基于直线定位模型的掘进机机身位姿单目视觉测量方法

摘要

本发明公开了一种基于直线定位模型的掘进机机身位姿单目视觉测量方法，通过摄像机对激光束图像进行采集，利用Hough变换对采集的激光束进行直线检测，分别得到平行激光束和水平激光束的直线方程；建立基于两点三线的掘进机位姿解算模型，根据水平激光束的直线方程和平行激光束的直线方程，得到摄像机在定位模型坐标系下的位姿信息，结合掘进机机身坐标系与摄像机坐标系间的转换关系，得到掘进机机身在定位模型坐标下的位姿信息；最后采用全站仪测量激光指向仪绝对坐标，获得激光指向仪在巷道坐标系下坐标，从而得到定位模型坐标系与巷道坐标系的转换关系，结合掘进机机身在定位模型坐标下的位姿信息，最终得到掘进机机身在巷道坐标下的俯仰角、偏航角、翻滚角和位置信息。