[发明专利]一种液压支架与刮板输送机的推移机构运动规划方法

说明书

本发明提供了一种液压支架与刮板输送机的推移机构运动规划方法，在液压支架上内嵌相关传感器获得的实时信息，采煤机截割过后，应用路径分割技术后利用笛卡尔路径规划方法对推移机构各结构的运动进行规划，得到基于各结构关键点的三维坐标关于时间维的运动规律，利用高斯滤波修正方法进行处理，得到最终修正轨迹。将获得的运动规律应用于Unity3D创建的煤层与虚拟煤机装备联合仿真系统中，将实时传感信息通过Unity3D中预留的接口接入虚拟环境进行联合规划，最终得到推移机构的规划后的运动。通过本发明，能够对推移机构各结构的运动进行规划，建立虚拟环境下液压支架与刮板输送机的协同推进与真实井下环境下的映射关系。

技术领域

本发明涉及路径规划技术领域，具体为一种液压支架与刮板输送机的推移机构运动规划方法。

背景技术

智能化开采是现代煤矿开采的目标，虚拟开采是实现开采智能化的关键之一。液压支架与刮板输送机的浮动连接机构具有多个自由度的空间运动，其运动对虚拟综采工作面协同推进具有重要作用，因而需要在虚拟环境下对液压支架与刮板输送机的浮动连接机构的运动进行规划。

申请号为CN202010102529.X公开了一种液压支架与刮板输送机浮动连接机构姿态描述方法，将推移机构转换为工业机器人模型，基于工业机器人逆向运动学的解析方法确定浮动连接机构的各运动参数关系式，由于逆向运动学的多解性，根据得到运动规律对机械手模型运动的实现度，根据逐级渐进筛选法，选择最优解，确定了浮动连接机构各结构的运动规律。

申请号为CN201811509303.0公开了一种综采面液压支架推移推杆位姿感知装置、综采面液压支架推移推杆机构及方法，在每个推移推杆的左、右两侧分别设有用于实时感知所述推移推杆位姿的左侧位姿感应单元和右侧位姿感应单元，中央信号处理单元根据左侧位姿感应单元所反馈的位移和根据右侧位姿感应单元所反馈的位移来感知推移推杆的偏移程度，并通过执行机构进行调整。

申请号为CN201910306404.6公开了一种在井下复杂地况的推溜过程模拟实验装置，液压支架底座模型与刮板输送机模型是通过推移机构模型连接构成，并通过推移路线结构模型实现刮板输送机推溜过程，推移机构前端通过连接头与输送机相连,它与液压支架底座通过推移千斤顶活塞杆前端相连接，而推移千斤顶的缸体与之铰接，通过该推移机构可以模拟推溜工作对刮板输送机进行推溜，并检测出刮板输送机的轨迹线,进行轨迹修正。

上述方法中，在获得推移机构各结构的运动参数时，需要安装传感器、相机等若干电子元器件，考虑到井下空间、光线限制、以及电磁干扰无线信号等影响因素，以及液压支架数目的限制，采用电子元器件获得推移机构的角度、推移距离具有一定的难度且未考虑到在真实情况下推移机构的运动特点，并且在进行理论分析时需要进行冗杂的计算，浮动连接机构最优解确定过程复杂。目前在液压支架与刮板输送机协同推进问题上，当液压支架推移刮板输送机时，推移机构存在多自由运动，阻碍了虚拟综采工作面的协同推进，因而需要对推移机构各结构的运动进行规划，建立虚拟环境下液压支架与刮板输送机的协同推进与真实井下环境下的映射关系。

发明内容

为解决上述技术问题，本发明将推移机构转换为机械手模型，在液压支架底座上内嵌相关传感器，通过虚实结合对推移机构各结构的运动进行规划，获得液压支架与刮板输送机浮动连接机构的运动。

为了解决上述技术问题，本发明提供了如下技术方案：一种液压支架与刮板输送机的推移机构运动规划方法，包括：

液压支架与刮板输送机的推移机构开始推移时，采用销耳间隙补偿法消除液压支架与刮板输送机之间的销耳间隙，并获取液压支架上内嵌传感器的实时感应信息；其中，内嵌传感器至少包括安装在液压支架底座上的红外测距仪、内嵌于底座两侧的倾角传感器、以及内嵌于推移杆内的陀螺仪；

采煤机截割过后，液压支架及时将刮板输送机推移一定距离，应用路径分割技术进行分割，并利用笛卡尔路径规划方法对推移机构各结构的运动进行规划，得到基于结构关键点的三维坐标关于时间维的运动规律；