关键词: 导轨机械臂, 关节速度偏离, 位置误差, 运动规划, 误差修正

Abstract: Aiming at the problem that the joint velocity of the rail manipulator deviates from the expected value during the process of task execution, a pseudoinverse-based motion planning scheme for deviation correction of joint velocity of rail manipulator was proposed. Firstly, according to the joint angle state of the manipulator and the motion state of the end-effector, the pseudoinverse algorithm was used to analyze the redundancy of the rail manipulator on the velocity level. Secondly, a time-varying function was designed to perform constraint and adjustment of the joint velocity, making the deviated joint velocity converge to the expected value. Thirdly, an error correction method was employed to reduce the position error of the end-effector for ensuring the successful execution of the trajectory tracking task. Finally, the motion planning scheme was simulated on Matlab software with the four-bar redundant manipulator with the base of linear movement and circular movement as the example. The simulation results show that the proposed motion planning scheme can correct the joint velocity of the rail manipulator deviated from the expected value during the task execution, and can make the end-effector obtain higher accuracy in trajectory tracking.

Key words: rail manipulator, deviation of joint velocity, position error, motion planning, error correction