Motion Planning of an Inchworm Robot Based on Improved Adaptive PSO

摘要

Focusing on the motion energy consumption of a self-developed inchworm robot’s peristaltic gait, based on the “error tracking” of cubic polynomial programming in Cartesian space and seventh polynomial programming in joint space, we propose an optimal motion planning method of energy consumption considering both kinematic and dynamic constraints. Firstly, we offer a mathematical description of the energy consumption and space curve similarity operator. Secondly, we describe the mathematical models of the robot trajectory and path that were established in terms of their dynamics and kinematics. Then, we propose a motion planning method based on improved adaptive particle swarm optimization (PSO) to accelerate the convergence speed of the algorithm and ensure the accuracy of the model calculation. Finally, we outline the simulation test carried out to measure the inchworm-like robot’s creeping gait. The results show that the motion path obtained by using the planning method proposed in this paper is the one with the least energy consumption by the robot among all the comparison paths. Moreover, compared with other algorithms, it was found that the result obtained by using the algorithm proposed in this paper is the one with the shortest solution time and the lowest energy consumption under the same iteration times. The calculation results verify the feasibility and effectiveness of the planning method.