Motion Planning Algorithm of a Multi-Joint Snake-Like Robot Based on Improved Serpenoid Curve
Dongfang Li, Chao Wang, Hongbin Deng, Yiran Wei
Abstract
In order to study the winding motion of a multi-joint snake-like robot with multi-degree of redundancy in plane, a motion planning algorithm of a multi-joint snake-like robot based on improved Serpenoid curve equation is proposed in this paper. Firstly, the kinematics and dynamics models of a multi-joint snake-like robot are established, and the joint angle curve equation and the thrust expression of each joint of the robot relative to time are obtained. Next, the existing Serpenoid curve equation is improved to calculate the axial bending moment function with joint angle amplitude adjustment factor and turn angle adjustment factor. By analyzing the relationship between the forward thrust of the robot and the improved Serpenoid curve equation, a simple, efficient and reliable closed-loop control system was designed. Then, MATLAB and SimWise4D were used for simulation to obtain the motion trajectory of the robot based on the improved Serpenoid curve motion planning algorithm, and the influence of different parameters on the forward velocity of the multi-joint snake robot was analyzed. Finally, the validity of the motion planning algorithm of a multi-joint snake-like robot based on improved Serpenoid curve equation is verified by the actual experiment.