智能采矿台车的路径规划方法、工控机及智能采矿台车与流程

摘要: 本发明涉及路径规划,尤其涉及一种智能采矿台车的路径规划方法、工控机及智能采矿台车。背景技术:1、采矿台车用于地下矿山钻凿炮孔。传统作业时,操作人员位于台车操作平...
智能采矿台车的路径规划方法、工控机及智能采矿台车与流程

本发明涉及路径规划,尤其涉及一种智能采矿台车的路径规划方法、工控机及智能采矿台车。

背景技术:

1、采矿台车用于地下矿山钻凿炮孔。传统作业时,操作人员位于台车操作平台,操控工作机构移动,使钻头对准目标孔,支撑推进器,进行钻孔。井下巷道断面通常狭窄,轮廓受围岩条件影响呈不规则形状。操作人员处于地下巷道,面临围岩失稳、粉尘、噪声、有害气体等风险。为减少人员暴露在风险下,智能采矿台车应运而生。智能采矿台车用于使操作人员转移至地面,由台车自动完成钻孔,操作人员在地面进行状态监控和异常干预。

2、现有自动钻孔控制方法主要包括两种,第一种方法通过按预设顺序依次驱动关节,但是这种方法从当前位置运动至目标位置时,运动路径固定,空行程较多。第二种方法在离散位置进行碰撞检测,以进行自动钻孔。上述所提供的两种方法在狭窄且不规则的巷道中,从当前位置运动至目标位置的运动路径筛选能力不足,容易产生较多关节动作、较长空行程、并且还可能涉及到反复调整和碰撞处理,导致自动钻孔效率降低。

3、因此,现阶段需要一种智能采矿台车的路径规划方法,以提高钻孔效率。

技术实现思路

1、本发明实施例提供了一种智能采矿台车的路径规划方法、工控机及智能采矿台车,以解决现阶段智能采矿台车的路径规划方法导致钻孔效率低的问题。

2、第一方面,本发明实施例提供了一种智能采矿台车的路径规划方法,包括:

3、针对预设钻孔序列中的任意一个目标孔位,读取目标智能采矿台车的钻头位于目标孔位的垂线上时目标智能采矿台车的各关节当前值;

4、获取该目标孔位下,预先确定的各关节目标值;

5、根据各关节当前值和各关节目标值构建初始路径规划方案;

6、按照初始路径规划方案,根据目标智能采矿台车的推进器和预先确定的巷道轮廓进行碰撞检测,以得到检测结果;

7、根据检测结果对初始路径规划方案进行调整,得到目标智能采矿台车的目标路径规划方案。

8、在一种可能的实现方式中,根据各关节当前值和各关节目标值构建初始路径规划方案,包括:

9、比较各关节当前值和各关节目标值,确定数值不同的关节;

10、按照预设动作顺序,每次调整一个关节动作,依次将数值不同的关节调整至相应的关节目标值,生成多行关节值向量;

11、将多行关节值向量作为初始路径规划方案。

12、在一种可能的实现方式中,各关节当前值和各关节目标值中分别包括俯仰关节值、平移关节值、旋转关节值和补偿关节值;补偿关节值用于调节推进器沿目标孔位的轴线方向的伸缩位置;预设动作顺序依次为俯仰关节运动、平移关节运动、旋转关节运动。

13、在一种可能的实现方式中,按照初始路径规划方案,根据目标智能采矿台车的推进器和预先确定的巷道轮廓进行碰撞检测,以得到检测结果,包括:

14、从初始路径规划方案中依次选取相邻两行关节值向量,并将所选取的相邻两行关节值向量之间的运动过程确定为运动区间,以得到至少一组运动区间;

15、针对任意一组运动区间,按照预设采样规则,确定多个中间关节值向量;

16、在每个中间关节值向量下,计算目标智能采矿台车的推进器与预先确定的巷道轮廓之间的安全距离;

17、基于安全距离进行碰撞检测,以得到检测结果。

18、在一种可能的实现方式中,基于安全距离进行碰撞检测,以得到检测结果,包括:

19、若任意一组运动区间内的所有每个中间关节值向量下,对应的安全距离均不小于预设安全距离阈值,则确定该组运动区间无碰撞;

20、若任意一组运动区间内存在中间关节值向量下,对应的安全距离小于预设安全距离阈值,则确定该组运动区间存在碰撞,并记录发生碰撞时的中间关节值向量;

21、遍历初始路径规划方案中的各组运动区间,得到检测结果。

22、在一种可能的实现方式中,根据检测结果对初始路径规划方案进行调整,得到目标智能采矿台车的目标路径规划方案,包括:

23、从检测结果中提取发生碰撞的运动区间,并确定其发生碰撞时的中间关节值向量;

24、保持该发生碰撞时的中间关节值向量中的俯仰关节值、平移关节值和旋转关节值不变,调整其中的补偿关节值;

25、基于调整后的中间关节值向量,计算推进器与预先确定的巷道轮廓之间的调整后的安全距离;

26、若调整后的安全距离不小于预设安全距离阈值,则判断在采用调整后的补偿关节值的情况下,该运动区间的起始行关节值向量所对应的推进器与预先确定的巷道轮廓之间的安全距离是否不小于预设安全距离阈值;

27、若是,则将初始路径规划方案中该运动区间对应的补偿关节值更新为调整后的补偿关节值,并对更新后的该运动区间进行碰撞检测,以得到目标路径规划方案。

28、在一种可能的实现方式中,若否,该方法还包括:

29、在该运动区间的起始行关节值向量之后依次插入第一关节值向量和第二关节值向量;其中,第一关节值向量为发生碰撞时的中间关节值向量;第二关节值向量中的俯仰关节值、平移关节值和旋转关节值为发生碰撞时的中间关节值向量中的俯仰关节值、平移关节值和旋转关节值,补偿关节值为调整后的补偿关节值;

30、将第二关节值向量之后各行关节值向量中的补偿关节值更新为调整后的补偿关节值,并对该调整后的各行关节值向量进行碰撞检测;

31、若均未发生碰撞,则基于调整后的各行关节值向量,确定目标路径规划方案;

32、若发生碰撞,则确定新的发生碰撞时的中间关节值向量,并返回保持该发生碰撞时的中间关节值向量中的俯仰关节值、平移关节值和旋转关节值不变,调整其中的补偿关节值的步骤。

33、在一种可能的实现方式中,各关节目标值通过以下方式确定:

34、根据预先获取的标定关节值组,计算目标智能采矿台车的钻头相对于车体坐标系的标定位姿矩阵;其中,标定关节值组为钻头位于标定目标孔的垂线上时各关节的值;

35、根据标定目标孔在巷道断面坐标系中的位姿和标定位姿矩阵,计算钻头位于目标孔位的垂线上时车体坐标系相对于巷道断面坐标系的车体位姿矩阵;

36、结合各目标孔在巷道断面坐标系中的位姿和车体位姿矩阵,计算所述钻头位于所述目标孔位的垂线上时相对于车体坐标系的目标位姿矩阵;

37、对目标位姿矩阵进行逆解,得到在该目标孔位下的各关节目标值。

38、第二方面,本发明实施例提供了一种工控机,包括存储器和处理器,存储器存储有计算机程序,处理器执行该计算机程序时实现如上第一方面或第一方面的任一种可能的实现方式中的方法。

39、第三方面,本发明实施例提供了一种智能采矿台车,包括如上第二方面所提供的工控机。

40、本发明实施例中,针对预设钻孔序列中的目标孔位,以该目标孔位下的各关节目标值为基准,构建初始路径规划方案,使目标智能采矿台车的钻头由各关节当前值调整至各关节目标值。在该过程中,对初始路径规划方案进行模拟运行,并在预先确定的巷道轮廓中进行碰撞检测,以防止运动过程中发生碰撞。若检测到碰撞,则对初始路径规划方案进行调整,直至无碰撞发生,得到目标路径规划方案。该目标路径规划方案用于控制目标智能采矿台车从当前位置运动至目标位置,减少对人工示教的依赖,减少无效关节动作,缩短空行程,减少钻孔过程中因推进器与巷道轮廓碰撞而导致的停机、退回、重新调整和人工干预。对预设钻孔序列中的多个目标孔位分别执行规划,可在规划阶段逐个完成各目标孔位的碰撞处理,降低多孔连续钻孔的运动规划复杂程度,提高自动钻孔效率。