Journal of Computer Applications ›› 2020, Vol. 40 ›› Issue (12): 3695-3700.DOI: 10.11772/j.issn.1001-9081.2020040560

• Frontier & interdisciplinary applications • Previous Articles     Next Articles

Pseudoinverse-based motion planning scheme for deviation correction of rail manipulator joint velocity

LI Kene, ZHANG Zeng, WANG Wenxin   

  1. School of Electrical and Information Engineering, Guangxi University of Science and Technology, Liuzhou Guangxi 545006, China
  • Received:2020-04-30 Revised:2020-06-20 Online:2020-12-10 Published:2020-08-05
  • Supported by:
    This work is partially supported by the National Natural Science Foundation of China (61663003).

基于伪逆的导轨机械臂关节速度纠偏运动规划方案

李克讷, 张增, 王温鑫   

  1. 广西科技大学 电气与信息工程学院, 广西 柳州 545006
  • 通讯作者: 李克讷(1978-),男,广西柳州人,副教授,博士,主要研究方向:智能系统、智能机器人。likene@163.com
  • 作者简介:张增(1995-),男,广西南宁人,硕士研究生,主要研究方向:移动机器人、智能系统;王温鑫(1996-),女,辽宁丹东人,硕士研究生,主要研究方向:移动机器人
  • 基金资助:
    国家自然科学基金资助项目(61663003)。

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

摘要: 针对导轨机械臂在任务执行过程中出现的关节速度偏离期望值的问题,提出了一种基于伪逆算法的导轨机械臂关节速度纠偏运动规划方案。首先,根据机械臂的关节角状态和末端执行器的运动状态,运用伪逆算法对导轨机械臂在速度层上进行冗余度解析。然后,设计时变函数对关节速度进行约束调整,使偏离后的关节速度收敛于期望值。接着,针对末端执行器出现的位置误差设计了误差修正方法以保证轨迹跟踪任务的顺利执行。最后,将运动规划方案在Matlab软件上以基座直线移动和弧形移动的四连杆冗余度机械臂为例进行了仿真实验。仿真结果表明了该方案能纠正导轨机械臂在任务执行过程中偏离期望值的关节速度,且能使末端执行器的轨迹跟踪达到较高的精度。

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

CLC Number: