风洞上攻角机器人轨迹规划算法研究与实现  

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

作　　者：孙晓军 宋代平[1] 林敬周 韩伟航 SUN Xiaojun;SONG Daiping;LIN Jingzhou;HAN Weihang(State Key Laboratory of Mechanical Transmissions,Chongqing University,Chongqing,400044;Hypervelocity Aerodynamics Institute,China Aerodynamics Research and Development Center,Mianyang,Sichuan,621000;School of Information and Control Engineering,Liaoning Shihua University,Fushun,Liaoning,113001)

机构地区：[1]重庆大学机械传动国家重点实验室,重庆400044 [2]中国空气动力学研究与发展中心超高速空气动力研究所,绵阳621000 [3]辽宁石油化工大学信息与控制工程学院,抚顺113001

出　　处：《中国机械工程》2021年第16期1963-1971,共9页China Mechanical Engineering

基　　金：国家重点研发计划(2018YFC0808004)。

摘　　要：为了提高机械臂跟踪目标轨迹的运动速度,对其目标轨迹进行二次规划。该轨迹规划算法通过引入路径参数s,将关节速度、力/力矩等约束转化为关于路径参数的约束,分别求取关节速度与力/力矩约束限制下路径参数s的最大速度曲线,对最大速度曲线求交集,获得多重约束最大速度曲线。采用模糊推理方法对目标轨迹进行离散化处理,减小优化规模;以0值加速度曲线乘以比例系数Kv替代关节力/力矩约束的最大速度曲线,提高算法的计算效率;通过速度特征点算法与修型射靶算法对规划得到的轨迹进行修形,确保修形后的目标轨迹满足关节速度、力/力矩的约束,并且速度曲线光滑。实验表明,该轨迹规划算法对不同复杂程度的目标轨迹都有着较好的规划性能,能够得到连续平滑的时间近似最优轨迹。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.

关 键 词：机器人 运动学模型 动力学模型 时间近似最优 轨迹规划 

分 类 号：TP242[自动化与计算机技术—检测技术与自动化装置]