[发明专利]基于摄像头和航姿仪的掘进自动导向系统及导向方法

说明书

技术领域

本发明涉及掘进机位姿测量技术领域，具体涉及一种基于摄像头和航姿仪的掘进自动导向系统及导向方法。

技术背景

目前，我国的巷道掘进导向技术一般采用激光指向仪，掘进机驾驶员通过目视端面上的激光光斑控制掘进机截割头在断面上截割运行，由于测量工作只能在掘进机停止截割的间隙中进行，因此测量浪费大量的时间，工作强度大，掘进的质量完全取决于驾驶员的熟练程度和经验，测量结果的准确性无法得到保证。

为解决以上问题，国内外的相关研究人员提出了很多的解决方案，公开号为CN101629807的中国专利《掘进机机身位姿测量系统及其方法》提出了利用扇形激光束在掘进机机身形成线性光斑，依靠带有光敏元件的激光标靶来产生电流信号，经过处理后得出掘进机的偏向角和偏向位移的方案。但是该方案在扇形激光束的获取上很有难度，且扇形激光束的加工工艺和精度难以保证。公开号为CN101266134A的中国专利《悬臂机头位姿的测量系统及其方法》提出了利用激光机动全站仪发射激光到掘进机，经过棱镜反射，再对反射回来的激光信号进行接收，然后通过无线信号的传输到达掘进机内的计算机，一次性地测量掘进机的全部位姿参数的方案。该方案虽理论上可行，但具有操作复杂，对操作人员要求高，成本高等缺点，不易推广使用。

发明内容

本发明的目的是针对上述技术问题，提供一种基于摄像头和航姿仪的掘进自动导向系统及导向方法，该导向系统和导线方法将CCD（Charge-coupled Device，电荷耦合元件）摄像头捕获激光光斑与航姿仪相结合，完成掘进机机身位姿参数（包括水平偏向位移和偏向角）的测量，并可根据偏向位移和偏向角对掘进机进行自动纠偏，实现掘进机的自动导向。

为实现此目的，本发明所设计的基于摄像头和航姿仪的掘进自动导向系统，它包括设置在掘进机机身上的掘进机控制模块，其特征在于：它还包括设置在掘进机机身上的激光靶面、CCD摄像头、航姿仪、数据采集模块、中央处理器以及设置在掘进巷道上的激光指向仪，所述激光指向仪位于掘进机机身后方，其中，所述激光指向仪的激光发射头对准激光靶面的中心，所述CCD摄像头投射在激光靶面上，所述CCD摄像头的信号输出端连接数据采集模块，航姿仪的信号输出端连接中央处理器，所述数据采集模块的通信端连接中央处理器的通信端，中央处理器的控制信号输出端连接掘进机控制模块的控制信号输入端。

本发明还包括分别设置在掘进机机身四个角上的四个光电开关，所述每个光电开关的信号输出端均连接中央处理器。

所述数据采集模块的通信端通过SPI（Serial Peripheral Interface，串行外围设备接口）总线连接中央处理器的通信端；所述航姿仪的信号输出端通过RS485总线连接中央处理器；所述中央处理器的控制信号输出端通过CAN (Controller Area Network,控制器局域网络)总线连接掘进机控制模块的控制信号输入端。

所述每个光电开关的信号输出端均通过RS485总线连接中央处理器。

一种基于摄像头和航姿仪的掘进自动导向系统的导向方法，其特征在于，它包括如下步骤：

步骤1:打开激光指向仪，并控制激光指向仪射出与掘进巷道平行的激光，该激光打在激光靶面的中心；

步骤2：掘进机开始工作并向前运动，CCD摄像头捕获激光靶面上的激光光斑，数据采集模块采集到激光光斑实时位置数据，数据采集模块将激光光斑实时位置数据传输给中央处理器，中央处理器运算得到实时激光光斑中心点坐标，通过实时激光光斑中心点坐标得到掘进机的实时水平偏向位移，所述水平偏向位移为在水平方向上偏离中心的距离；

步骤3：在掘进机向前运动的过程中，航姿仪实时采集掘进机运动时的偏向角，并将掘进机的实时偏向角数据输送到中央处理器；

步骤4：中央处理器将掘进机的实时水平偏向位移和掘进机的实时偏向角数据输送给掘进机控制模块，掘进机控制模块根据上述掘进机的实时水平偏向位移和掘进机的实时偏向角数据发出控制指令使掘进机进行动态纠偏，实现自动导向。

所述步骤4中，掘进机控制模块根据上述掘进机的实时水平偏向位移和掘进机的实时偏向角数据发出控制指令使掘进机进行动态纠偏的具体方法是：掘进机控制模块获取掘进机的水平偏向位移和偏向角后，首先掘进机控制模块调整掘进机右轮的速度，从而调整掘进机的偏向角，当掘进机的偏向角调整为0度时，再继续通过掘进机控制模块调整掘进机右轮的速度，从而调整掘进机的水平偏向位移，这样不断重复，若掘进机右偏则调慢掘进机右轮速度，若掘进机左偏则调快掘进机右轮速度；