Nonholonomic motion planning based on Newton algorithm with energy optimization

This paper discusses a modification of the Newton algorithm applied to nonholonomic motion planning with energy optimization. The energy optimization is performed either by optimizing motion in the pull space of the Jacobian matrix derived from the nonholonomic system or coupling this motion with mo ment toward the goal., Resulting controls are smooth and easily generated by motors or thrusters. The two methods can be used, when kinematics are considered, to steer any driftless nonholonomic systems particular free-floating objects, underactuated manipulators, mobile robots (with trailers). Similarities and differences are also discussed in the Newton algorithm for holonomic and nonholonomic systems.