[发明专利]一种井下快速定位炮孔进行自动装药的方法

说明书

技术领域

本发明属于矿山爆破技术领域，特别是涉及一种井下快速定位炮孔进行自动装药的方法。

背景技术

矿山爆破作业中，在炮孔内装填炸药是一个非常重要的环节，现阶段，在炮孔内装填炸药的方式主要有两种，一种是以纯人工的方式进行炸药的填装，工人通过炮棍将成品炸药塞入炮孔内，或是工人将输药管塞入炮孔进行散装炸药的填装，但是纯人工装药使工人的劳动强度非常大，且安全性差；另一种是通过人工手动控制装药机械臂，通过机械臂末端的送管装置将输药管送入炮孔进行散装炸药的填装，但是该种方式对操作人员的技术水平要求非常高，要想人工手动控制装药机械臂实现送管装置的对孔非常困难，且对孔时操作过程繁琐，对孔时间普遍很长。

发明内容

针对现有技术存在的问题，本发明提供一种井下快速定位炮孔进行自动装药的方法，该方法通过在装药机械臂上加装结构光视觉系统，通过结构光视觉系统来控制装药机械臂的动作，并能实现自动控制机械臂末端送管装置进行对孔，且对孔精度高，面对井下的恶劣条件，能够完成从一个炮孔到另一个炮孔的自动定位，不但解决了传统方式中纯人工装药的工人劳动强度非常大及安全性差的问题，还解决了人工手动控制装药机械臂的对孔困难、操作过程繁琐及对孔时间长的问题。

为了实现上述目的，本发明采用如下技术方案：一种井下快速定位炮孔进行自动装药的方法，包括以下步骤：

步骤一：确定作业现场坐标系

所述作业现场坐标系包括炮孔坐标系O_P-x_py_pz_p、机械臂基座坐标系O₀-x₀y₀z₀、送管装置坐标系O_T-x_Ty_Tz_T及摄像机坐标系O_C-x_Cy_Cz_C，其中O_P为炮孔坐标系原点，x_p、y_p、z_p为炮孔坐标系坐标，O₀为机械臂基座坐标系原点，x₀、y₀、z₀为机械臂基座坐标系坐标，O_T为送管装置坐标系原点，x_T、y_T、z_T为送管装置坐标系坐标，O_C为摄像机坐标系原点，x_C、y_C、z_C为摄像机坐标系坐标；

步骤二：选定一个需要定位的炮孔P₁，完成炮孔P₁的对孔及装药作业

炮孔P₁为第一个填装炸药的炮孔，对孔前，首先手动控制机械臂移动，使炮孔P₁进入结构光视觉系统的摄像机视野中，此时结构光视觉系统会通过摄像机自动扫描炮孔P₁，并记录下炮孔P₁的空间位置坐标数据，根据摄像机坐标系到机械臂基座坐标系的变换矩阵驱动机械臂，使机械臂移向炮孔P₁，再根据送管装置坐标系到机械臂基座坐标系的变换矩阵驱动送管装置对准炮孔P₁，其中和均为事先对摄像机进行标定时获得的已知量，已经存储在结构光视觉系统内；然后结构光视觉系统会控制送管装置将输药管送入炮孔P₁内，完成炮孔P₁的装药工作；

步骤三：自动定位第二个炮孔P₂，完成炮孔P₂的对孔及装药作业

确定炮孔P₁在炮孔坐标系的位置矢量为^PP₁，而^PP₁=P（u,v,w）=[u₁ v₁ w₁ 1]^T，其中u₁,v₁,w₁为炮孔P₁的坐标值；

确定炮孔P₁在机械臂基座坐标系的位置矢量为⁰P₁；