双矢量定姿在煤矿掘进机姿态测量中的应用

作者：徐叶倩; 黄喆; 沈小玲; 赵世艺; 李佳雄; 王浩森; 肖恒

来源：电子科技, 2023, 1-9.

DOI：10.16180/j.cnki.issn1007-7820.2024.04.002

• 双目视觉
• 姿态测量
• 双矢量定姿
• 倾斜仪
• 煤矿掘进机
• 姿态角
• 重复性实验
• 误差分析

针对现有巷道掘进机的姿态测量手段中普遍存在的高成本和误差累积等问题，文中提出了一种基于双矢量定姿原理的姿态测量算法。通过在巷道掘进环境中分别对重力矢量和光矢量进行构建与感知，利用惯性倾角测量和双目视觉测量技术，基于矢量元素分别在导航坐标系和掘进机载体坐标系中的数学表达，即可实现掘进机载体坐标系相对于巷道导航坐标系的姿态解算。利用倾斜仪和双目相机组成的测量装置对指示激光和重力矢量进行测量，结合双矢量定姿算法即可完成掘进机机身的姿态解算。文中设计了静态重复性精度测量实验，结果表明该方法的姿态角重复性测量精度为0.066 2°。利用蒙特卡洛方法对可能会引入的误差源进行仿真分析，结果表明误差对方位角、俯仰角以及滚转角的影响分别为0.786 4°、0.454 8°、0.476 5°。

• 单位
  天津科技大学; 自动化学院