• CN:11-2187/TH
  • ISSN:0577-6686

›› 2008, Vol. 44 ›› Issue (8): 248-252.

• 论文 • 上一篇    下一篇

扫码分享

大型刚体调姿系统最优时间轨迹规划

张斌;方强;柯映林   

  1. 浙江大学机械与能源工程学院
  • 发布日期:2008-08-15

Optimal Time Trajectory Planning Method for a Kind of Posture Aligning System of Large Rigid Bodies

ZHANG Bin;FANG Qiang;KE Yinglin   

  1. College of Mechanical and Energy Engineering, Zhejiang University
  • Published:2008-08-15

摘要: 研究基于三坐标支撑柱的大型刚体位姿调整系统。系统可等效为6自由度冗余驱动并联机构,动平台初始位姿和目标位姿已知,而运动时间和路径不确定。为了使支撑柱运动平稳并提高调姿精度,在考虑工程实际中的关节驱动力约束和驱动速度约束的基础上,提出一种最优时间轨迹规划算法。首先运用冗余驱动并联机构的分析方法建立该系统的运动学和动力学模型,并通过Moore-Penrose广义逆矩阵得到关节驱动力的最小范数解,然后以时间为参数,运用5次多项式拟合调姿物体的位姿变化轨迹,再通过二分法求解出满足关节空间约束的最优调姿时间,从而生成相应的关节运动轨迹。仿真结果表明算法只需经过较少次迭代就能获得理想的调姿运动轨迹。总之,该轨迹规划方法是有效的。

关键词: 并联机构, 动力学, 位姿调整, 运动学, 最优时间

Abstract: A kind of posture alignment system of large rigid bodies based on 3-coordinate posts is studied. The system can be equivalent to a 6-DOF over-actuated parallel mechanism and the init and final posture of the movable-platform are given while the moving time and path are uncertain. In order to make the movement of the posts stable and to improve the precision of alignment, an optimal time trajectory planning algorithm with the actuating force and velocity restrains of the joints in the engineering is presented. Firstly, kinematics as well as dynamics models of the system are established with the analyzing method for over-actuated parallel mechanisms, and the minimum norm solution of the actuating force of the joints is obtained through Moore-Penrose pseudoinverse matrix. Then, the posture variety of the body is fitted by quintic polynomial while the aligning time is parameterized. At last, the optimal aligning time for the system subjected to the joint space restrains is calculated by the bisection method and the corresponding trajectory is generated. The simulation result shows that only a few times of iteration are needed to generate the trajectory with the algorithm. In conclusion, the planning method is feasible.

Key words: Dynamics, Kinematics, Optimal time, Parallel mechanism, Posture alignment

中图分类号: