基于SINS/CNS的月球车自主导航方法

针对月面特殊环境,设计了一种基于改进粒子滤波的捷联惯导与天文导航(SINS/CNS)月球车组合导航仿真方案。首先,根据月球表面导航的特殊要求,建立了月球环境下惯性导航系统的姿态、速度和位置误差方程,然后建立基于速度和天文联合观测的量测方程。由于系统状态方程和量测方程均为非线性方程,所以采用了改进的粒子滤波实现月球车位姿信息的最优估计,估计出组合导航系统的误差状态量,进而修正惯导系统的位置、速度和姿态。本设计的仿真结果表明:该方法具有很好的位置和姿态估计精度,同时有效抑制了量测噪声对系统性能的影响,是解决月球车自主导航问题的一种有效而实用的方法。