跟管钻机的位姿调整方法、设备及存储介质与流程
本发明属于机械控制,涉及跟管钻机的位姿调整方法、设备及存储介质。
背景技术:
1、在矿山救援、隧道施工等紧急作业中,大直径跟管钻机是构建生命通道的关键装备,其钻孔轨迹的精度直接关系到救援效率与安全性。跟管钻机在复杂地层如坍塌体、破碎岩层中施工时,受地层不均、金属障碍物等因素影响,钻机位姿容易发生变化,导致钻孔偏离预设路径,尤其在长距离钻进中,误差累积可能引发卡钻、孔壁坍塌等严重事故,救援安全性较低。
技术实现思路
1、针对现有技术中存在的不足,本发明的目的在于,提供一种跟管钻机的位姿调整方法、设备及存储介质,解决如何自动调整跟管钻机的位姿以提高救援安全度的技术问题。
2、为了解决上述技术问题,本发明采用如下技术方案予以实现:
3、跟管钻机的位姿调整方法,包括以下步骤:
4、步骤s10,在预设采集时刻,获取跟管钻机的目标构件上预设的位姿测量点的当前位姿参数和当前理论控制参数,并根据当前位姿参数与当前理论控制参数之间的差值确定当前位姿误差;
5、步骤s20,读取存储的上一采集时刻的前置位姿误差,确定上一采集时刻的前置位姿误差与所述当前位姿误差之间的误差变化量,以及确定上一采集时刻各个所述位姿测量点的理论控制参数与所述当前理论控制参数之间的理论控制参数变化量;
6、步骤s30,通过多项式插值算法,确定所述误差变化量与对应的所述前置位姿误差、当前位姿误差和所述理论控制参数变化量之间的函数关系;
7、步骤s40,基于所述函数关系和下一采集时刻的理论控制参数,确定下一采集时刻对应的预测误差变化量,并将预测误差变化量与当前位姿误差之和作为综合误差;
8、步骤s50,根据所述综合误差确定下一采集时刻对应的补偿控制参数;
9、步骤s60,基于所述补偿控制参数向目标构件发出控制指令,以调整跟管钻机的位姿。
10、本发明还包括如下技术特征:
11、具体的,所述步骤s50包括:
12、根据控制参数与位姿变化量之间的映射关系确定补偿矩阵,所述补偿矩阵用于表示预设单位的控制参数变化引起的位姿变化量的变化;
13、将所述补偿矩阵和所述综合误差作为预设补偿方程的输入参数,求解所述补偿方程的解,得到所述补偿控制参数。
14、具体的,所述目标构件包括偏置油缸,所述偏置油缸的缸筒端通过铰接点固定于跟管套管的头部,所述偏置油缸的活塞杆端通过另一铰接点连接可调导向头的尾部,所述可调导向头通过铰链轴与跟管套管的头部连接,所述可调导向头可通过所述铰链轴上下摆动。
15、具体的,当所述目标构件为所述偏置油缸时,所述位姿测量点设置于螺旋钻杆内部,以及所述偏置油缸的活塞杆与缸筒连接处;
16、在达到预设的采集时刻时,获取到的所述偏置油缸上所述位姿测量点的当前位姿参数包括所述螺旋钻杆内部的陀螺仪传感器采集到的当前第一倾角,以及所述活塞杆与缸筒连接处的传感器采集到的活塞杆的当前位移;
17、在达到预设的采集时刻时,获取到的所述偏置油缸上所述位姿测量点的当前理论控制参数包括所述偏置油缸的伸出量和伸出速度。
18、具体的,所述补偿控制参数包括所述偏置油缸的补偿伸出量和补偿伸出速度;
19、所述基于所述补偿控制参数向目标构件发出控制指令,以调整所述跟管钻机的位姿的步骤包括:
20、基于所述偏置油缸的补偿伸出量和补偿伸出速度,控制所述偏置油缸的活塞杆伸出,以推动所述可调导向头绕所述铰链轴旋转形成导向角,调节所述螺旋钻杆的倾角;其中,所述偏置油缸的伸出量越大,所述导向角越大,所述螺旋钻杆的倾角越大。
21、具体的,所述目标构件还包括所述跟管钻机的液压支腿,所述液压支腿由电液控制的支撑油缸驱动;所述支撑油缸的缸筒端通过铰接底座连接钻机底盘或固定安装于钻机底盘,所述支撑油缸的活塞杆端通过支撑脚盘与地面接触。
22、具体的,当目标构件为液压支腿时,所述位姿测量点设置于所述跟管钻机的机身,以及所述液压支腿的液压回路中;
23、在达到预设的采集时刻时,获取到的所述液压支腿上所述位姿测量点的当前位姿参数包括所述机身上预设测量点处的传感器采集的当前第二倾角和各个所述液压支腿的液压回路中压力传感器的当前压力;
24、在达到预设的采集时刻时,获取到的所述液压支腿上所述位姿测量点的当前理论控制参数包括所述支撑油缸的伸出量和伸出速度。
25、具体的,所述补偿控制参数包括所述支撑油缸的补偿伸出量和补偿伸出速度;
26、所述基于所述补偿控制参数向目标构件发出控制指令,以调整所述跟管钻机的位姿的步骤包括:
27、基于所述支撑油缸的补偿伸出量和补偿伸出速度,控制所述液压支腿的电液比例阀或伺服阀驱动液压油流入或流出所述支撑油缸,以使所述支撑油缸的活塞杆伸缩,以调节所述跟管钻机的位姿。
28、一种跟管钻机的位姿调整设备,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现所述的跟管钻机的位姿调整方法的步骤。
29、一种存储介质所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现所述的跟管钻机的位姿调整方法的步骤。
30、本发明与现有技术相比,具有如下技术效果:
31、本发明跟管钻机的位姿调整方法,在达到预设的采集时刻时,获取跟管钻机的目标构件上预设的位姿测量点的当前位姿参数和当前理论控制参数,并根据当前位姿参数与当前理论位姿参数之间的差值确定当前位姿误差;确定上一采集时刻的前置位姿误差与当前位姿误差之间的误差变化量,以及确定上一采集时刻各个位姿测量点的理论控制参数与当前理论控制参数之间的理论控制参数变化量;通过多项式插值算法,确定误差变化量与对应的前置位姿误差、当前位姿误差和理论控制参数变化量之间的函数关系;基于函数关系和下一采集时刻的理论控制参数,确定下一采集时刻对应的预测误差变化量,并将预测误差变化量与当前位姿误差之和作为综合误差;根据综合误差确定下一采集时刻对应的补偿控制参数;基于补偿控制参数向目标构件发出控制指令,以调整跟管钻机的位姿。
32、本发明通过实时采集位姿测量点的当前位姿参数与当前理论控制参数,精准计算当前位姿误差,同时捕捉上一采集时刻与当前采集时刻的误差变化量、理论控制参数变化量,再通过多项式插值算法构建多参数关联的函数关系,可精准预测下一采集时刻的误差变化趋势。基于该预测结果得到综合误差,进而确定补偿控制参数,实现对位姿偏差的提前预判和主动补偿,快速响应地层不均、金属障碍物等因素引发的微小位姿变化,及时通过补偿控制参数调整目标构件动作,避免偏差扩大,有效规避因误差累积导致的卡钻、孔壁坍塌等严重事故,提升救援安全性。
1.跟管钻机的位姿调整方法,其特征在于,包括以下步骤:
2.如权利要求1所述的跟管钻机的位姿调整方法,其特征在于,所述步骤s50包括:
3.如权利要求1所述的跟管钻机的位姿调整方法,其特征在于,所述目标构件包括偏置油缸,所述偏置油缸的缸筒端通过铰接点固定于跟管套管的头部,所述偏置油缸的活塞杆端通过另一铰接点连接可调导向头的尾部,所述可调导向头通过铰链轴与跟管套管的头部连接,所述可调导向头可通过所述铰链轴上下摆动。
4.如权利要求3所述的跟管钻机的位姿调整方法,其特征在于,当所述目标构件为所述偏置油缸时,所述位姿测量点设置于螺旋钻杆内部,以及所述偏置油缸的活塞杆与缸筒连接处;
5.如权利要求4所述的跟管钻机的位姿调整方法,其特征在于,所述补偿控制参数包括所述偏置油缸的补偿伸出量和补偿伸出速度;
6.如权利要求1所述的跟管钻机的位姿调整方法,其特征在于,所述目标构件还包括所述跟管钻机的液压支腿,所述液压支腿由电液控制的支撑油缸驱动;所述支撑油缸的缸筒端通过铰接底座连接钻机底盘或固定安装于钻机底盘,所述支撑油缸的活塞杆端通过支撑脚盘与地面接触。
7.如权利要求6所述的跟管钻机的位姿调整方法,其特征在于,当目标构件为液压支腿时,所述位姿测量点设置于所述跟管钻机的机身,以及所述液压支腿的液压回路中;
8.如权利要求7所述的跟管钻机的位姿调整方法,其特征在于,所述补偿控制参数包括所述支撑油缸的补偿伸出量和补偿伸出速度;
9.一种跟管钻机的位姿调整设备,其特征在于,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现如权利要求1至8中任一项所述的跟管钻机的位姿调整方法的步骤。
10.一种存储介质,其特征在于,所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至8中任一项所述的跟管钻机的位姿调整方法的步骤。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com