This paper develops nonholonomic motion planning strategy for three-joint underactuated manipulator, which uses only two actuators and can be converted into chained form. Since the manipulator was designed focusing on the control simplicity, there are several issues for motion planning, mainly including transformation singularity, path estimation, and trajectory robustness in the presence of initial errors, which need to be considered. Although many existing motion planning control laws for chained form system can be directly applied to the manipulator and steer it to desired configuration, coordinate transformation singularities often happen. We propose two mathematical techniques to avoid the transformation singularities. Then, two evaluation indicators are defined and used to estimate control precision and linear approximation capability. In the end, the initial error sensitivity matrix is introduced to describe the interference sensitivity, which is called robustness. The simulation and experimental results show that an efficient and robust resultant path of three-joint underactuated manipulator can be successfully obtained by use of the motion planning strategy we presented.
Nonholonomic Motion Planning Strategy for Underactuated Manipulator