一种并联机器人轨迹规划算法研究

朱大昌, 盘意华, 杜宝林, 吴光毅, 谢清华

机床与液压 ›› 2023, Vol. 51 ›› Issue (5) : 14-22.

PDF(5748 KB)
PDF(5748 KB)
机床与液压 ›› 2023, Vol. 51 ›› Issue (5) : 14-22. DOI: 10.3969/j.issn.1001-3881.2023.05.003
工业机器人专栏

一种并联机器人轨迹规划算法研究

  • 朱大昌, 盘意华, 杜宝林, 吴光毅, 谢清华
作者信息 +

Research on Trajectory Planning Algorithm of Parallel Robot

  • ZHU Dachang, PAN Yihua, DU Baolin, WU Guangyi, XIE Qinghua
Author information +
文章历史 +

摘要

针对并联机器人工作空间微小线段间拐角处产生的冲击与振动问题,提出一种基于笛卡尔空间与关节空间相结合的机器人联合空间轨迹规划方法。在笛卡尔空间中采用三次非均匀有理B样条曲线对机器人末端执行器复杂的加工轨迹进行插补。为解决笛卡尔空间微小线段间拐角处的切向不连续导致轨迹突变的问题,基于并联机器人逆运动学模型,将笛卡尔空间轨迹规划算法所得插补点映射到关节空间,采取五次均匀B样条曲线进行第二次轨迹插补,平滑并联机器人运动过程中加速度及加加速度突变曲线。并在动力学层面验证所提算法的有效性。仿真结果表明:联合空间轨迹规划策略能使机器人末端执行器较好地改善连续高阶曲率导数的轨迹平滑问题,提高末端跟踪精度。实验结果表明:末端跟踪误差值最大减少21.12%,力矩最大值减少11.65%。

Abstract

Aiming at the problem of impact and vibration at the corner between micro segments in the workspace of parallel robot, a joint-space trajectory planning method based on Cartesian space and joint space was proposed.In essence, the complex machining trajectory of robot is to approximate the target curve by using small straight line segments.The cubic non-uniform rational B-splines (NURBS) curve was used to interpolate the complex machining trajectory of the end effector in robot Cartesian space.In order to solve the problem of sudden change of trajectory caused by tangential discontinuity at the corner between small line segments in Cartesian space, based on the inverse kinematics model of the parallel robot, the interpolation points obtained by the Cartesian space trajectory planning algorithm were mapped to the joint space, and the quintic uniform B-spline curve was used for the second trajectory interpolation in the joint space, smoothing the abrupt curves of acceleration and jerk during the movement of the parallel robot.Finally, the effectiveness of the proposed algorithm was verified at the dynamic level.The simulation results show that the joint spatial trajectory planning strategy can be used to make the robot end effector better improve the trajectory smoothing problem caused by continuous high-order curvature derivatives and improve the end tracking accuracy.The experimental results show that the end tracking error is reduced by 21.12% and the maximum torque is reduced by 11.65%.

关键词

并联机器人 / 联合空间轨迹规划算法 / NURBS / 五次均匀B样条

Key words

Parallel robot / Joint-space trajectory planning algorithm / Non-uniform rational B-splines(NURBS) / Quintic uniform B spline

引用本文

导出引用
朱大昌, 盘意华, 杜宝林, 吴光毅, 谢清华. 一种并联机器人轨迹规划算法研究[J]. 机床与液压, 2023, 51(5): 14-22 https://doi.org/10.3969/j.issn.1001-3881.2023.05.003
ZHU Dachang, PAN Yihua, DU Baolin, WU Guangyi, XIE Qinghua. Research on Trajectory Planning Algorithm of Parallel Robot[J]. Machine Tool & Hydraulics, 2023, 51(5): 14-22 https://doi.org/10.3969/j.issn.1001-3881.2023.05.003

参考文献

[1] LI B R, ZHANG H, YE P Q, et al.Trajectory smoothing method using reinforcement learning for computer numerical control machine tools[J].Robotics and Computer-Integrated Manufacturing, 2020, 61:101847.
[2] 冯李航, 张为公, 龚宗洋, 等.Delta系列并联机器人研究进展与现状[J].机器人, 2014, 36(3):375-384. FENG L H, ZHANG W G, GONG Z Y, et al.Developments of delta-like parallel manipulators:a review[J].Robot, 2014, 36(3):375-384.
[3] FANG S, MA X H, ZHAO Y, et al.Trajectory planning for seven-DOF robotic arm based on quintic polynormial[C]//Proceedings of 2019 11th International Conference on Intelligent Human-Machine Systems and Cybernetics.Hangzhou:IEEE, 2019:198-201.
[4] WANG H, WANG H, HUANG J H, et al.Smooth point-to-point trajectory planning for industrial robots with kinematical constraints based on high-order polynomial curve[J].Mechanism and Machine Theory, 2019, 139:284-293.
[5] 金育安, 贺永, 傅建中.NURBS及Hermite混合高速加工插补算法[J].浙江大学学报(工学版), 2014, 48(4):641-648. JIN Y, HE Y, FU J Z.NURBS-Hermite hybrid interpolation for high-speed machining[J].Journal of Zhejiang University (Engineering Science), 2014, 48(4):641-648.
[6] 陈光胜, 梅雪松.一种小线段的非对称S曲线速度规划与前瞻算法[J].机械设计与制造, 2010(8):47-49. CHEN G S, MEI X S.A dissymmetrical s curve velocity plan & look-ahead algorithm for small line segments[J].Machinery Design & Manufacture, 2010(8):47-49.
[7] FAN W, LEE C H, CHEN J H.A realtime curvature-smooth interpolation scheme and motion planning for CNC machining of short line segments[J].International Journal of Machine Tools and Manufacture, 2015, 96:27-46.
[8] 陈伟华.工业机器人笛卡尔空间轨迹规划的研究[D].广州:华南理工大学, 2010:46-54. CHEN W H.Study of industrial robot trajectory planning in Cartesian space[D].Guangzhou:South China University of Technology, 2010:46-54.
[9] 梅江平, 臧家炜, 乔正宇, 等.三自由度Delta并联机械手轨迹规划方法[J].机械工程学报, 2016, 52(19):9-17. MEI J P, ZANG J W, QIAO Z Y, et al.Trajectory planning of 3-DOF delta parallel manipulator[J].Journal of Mechanical Engineering, 2016, 52(19):9-17.
[10] BORYGA M,GRABOS A.Planning of manipulator motion trajectory with higher-degree polynomials use[J].Mechanism and Machine Theory, 2009, 44(7):1400-1419.
[11] LIU L, CHEN C Y, ZHAO X H, et al.Smooth trajectory planning for a parallel manipulator with joint friction and jerk constraints[J].International Journal of Control, Automation and Systems, 2016, 14(4):1022-1036.
[12] QIAN S, BAO K L, ZI B, et al.Dynamic trajectory planning for a three degrees-of-freedom cable-driven parallel robot using quintic B-splines[J].Journal of Mechanical Design, 2020, 142(7):073301.
[13] 孔庆博, 袁亮, 蒋伟.一种改进的工业机器人轨迹规划方法研究[J].机械传动, 2019, 43(2):30-36. KONG Q B, YUAN L, JIANG W.Research of an improved trajectory planning method for industrial robot[J].Journal of Mechanical Transmission, 2019, 43(2):30-36.
[14] HUANG J S, HU P F, WU K Y, et al.Optimal time-jerk trajectory planning for industrial robots[J].Mechanism and Machine Theory, 2018, 121:530-544.
[15] 梁香宁, 牛志刚.三自由度Delta并联机器人运动学分析及工作空间求解[J].太原理工大学学报, 2008, 39(1):93-96. LIANG X N, NIU Z G.Kinematic analysis and workspace of 3-dof delta parallel robot[J].Journal of Taiyuan University of Technology, 2008, 39(1):93-96.
[16] MO J, SHAO Z F, GUAN L W, et al.Dynamic performance analysis of the X4 high-speed pick-and-place parallel robot[J].Robotics and Computer-Integrated Manufacturing, 2017, 46:48-57.
[17] WU G L, ZHAO W K, ZHANG X P.Optimum time-energy-jerk trajectory planning for serial robotic manipulators by reparameterized quintic NURBS curves[J].Proceedings of the Institution of Mechanical Engineers:Part C:Journal of Mechanical Engineering Science, 2021, 235(19):4382-4393.
[18] 陈绍平.三次NURBS曲线的插值与应用[J].机械科学与技术, 2001, 20(5):692-693. CHEN S P.Interpolation and application for cubic NURBS curves[J].Mechanical Science and Technology, 2001, 20(5):692-693.
[19] 霍亚光, 宋绪丁, 刘海明.NURBS插补方式对数控铣削加工质量的影响[J].现代制造工程, 2012(8):57-60.HUO Y G, SONG X D, LIU H M.Effect of NURBS interpolation method on the accuracy of CNC milling[J].Modern Manufacturing Engineering, 2012(8):57-60.
[20] 施法中.计算机辅助几何设计与非均匀有理B样条[M].北京:高等教育出版社, 2001:227-230.
[21] 杜宝林, 朱大昌, 盘意华.机械臂模糊超螺旋二阶滑模轨迹跟踪控制[J].系统仿真学报, 2022, 34(6):1343-1352. DU B L, ZHU D C, PAN Y H.Fuzzy super-twisting second order sliding mode trajectory tracking control for robotic manipulator[J].Journal of System Simulation, 2022, 34(6):1343-1352.

基金

广州大学研究生创新研究资助计划项目(2021GDJC-M31);国家自然科学基金资助项目(51905115)
PDF(5748 KB)

144

Accesses

0

Citation

Detail

段落导航
相关文章

/