工业机器人倍四元数轨迹规划算法的研究

摘要/Abstract

摘要： 针对工业机器人在笛卡尔空间的轨迹规划曲线的平滑性与实时性，提出一种用于描述超球面旋转的倍四元数对机器人运动轨迹进行球面线性插补，并结合正弦波加速度曲线升降速控制算法对轨迹规划的速度进行控制，为机器人的轨迹规划提供了一种新的位姿规划的解决方案。在六关节搬运机器人控制系统平台上进行了仿真与试验，验证了该算法解决方案的有效性。

关键词: 工业机器人, 倍四元数, 正弦波加速度曲线, 轨迹规划

Abstract: For the curve smoothness and real-time requirements of industrial robot trajectories in cartesian space, the paper represented hyperspheres rotation quaternion of robot trajectory spherical linear interpolation, combined with the algorithm of sinusoidal acceleration curve lifting velocity to control the trajectory planning. It provides a new solution of position and pose planning. Finally, simulations were performed in six joints handling robot control system platform, then to prove the validity of the algorithm solution.

Key words: industrial robot, double quaternion, sinusoidal acceleration curve, trajectory planning

中图分类号:

TP242.2

李宏胜, 汪允鹤, 黄家才, 施昕昕. 工业机器人倍四元数轨迹规划算法的研究[J]. 中国机械工程.

Li Hongsheng, Wang Yunhe, Huang Jiacai, Shi Xinxin. Research on Trajectory Planning of Industrial Robots with Double Quaternion[J]. China Mechanical Engineering.

参考文献

[1]Craig J J.机器人学导论[M].牟超，译.北京：机械工业出版社,2012.

[2]Dam E B, Koch M, Lillholm M. Quaternions, Interpolation and Animation[R]. Copenhagen，Denmark：University of Copenhagen,1998.

[3]季晨. 工业机器人姿态规划及轨迹优化研究[D].哈尔滨：哈尔滨工业大学,2013.

[4]孙斌,常晓明,段晋军.基于四元数的机械臂平滑姿态规划与仿真[J].机械科学与技术,2015（1）:56-59.

Sun Bin, Chang Xiaoming, Duan Jinjun. Smooth Orientation Planning and Simulation of Manipulator Based on Quaternion[J]. Mechanical Science and Technology for Aerospace Engineering, 2015（1）:56-59.

[5]刘松国,朱世强,王宣银,等. 基于四元数和B样条的机械手平滑姿态规划器[J]. 浙江大学学报(工学版),2009,43（7）:1192-1196.

Liu Songguo, Zhu Shiqiang, Wang Xuanyin, et al. Smooth Orientation Planner for Manipulators Based on Quaternion and B-spline[J].Journal of Zhejiang University(Engineering Science),2009,43（7）:1192-1196.

[6]高亚军.六自由度机器人平滑轨迹规划与控仿一体化系统研究[D].杭州：浙江工业大学,2014.

[7]王健. 6R串联机器人轨迹规划算法研究[D].北京：北方工业大学,2014.

[8]乔曙光,廖启征,黄昔光. 倍四元数及其在串联机构运动分析中的应用[J]. 机械设计与制造,2008（2）:36-38.

Qiao Shuguang, Liao Qizheng, Huang Xiguang. Application of Double Quaternions in Inverse Solving of Serial Mechanisms[J]. Machinery Design & Manufacture, 2008（2）:36-38.

[9]廖啟征. 机构运动学建模的倍四元数法[J]. 北京工业大学学报,2015,41（11）:1611-1619.

Liao Qizheng. Kinematic Modeling of Mechanisms Ssing Double Quaternion[J]. Journal of Beijing University of Technology,2015,41（11）:1611-1619.

[10]马艳红,胡军. 姿态四元数相关问题[J]. 空间控制技术与应用,2008,34（3）:55-60.

Ma Yanhong, Hu Jun.On Attitude Quaternion[J]. Aerospace Control and Application, 2008,34（3）:55-60.

[11]张劲夫,蔡泰信. 对偶四元数及其在刚体定位中的应用[J]. 黄淮学刊(自然科学版),1993,9（增刊4）:27-30.

Zhang Jinfu, Cai Taixin. Dual Quaternion and Its Application in Rigid Positioning[J]. Huanghuai Journal(Natural Science),1993,9（S4）:27-30.

[12]刘鹏飞,杨孟兴,宋科,等. ‘S'型加减速曲线在机器人轨迹插补算法中的应用研究[J]. 制造业自动化,2012,34（20）:4-8.

Liu Pengfei, Yang Mengxing, Song Ke, et al. The Study of S-curve’s Application on Manipulator’s Trajectory Interpolation Algorithm[J]. Manufacturing Automation, 2012,34（20）:4-8.

[13]林仕高,刘晓麟,欧元贤. 机械手笛卡尔空间轨迹规划研究[J]. 机械设计与制造,2013(3):49-52.

Lin Shigao, Liu Xiaolin, Ou Yuanxian. The Study of Trajectory Planning of Manipulator in Cartesian Space[J]. Machinery Design & Manufacture, 2013(3):49-52.

[14]杜滨. 全方位移动机械臂协调规划与控制[D].北京：北京工业大学,2013.

[15]张红强. 工业机器人时间最优轨迹规划[D].长沙：湖南大学,2004.