航空学报 > 2009, Vol. 30 Issue (8): 1521-1530

崎岖地形中关节式月球车姿态估计数值求解方法

禹鑫燚,高海波,邓宗全   

  1. 哈尔滨工业大学 机电工程学院
  • 收稿日期:2008-06-02 修回日期:2008-08-05 出版日期:2009-08-25 发布日期:2009-08-25
  • 通讯作者: 禹鑫燚

Numerical Solving Method of Kinematic Observers Estimation ofArticulated Rovers on Rough Terrain

Yu Xinyi, Gao Haibo, Deng Zongquan   

  1. School of Mechatronics Engineering, Harbin Institute of Technology
  • Received:2008-06-02 Revised:2008-08-05 Online:2009-08-25 Published:2009-08-25
  • Contact: Yu Xinyi

摘要: 以被动关节式地形自适应月球车为研究对象,融合关节机器人D-H坐标建模方法构建了月球车悬架运动学模型和以侧倾、俯仰和偏转角表示姿态的欧拉角方式建立了车轮到世界坐标系的悬架完整表达模型。利用悬架完整表达模型,用带有迭代因子的连续迭代和离散迭代数值求解方法,建立了光滑和离散崎岖地形姿态估计算法。最后以8轮扭杆双摇杆摇臂月球车原理样机为例来验证此模型求解方法。仿真结果验证了所建立的基于数值方法的崎岖地形被动关节式月球车姿态估计模型的正确性,其求解模型精度能够满足仿真要求。

关键词: 姿态估计, 悬架运动学, 月球车, 数值方法, 被动关节式

Abstract: Based on a study of the passive articulated rover, a complete suspension kinematics model from wheel to inertial reference frame is presented, which uses the D-H kinematics model method of manipulator and presentation with Euler angle of pitch, roll, and yaw. By means of this complete suspension kinematics model and Newton’s numerical continuous and discrete method with iterative factors, the numerical solution of kinematic observer estimation of articulated rovers on smooth rough and discrete terrain is constructed. To demonstrate the validity of this numerical solution, an example about a two torsionbar rockerbogie lunar rover with eight wheels is presented. Simulation results show that this numerical solving method of kinematic observer estimation of articulated rovers on rough terrain is valid and its precision can satisfy the requirements of simulation systems.

Key words: kinematic observer estimation, suspension kinematics, lunar rover, numerical methods, passive-articulated

中图分类号: