Research and Implementation of Trajectory Planning Algorithm for Attacking Robots on Wind Tunnel

Expand
  • 1.State Key Laboratory of Mechanical Transmissions,Chongqing University,Chongqing,400044
    2.Hypervelocity Aerodynamics Institute,China Aerodynamics Research and Development Center,Mianyang,Sichuan,621000
    3.School of Information and Control Engineering,Liaoning Shihua University,Fushun,Liaoning,113001

Received date: 2020-05-13

  Online published: 2021-08-26

Abstract

 In order to increase the speeds of the robot arms tracking the target trajectory, the target trajectory of the robots was re-planned. By introducing path parameters, constraints such as joint velocity and force/moment were transformed into constraints on trajectory parameters in the trajectory planning algorithm. The maximum velocity curves of path parameters under joint velocity and force/moment constraints were obtained respectively. The maximum velocity curves with multiple constraints were obtained by calculating the intersection of the above maximum velocity curves. In order to improve the computational efficiency of the algorithm, the fuzzy inference method was used to discretize the target trajectory to reduce the optimization scales, and the maximum velocity curves of the joint force/torque constraint were replaced by the velocity curves of the zero value acceleration curves multiplied by the proportional coefficient. The planned trajectory was modified through the speed feature point algorithm and the modification-target algorithm to ensure that the modified target trajectory meets the constraints of joint speed and force/torque, and the velocity curve is smooth. The trajectory planning experimental results shows that the trajectory planning algorithm have better planning performance for target trajectories of different complexity, and may obtain continuous and smooth time approximate optimal trajectories.

Cite this article

SUN Xiaojun, SONG Daiping, LIN Jingzhou, HAN Weihang . Research and Implementation of Trajectory Planning Algorithm for Attacking Robots on Wind Tunnel[J]. China Mechanical Engineering, 2021 , 32(16) : 1963 -1971 . DOI: 10.3969/j.issn.1004-132X.2021.16.009

References

[1]张强. 基于最优控制的数控系统轨迹规划方法研究[D].青岛:中国石油大学(华东),2014.

ZHANG Qiang. Research on Trajectory Planning Method of Numerical Control System Based on Optimal Control [D]. Qingdao:China University of Petroleum (East China), 2014.

[2]刘凉, 陈超英, 赵新华.考虑关节摩擦的并联机械臂平滑轨迹规划[J]. 机械工程学报, 2014, 50(19):9-17.

LIU Liang, CHEN Chaoying, ZHAO Xinhua. Smooth Trajectory Planning of Parallel Robots Considering Joint Friction [J]. Journal of Mechanical Engineering, 2014, 50(19):9-17

[3]刘小磊. R-Theta型硅片传输机械臂轨迹规划研究与实现[D].哈尔滨:哈尔滨工业大学, 2016.

LIU Xiaolei. Research and Implementation of  Trajectory Planning for R-Theta Silicon Wafer Transmission Robot [D]. Harbin:Harbin Institute of Technology, 2016.

[4]南文虎,郑海霞,叶伯生.基于修型/射靶算法的工业机械臂固定路径时间最优轨迹规划[J].机器人,2016,38(2):233-240. 

NAN Wenhu, ZHENG Haixia, YE Bosheng. Time-optimal Trajectory Planning for Fixed Paths of Industrial Manipulators Based on Modification/Targeting Algorithm[J].Robot, 2016, 38(2):233-240.

[5]PHAM Q C. A General, Fast, and Robust Implementation of the Time-optimal Path Parameterization Algorithm[J]. IEEE Transactions on Robotics, 2014, 30(6):1533-1540.

[6]DEBROUWERE F, van LOOCK W, PIPELEERS G, et al. Time-optimal Path Following for Robots with Convex-concave Constraints Using Sequential Convex Programming[J]. IEEE Transactions on Robotics, 2013, 29(6):1485-1495.

[7]徐海黎,解祥荣,庄健,等.工业机械臂的最优时间与最优能量轨迹规划[J].机械工程学报,2010,46(9):19-25.

XU Haili, XIE Xiangrong, ZHUANG Jian, et al. Optimal Time and Optimal Energy Trajectory Planning for Industrial Robots [J]. Journal of Mechanical Engineering, 2010, 46 (9):19-25.

[8]甘亚辉, 戴先中. 基于遗传算法的多机械臂系统最优轨迹规划[J]. 控制理论与应用, 2010, 27(9):1245-1252.

GAN Yahui, DAI Xianzhong. Optimal Trajectory Planning of Multi-robot System Based on Genetic Algorithm [J]. Control Theory and Applications, 2010, 27(9):1245-1252.

[9]滕儒民,李玉鑫,王欣,等.基于凸优化的举高消防车时间最优轨迹规划[J].机械工程学报,2019,55(6):138-144.

TENG Rumin, LI Yuxin, WANG Xin, et al. Time-optimal Trajectory Planning of Lifting Fire Truck Based on Convex Optimization [J]. Journal of Mechanical Engineering, 2019, 55(6):138-144.

[10]方健,宋宇,朱茂飞,等.基于时间最优的码垛机械臂轨迹规划[J].控制工程,2018,25(1):93-99.

FANG Jian, SONG Yu, ZHU Maofei, et al. Trajectory Planning of Palletizing Manipulator Based on Time Optimization [J]. Control Engineering, 2018, 25(1):93-99.

[11]李树荣, 张强. 计算机数控系统光滑时间最优轨迹规划[J]. 控制理论与应用, 2012, 29(2):192-198.

LI Shurong, ZHANG Qiang. Smooth Time Optimal Trajectory Planning of Computer Numerical Control System [J]. Control Theory and Applications, 2012, 29(2):192-198.

[12]FLORES F G, ANDRS K. Time-optimal Path Planning Along Specified Trajectories[M]∥Multibody System Dynamics,Robotics and Control.Vienna, 2013:1-16.

[13]LIU H , LAI X , WU W . Time-optimal and Jerk-continuous Trajectory Planning for Robot Manipulators with Kinematic Constraints[J]. Robotics & Computer Integrated Manufacturing, 2013, 29(2):309-317.

[14]韩江,谷涛涛,夏链,等.基于混合插值的工业机器人关节轨迹规划算法[J].中国机械工程,2018,29(12):1460-1466.

HAN Jiang, GU Taotao, XIA Lian, et al. Joint Trajectory Planning Algorithm for Industrial Robots Based on Hybrid Interpolation[J]. China Mechanical Engineering, 2018, 29(12):1460-1466.
Outlines

/

〈 〉