Coordinated trajectory planning of a dual-arm space robot with multiple avoidance constraints

This paper presents a coordinated trajectory planning method for a free-floating dual-arm space robot system. The research purpose of this paper is to enable a space robot to complete the specified goals while avoiding collision with an obstacle by planning the motion of the joints. The coordinated trajectory planning problem for a space robot is transformed into an optimization problem to find the optimal trajectory of the base and manipulators by using particle swarm optimization (PSO). Since the optimization method is used to find an optimal trajectory, it is unnecessary to calculate the position of the base and the inverse kinematics of the joints. Therefore, the kinematic singular problem in seeking the inverse solution can be avoided. The joint trajectories are parametrized by a sine function with seventh-order polynomial parameters. Multiple constraints are added to the objective function as penalty items, and a new increasing strategy for a penalty factor is proposed to balance the penalty and search ability under multiple constraints. Finally, numerical simulations are carried out to verify the effectiveness of the proposed method.