宇航学报 ›› 2020, Vol. 41 ›› Issue (8): 989-999.doi: 10.3873/j.issn.1000-1328.2020.08.001

• 飞行器设计与力学 • 上一篇    下一篇

空间机器人动力学奇异回避的笛卡尔轨迹规划

金荣玉,耿云海   

  1. 哈尔滨工业大学卫星技术研究所,哈尔滨 150001
  • 收稿日期:2019-08-02 修回日期:2019-10-11 出版日期:2020-08-15 发布日期:2020-08-25

Cartesian Trajectory Planning of Free Floating Space Robot with Dynamic Singularities Avoidance#br#

JIN Rong yu, GENG Yun hai   

  1. Research Center of Satellite Technology, Harbin Institute of Technology, Harbin 150001, China
  • Received:2019-08-02 Revised:2019-10-11 Online:2020-08-15 Published:2020-08-25

摘要: 针对空间机器人动力学奇异的回避问题,提出一种基于组合函数的笛卡尔轨迹规划方法。将梯形规划与正弦函数相结合,对机械臂末端的位姿进行参数化。机械臂沿着某一轨迹运动时,根据阻尼最小方差法(DLS)的特点,提出一种判断是否发生动力学奇异的方法,并据此进行轨迹规划。该方法可以保证空间机械臂运动过程中不会遇到动力学奇异。此外,将基座姿态扰动和机械臂运动时间作为目标函数的一部分,最终,轨迹规划问题转化为多目标优化问题,并利用混合整数规划的混沌粒子群优化算法(CPSO)进行求解。该优化算法能够改善标准粒子群算法(PSO)的“早熟”现象。仿真结果表明,新方法能够有效处理动力学奇异问题,减小基座姿态扰动及运动时间。

关键词: 空间机器人, 轨迹规划, 动力学奇异, 基座姿态扰动, 运动时间, 混沌粒子群优化算法(CPSO)

Abstract: To avoid dynamic singularities, a Cartesian trajectory planning method for a free-floating space robot is developed in this paper. Combining the trapezoidal programming and sine functions, the position and attitude of the end-effector are parameterized. Based on the damped least-squares (DLS), this paper proposes a method to determine whether the singularities occur during the movement of the manipulators. It can guarantee that the space robot cannot meet the singularities with the method. Moreover, considering the base attitude disturbance and the moving time, a cost function is obtained. Therefore, the trajectory planning issue is transferred to an optimization issue. The chaos particle swarm optimization (CPSO) algorithm for mixed integer programming is implemented to find the optimal solution. Compared with particle swarm optimization (PSO), it can improve the premature. The numerical simulations have demonstrated that the designed method can avoid dynamic singularities, and minimize the base attitude disturbance and the moving time effectively.

Key words: Space robot, Trajectory planning, Dynamic singularities, Base attitude disturbance, Moving time, Chaos particle swarm optimization (CPSO)

中图分类号: