1.一种受限硬岩巷道定向钻进劈裂施工方法,使用的定向钻进劈裂设备包括:机体;行走部,设于机体以带动机体移动;钻劈臂架,设于机体用于进行钻劈作业;破碎臂架,设于机体用于进行破碎作业;支撑部,设于机体用于支撑机体以在作业时保持稳定;液压系统,设于机体用于给钻劈臂架及破碎臂架提供动力;采集与控制中心,设于机体用于采集信息并控制行走部、钻劈臂架、破碎臂架及支撑部执行指令动作;钻劈臂架包括:大臂,一端可转动地设于机体,大臂通过驱动件驱动能够进行俯仰及摆动;小臂,可滑动地设于大臂的末端,小臂通过驱动件驱动能够进行伸缩;回转装置,可转动地设于小臂的末端,回转装置通过驱动件驱动能够进行俯仰、竖转、横转;钻进装置,设于回转装置,能够推进以执行钻进作业;劈裂装置,设于回转装置,能够推进以执行劈裂作业;破碎臂架包括:破碎臂架大臂,一端可转动地设于机体,破碎臂架大臂通过驱动件驱动能够进行俯仰;破碎臂架小臂,可转动地设于破碎臂架大臂末端,破碎臂架小臂通过驱动件驱动能够进行俯仰;破碎臂架破碎装置,设于破碎臂架小臂末端,用于进行破碎作业;行走部包括:四个行走履带,分别设于机体底部,通过马达驱动转动以带动机体行走;支撑部包括:四个支撑油缸,分别设于机体底部,能够伸出以支撑机体;所述采集与控制中心包括:激光标靶,通过位姿检测获得机体实际位姿;支撑油缸位移传感器,通过检测支撑部的支撑油缸位移获得支撑部的高度;深度视觉传感器,用于获取环境点云信息;多个编码器,分别用于获取大臂摆动、大臂俯仰、小臂伸缩、回转装置俯仰、回转装置竖转、回转装置横转信息;钻进装置与劈裂装置推进位移传感器,用于获取钻进装置与劈裂装置的推进位移信息;控制中心,根据采集的信息控制行走部、钻劈臂架、破碎臂架及支撑部执行对应动作;其特征在于,方法包括以下步骤:(1)根据目标行进位置,采集与控制中心发送行走指令,行走部带动机体行走至指定工作位置;
(2)根据目标机体位姿,采集与控制中心发送支撑指令,支撑部撑起机体;
(3)采集与控制中心发送钻进臂架控制指令,根据钻孔位置,调控钻劈臂架大臂;钻劈臂架小臂,钻劈臂架回转支撑装置;
(4)采集与控制中心发送钻进指令,推进钻进装置冲击钻孔,根据钻孔布置图,重复进行钻孔,直至布孔图所有钻孔完成钻进;
(5)采集与控制中心发送回转装置控制指令,调控回转支承装置使劈裂装置对准钻孔并劈裂剥落硬岩;
(6)采集与控制中心发送破碎臂架控制指令,调控破碎臂架大臂,破碎臂架小臂,破碎臂架破碎装置,进行大体积剥落硬岩破碎;
步骤(1)包括:
(101)采集与控制中心接收到基于基于激光标靶位姿检测获得的机体实际航行位姿,依据机体目标位姿,计算出此时行走部履带的转速;
(102)采集与控制中心基于计算得到的行走部履带的转速后,向行走履带的速度控制器下达工作指令,行走履带速度控制器在接收到工作指令后,控制行走履带的驱动系统,驱动受限硬岩巷道钻进劈裂装备行走,安装在行走履带驱动轮旁的角编码器会将马达转角转换成周期性的电信号,再将电信号转换成技术脉冲,进而检测行走履带的实际转速,确保行走履带达到指定速度;行走过程中,激光标靶会实时将巷道钻进劈裂设备行走过程中机体的实际位姿检测传输到采集与控制中心,供采集与控制中心判选是否继续进行航行位姿调控,若还需进行航行位姿调控,采集与控制中心会重复以上工作流程,并对进行航行位姿调控后的巷道钻进劈裂设备的实际航行位姿再次进行判选,直至巷道钻进劈裂设备实际航行位姿达到目标位姿状态;
步骤(2)包括:
(201)采集与控制中心接收基于激光标靶位姿检测获得的机体实际俯仰位姿,依据机体初始位姿,计算出此时支撑部支撑油缸的伸缩量;
(202)采集与控制中心基于计算得到的支撑油缸的伸缩量后,向支撑油缸位置控制器下达工作指令,支撑油缸位置控制器在接收到工作指令后,控制支撑油缸的驱动系统动作,开始对机体进行位姿调控,安装在支撑油缸内部的致磁伸缩位移传感器,利用致磁伸缩原理,通过两个不同磁场相交产生一个应变脉冲信号来准确地检测支撑油缸的伸缩量,确保支撑油缸伸缩到指定位置;激光标靶会继续将调控后机体实际位姿检测传输到采集与控制中心,供采集与控制中心判选是否继续进行俯仰与翻滚位姿调控,若还需进行俯仰与翻滚位姿调控,采集与控制中心会重复以上工作流程,并对进行俯仰与翻滚位姿调控后的巷道钻进劈裂设备的实际俯仰与航行位姿再次进行判选,直至巷道钻进劈裂设备实际俯仰与翻滚位姿达到初始位姿状态;
在钻进劈裂作业时,通过控制钻劈臂架关节运动补偿挠度误差与机体位姿偏差来实现受限硬岩巷道定向钻进劈裂作业,包括:
(301)采集与控制中心接收基于激光标靶检测获得的机体位姿调控后的位姿偏差以及钻涨臂架末端位置挠度误差,结合钻劈臂架的钻进装置与劈裂装置末端目标位姿和钻涨臂架末端挠度误差及机体位姿偏差修正方法,获得钻涨臂架大臂、小臂、回转装置、钻进装置、劈裂装置驱动关节修正运动参数,进而获得钻涨臂架大臂、小臂、回转装置、钻进装置、劈裂装置驱动关节控制目标;
(302)采集与控制中心的PID控制器基于接收到的钻涨臂架大臂、小臂、回转装置、钻进装置、劈裂装置驱动关节控制目标,以及由钻涨臂架大臂摆动编码器、大臂俯仰编码器、小臂伸缩编码器.回转装置俯仰编码器、回转装置竖转编码器、回转装置横转编码器、钻进装置与劈裂装置推进位移传感器采集得到的实际关节输出参数,对钻涨臂架大臂、回转装置、钻进装置、劈裂装置关节驱动系统下达控制指令;
(303)钻涨臂架大臂、小臂、回转装置、钻进装置、劈裂装置关节驱动系统根据控制指令驱动钻涨臂架大臂、小臂、回转装置、钻进装置、劈裂装置的关节进行运动;
(304)采集与控制中心接收基于激光标靶检测获得的钻劈臂架钻进装置与劈裂装置末端实际位姿,并与钻劈臂架钻进装置与劈裂装置末端目标位姿进行比较,判断是否继续进行钻劈臂架运动控制,若继续进行运动控制,则重复以上工作流程,并对进行运动控制后的钻劈臂架的末端实际位姿再次进行判选,直至完成钻劈臂架运动控制。
2.根据权利要求1所述的受限硬岩巷道定向钻进劈裂施工方法,其特征在于,当进行钻劈臂架、破碎臂架、破碎臂架协同作业时:
(401)采集与控制中心接受钻劈臂架钻进装置作业次数及钻劈臂架劈裂装置作业次数,根据钻劈臂架与破碎臂架关节参数计算钻劈臂架与破碎臂架运动空间,结合巷道空间确定钻劈臂架与破碎臂架运动限制;根据钻进-劈裂作业任务,计算钻劈臂架与破碎臂架各关节能耗、末端运动距离,评估钻进装置、裂装置作业效率;
(402)采集与控制中心接收基于深度视觉传感器获取环境点云信息,并对点云数据预处理:滤波、降采样、去噪,去除钻劈臂架、破碎臂架本体及底板点云后,构建包围盒树,进行障碍物碰撞检测,自适应生成臂架运动路径,在工作空间和构型空间内同时进行局部路径规划,对钻劈臂架与破碎臂架运动路径节点优化进而获得安全无碰撞可执行路径;
(403)采集与控制中心基于步骤(401)的运算结果,对钻劈臂架与破碎臂架进行任务分配,确定主从臂架,并根据机体位姿偏差、钻劈臂架与破碎臂架可达空间、钻进装置、劈裂装置利用率,修正钻劈臂架与破碎臂架进行任务;
(404)采集与控制中心将步骤(402)获得的安全无碰撞可执行路径及步骤(403)进行的钻劈臂架与破碎臂架任务分配结果下发给钻劈臂架与破碎臂架关节驱动系统,结合受限硬岩巷道定向钻进劈裂施工装备臂架补偿位姿偏差与挠度误差方法,进行多臂架协同作业控制。