Smooth Orientation Planning and Simulation of Manipulator Based on Quaternion
-
摘要: 姿态迹规划在机械臂控制中占有重要的地位,插值姿态的平滑性将直接影响到机械臂末端动作的柔和度。对姿态规划的等效性进行研究,给出角加速度与角速度可控的转角规划曲线。为减小计算复杂度,采用四元数代替姿态矩阵描述末端姿态。此外,还研究了等效转角与四元数球面线性插值的关系。最后,针对自行研制的六轴机械臂模型,以LabVIEW为仿真平台,对姿态轨迹进行了仿真与讨论。仿真结果表明:所规划的姿态具有C2连续的特点,实现了平滑变化。Abstract: Orientation trajectory planning plays an important role in manipulator controlling and the smoothness of interpolation orientation will directly affect the action softness of end in manipulator. In this paper, the equivalence of orientation planning was studied and rotation angular planning curve was given with controllable angular acceleration and angular velocity. In order to reduce computational complexity, the end orientation was described in quaternion instead of orientation matrix. Else, the relationship of equivalent angular and spherical linear quaternion interpolation (Slerp) was studied. In the end, for self-developed six-axis manipulator module, the orientation planning method was simulated and discussed with simulation platform LabVIEW. As showed by simulation results, the planned orientations have C2-continuous characteristic while changes smoothly.
-
Key words:
- angular velocity /
- C2-continuous /
- computer simulation /
- LabVIEW /
- manipulators
-
[1] Dam E B, Koch M, Lillholm M. Quaternions, interpolation and animation[R]. Denmark:University of Copenhagen,1998 [2] 任秉银,梁兆东,孔民秀.机械手空间圆弧位姿轨迹规划算法的实现[J].哈尔滨工业大学学报,2012,(44):27-31 Ren B Y, Liang Z D, Kong X M. Realization of arc position and orientation planning algorithms of manipulator in space[J]. Journal of Harbin Institute of Technology,2012,(44):22-31 (in Chinese) [3] 熊有伦.机器人技术基础[M].武汉:华中科技大学,1992:114 Xiong Y L. Robot technolony foundation[M]. Wuhan:Huazhong University of Sciense and Technolony,1992:114 ( in Chinese) [4] 施开达,马利庄.试论四元数与旋转矩阵的关系及其在计算机图形学中的应用[J].舟山师专学报,1997,(1):7-13 Shi K D, Ma L Z. Discussion on relationship between quaternion and rotation matrix and its application in computer graphics[J]. Journal of Zhoushan Teachers College,1997,(1):7-13 (in Chinese) [5] 刘松国.六自由度串联机器人运动优化与轨迹跟踪控制研究[D].杭州:浙江大学,2009 Liu S G. Optimization and tracking control study on six freedom degrees of series robot[D]. Hangzhou:Zhejiang University,2009:50 (in Chinese)
点击查看大图
计量
- 文章访问数: 209
- HTML全文浏览量: 32
- PDF下载量: 20
- 被引次数: 0