针对运载火箭加注时连接器与加注活门自动对接随动过程进行研究,提出了基于动态方位检测对准技术的偏差测量系统。本方案首先测得连接器与加注活门的位置偏差值,将其定义为系统初值,采用光学摄像机获取合作靶标的图像,通过识别图像中靶标图像的方向及标志物的大小,快速提取靶标在相机平面的二维位姿,同时辅以激光测距传感器精确获取靶标与相机的距离信息。通过本测量方案即可实时获得当前时刻连接器与加注活门的偏差值。将其应用到自动对接系统中,结果表明,本方法满足火箭自动对接位移精度1 mm的技术要求。

针对车载里程计刻度系数受轮胎胎压、温度等的影响实时变化,提出采用强跟踪滤波进行捷联惯导/里程计组合导航。强跟踪滤波利用卡尔曼滤波残差序列相互正交的性质,在线实时调整渐消因子,对突变状态有较强的跟踪能力。提出采用平均速度匹配方法以消除载车振动及里程计量化误差对组合导航的影响,同时将杆臂误差列入状态量,消除不准确的杆臂在载车转弯时对组合导航的影响,建立了捷联惯导/里程计组合导航模型。进行了实际组合导航跑车试验,结果表明组合导航的定位精度优于1‰D。