一种基于光流法的采煤机捷联惯导初始对准系统及方法

摘要

本发明公开了一种基于光流法的采煤机捷联惯导初始对准系统及方法，包括防爆箱、捷联惯导系统、处理器、固定支架和摄像头；所述防爆箱固定安装在采煤机的机身上，捷联惯导系统和处理器安装在防爆箱中，摄像头通过固定支架固定在采煤机一侧的液压支架上，且摄像头的拍摄方向朝着采煤机。利用摄像头拍摄采煤机运动图像，并结合光流技术得到采煤机的运动方向及其对地实际速度，通过捷联惯导的比力方程推导出多矢量定姿方程，最后采用Whaba最优矩阵即可求解出捷联惯导的初始姿态矩阵，实现捷联惯导系统的初始对准。本发明利用外界速度辅助，无需经过粗对准阶段，实现捷联惯导的动基座精确初始对准。