人机协作下的机械臂轨迹生成与修正方法.PDF

第38 卷第4 期 机器人 ROBOT Vol.38, No.4 2016 年7 月 Jul., 2016 DOI ：10.13973/ki.robot.2016.0504 人机协作下的机械臂轨迹生成与修正方法 刘维惠，陈殿生，张立志 （北京航空航天大学机械工程及自动化学院，北京 100191） 摘 要：针对日常生活中多障碍物环境下的服务机器人机械臂轨迹规划问题，提出了一种人机协作下的轨迹 生成与修正方法．首先，基于动态动作基元（DMP ）模型，设计了一个能生成与示教轨迹形状相似的路径的方法． 该方法针对多自由度耦合产生的轨迹形状畸变问题，通过将3 维目标点投影于示教轨迹平面，再利用罗德里格旋 转公式生成3 维路径，保证了生成轨迹在各个方向都具有较稳定的形状特征．其次，针对存在多种形状障碍物的 复杂操作环境，提出了通过插入交互点对轨迹形状进行修正的方法．并采用双抛物线插值算法使修正后的轨迹平 滑．最后，基于人机协作的思想，在ROS （robot operating system ）环境下搭建一个交互界面．从而操作者能够直 观地辅助机械臂完成无障碍物和有障碍物的情况下的末端轨迹生成和修正．实验结果验证了该方法的直观性和灵 活性，该方法适用于具有多种障碍物的复杂日常环境． 关键词：人机协作；机械臂；轨迹生成；避障；人机交互界面；服务机器人 中图分类号：TP242.6 文献标识码：A 文章编号：1002-0446(2016)-04-0504-09 Trajectory Generation and Adjustment Method for Robot Manipulators in Human-Robot Collaboration LIU Weihui ，CHEN Diansheng ，ZHANG Lizhi (School of Mechanical Engineering and Automation, Beihang University, Beijing 100191, China) Abstract: For trajectory planning of service robot manipulators in daily living environment with obstacles, a trajectory generation and adjustment method in human-robot collaboration is proposed. At first, an approach is designed to produce a trajectory with similar shape to the demonstrated one based on dynamic movement primitive (DMP) model. Here, the problem of shape distortion caused by multi-degree-of-freedom coupling is solved by projecting the 3D target point on a plane where the demonstration trajectory falls, then generating the 3D trajectory by using Rodrigues’ rotation formula. Thu