[发明专利]一种用于硬岩巷道采矿机自动行走和纠偏的电控系统

说明书

技术领域

本发明涉及硬岩巷道掘进机领域中的一种用于硬岩巷道采矿机自动行走和纠偏的电控系统。

背景技术

巷道掘进机是我国煤矿井下生产中应用最广泛的机械装备。出于对煤矿生产能力和生产安全的考虑,提升煤矿掘进作业的自动化水平、减少掘进工作面操作人员的要求已是十分迫切,开发研制自动掘进机是解决该问题的必然方向。掘进机位置及姿态的自动测定和控制算法是全自动掘进机必须解决的核心问题，本设备的位置及姿态的自动测定是通过激光定位测量系统实现的，电控系统通过将激光定位测量系统检测到的机身位置及姿态信号与巷道设计的线路进行比对，如果出现偏差，则智能控制系统根据控制算法来控制相应的执行机构动作，进而实现机器的自动行走和纠偏。因此，研制一种用于硬岩巷道采矿机自动行走和纠偏的电控系统一直是急待解决的新课题。

发明内容

本发明的目的在于提供一种用于硬岩巷道采矿机自动行走和纠偏的电控系统，该装置将电控系统的模拟量输出信号通过比例放大器输出给执行机构电磁阀，再将通过激光定位测量系统检测到的信号反馈给PLC，形成闭环控制，在硬岩巷道采矿机进行行走和定位的过程中，系统需要采用自动行走和纠偏程序进行控制，对相应执行机构控制的实时性和位移传感器的精度要求极高，出现故障时对整个系统的联锁保护也要求的非常全面和严格。

本发明的目的是这样实现的：一种用于硬岩巷道采矿机自动行走和纠偏的电控系统，由主机电控系统和激光定位测量系统组成，主机电控系统包括隔离开关QS、真空接触器KM、阻容吸收器RC、电流互感器TA1、电压互感器CSP、隔离安全栅RW、片式继电器KA、微型断路器QF、PLC、油温传感器GWP200-C、油位传感器YW、甲烷浓度传感器GJT4/1000、位移传感器WY、防爆电铃DL9、防爆机车灯HL1-5、驱动电机YBU-160，阻容吸收器RC、电流互感器TA1串在主回路上，驱动电机YBU-160和真空接触器KM连接，所有的传感器信号和隔离安全栅RW连接，此连接是为了达到本安要求；激光定位测量系统包括本安型位姿检测装置、本安隔爆型激光指向装置、防爆型倾斜检测装置、防爆激光测距装置，激光定位测量系统与开关箱通过通讯和电源电缆连接；所述装置的工作原理及操作方法是，首先由激光定位测量系统测得采矿机偏角、偏距、俯仰角和翻滚角、车前距和机身中心高等位姿参数；再由位移传感器测出支撑油缸的位移量，然后PLC将这些测量信号与理论设计值进行比较，计算出相应的模拟量输出；通过一次变压器送电到开关箱在由开关箱内变压器变成相应的电压等级，箱内电压等级主要由3300V，1140V驱动电压组成，开关箱送电后系统先自检测甲烷浓度，驱动电机是否漏电，通讯是否正常，油温油位是否正常；开关箱供电后通过激光定位测量系统和位移传感器等采集的数据反馈到PLC，由PLC计算出相应的模拟量输出信号再经过PLVC放大，控制相应的电磁比例阀，进而驱动相应的行走履带，和相应的支撑油缸的伸出或缩回，再由激光定位测量系统和支撑油缸内的位移传感器和角度传感器来判断机身的位置和姿态是否行走到预定的位置和姿态，从而形成闭环控制系统 ，经过反复调整达到理想状态；闭环控制的目的是通过测量所得数据，分别控制6个支撑油缸，并重复其控制过程，使其整机中心线与工程巷道理想中心线偏差在工程要求范围内；其控制过程是：第一步测量整机位姿参数，并计算理想地平面补偿量，控制油缸伸长相应长度；第二步再进行整机位姿参数测量，并计算实际地平面补偿量，控制油缸伸长相应长度；第三步最后进行整机位姿参数测量，并计算控制误差补偿量，控制油缸伸长相应长度，从而达到工程控制要求；其控制参数如下：

支撑油缸A、B、C、D、E、F总伸长补偿量依次为：

ΔL₁、ΔL₂、ΔL₃、ΔL₄、ΔL₅、ΔL₆

支撑油缸A、B、C、D、E、F理想地平面补偿量依次为：

Δl₁、Δl₂、Δl₃、Δl₄、Δl₅、Δl₆

支撑油缸A、B、C、D、E、F实际地平面补偿量依次为：