基于捷联惯导的悬臂式掘进机位姿解算算法研究

针对煤矿井下高煤尘、光线暗的恶劣环境中掘进机无法实现动态位姿检测的问题,提出了基于捷联惯导的悬臂式掘进机位姿检测方法并对其解算算法做了对比研究。捷联惯导是通过三轴陀螺仪和三轴加速度计实时测得掘进机的角速度和加速度,根据位姿解算算法动态输出掘进机的姿态和位置信息。位姿解算算法很大程度决定着姿态和位置的精度,因此结合掘进机实际掘进工艺的特点,围绕位姿解算算法的适用性和优劣性,对比了四元数和等效旋转矢量两种位姿解算算法,分析了姿态解算误差的影响因素。在有噪声正弦运动和模拟掘进机行走运动两种情况下进行仿真并搭建了利用小车循迹代替掘进机掘进的实验平台进行实验,结果表明,两种算法均能满足掘进机姿态角的解算精度要求,四元数法的姿态解算精度高于等效旋转矢量法|位置的解算误差较大且呈发散状态,这有待于进一步研究。