一种隧道施工中拱架自动识别/拼装系统及拱架识别/拼装方法与流程

摘要: 本发明涉及隧道施工自动化装备,提供了一种隧道施工中拱架自动识别/拼装系统及拱架识别/拼装方法;特别涉及一种基于力位融合的拱架自动识别、定位与拼装的系统及方法。背...
一种隧道施工中拱架自动识别/拼装系统及拱架识别/拼装方法与流程

本发明涉及隧道施工自动化装备,提供了一种隧道施工中拱架自动识别/拼装系统及拱架识别/拼装方法;特别涉及一种基于力位融合的拱架自动识别、定位与拼装的系统及方法。

背景技术:

1、随着设备信息化智能化技术的不断发展,人口老龄化问题的不断加剧,机械化施工减人增效的需求不断扩大,隧道支护设备的自动化作业逐渐被推广应用。同时隧道支护作业中拱架的拼装,劳动强度大、危险性高,人工操作步骤较多且复杂,现有拱架拼装设备多为手动操作,自动化程度低。

2、基于上述技术发展趋势及原因,逐渐出现了拱架位姿测量的系统和方法的研究。

3、公布号为cn110375650a的中国发明专利申请公布文本公开了一种拱架位姿测量方法及系统,通过在拱架上设置反射片并利用定位装置扫描标记点,计算转换参数实现拱架位姿的精确测量和拼装,但在隧道光线恶劣的环境下标记易被污染或遮挡,鲁棒性差,且无法获取拱架整体轮廓信息,无法避免拼拱碰撞。

4、公布号为cn110593916a的中国发明专利申请公布文本公开了一种拱架调整设备及拱架调整方法,可实现拼拱架动作的调整但实时性较低。

5、因此,设计一种能够兼顾大范围高精度定位与智能拼装的拱架识别/拼装系统及方法很有必要。

技术实现思路

1、本发明的目的在于克服现有技术的不足,提供一种隧道施工中拱架自动识别/拼装系统及拱架识别/拼装方法,用以解决现有方案难以兼顾实时性与安全性的问题;设计了一种无需标记、能够兼顾大范围高精度定位与智能拼装的、能够有效服务于拱架台车的基于力位融合的拱架识别/拼装系统及方法。

2、为实现上述目的,本发明第一方面提供一种拱架识别/拼装方法,包括如下步骤:

3、1)在机械臂抓取拱架后,获得扫描机械臂的末端执行器抓取拱架后的工作区域形成的空间点云;

4、2)通过配准算法将空间点云与预存的拱架精确的三维模型进行配准,解算出拱架在隧道全局坐标系下的全局绝对位姿;

5、3)实时监测末端执行器在空间坐标系下三个方向的力和力矩;并生成位姿补偿控制信号;

6、4)根据所述全局绝对位姿对机械臂和末端执行器进行拱架位姿调整和快速拼装控制;还根据所述位姿补偿控制信号引导末端执行器完成拱架间的精细对位及装配控制。

7、本发明的有益效果为:

8、本发明能够结合激光雷达点云与拱架模型直接配准获取全局绝对位姿,避免了机械臂运动学链的累积误差,算法不依赖预设标记点,抗粉尘、水雾干扰能力强。“主从式”架构分工明确,主感知系统负责大范围高效定位与防撞,从控制系统负责小范围高精度装配,兼顾了效率与精度。利用六维力传感器及闭环控制,实现了高精度柔顺装配和主动防撞能力,避免了刚性碰撞。从激光雷达点云、中央控制器信息处理解算及控制信号输出执行形成了一套完整的自主拼装解决方案,自动化程度高。

9、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述步骤1)中,扫描所述工作区域形成工作空间点云,对工作空间点云进行降采样、滤波去噪、离群点剔除操作后得到预处理后的点云,作为所述空间点云。

10、上述方案的有益效果为:

11、对点云进行包括降采样、滤波去噪、离群点剔除操作的预处理,降低运算量的同时避免噪音对算法的干扰,提高控制精度。

12、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述降采样采用体素网格滤波。

13、上述方案的有益效果为:

14、通过体素网格滤波在保持点云几何特征基础之上降低点云数据量,降低算法对硬件的要求。

15、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述滤波去噪包括:对于待处理点云中的每个点,计算它到设定数量个最邻近点的平均距离,基于这些平均距离服从高斯分布计算整个点云中所有点的平均距离的平均值和标准差,根据平均值和标准差设置距离阈值,剔除平均距离大于距离阈值的点。

16、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述离群点剔除包括:对于待处理点云中的每个点,统计以其为中心、设定半径的球体内的点数,剔除所有点数小于预设点数阈值的点。

17、上述方案的有益效果为:

18、通过统计滤波去噪和半径滤波去噪,提高了点云数据的准确度,提高控制的精度。

19、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述步骤2)中,所述配准包括粗配准和精配准。

20、上述方案的有益效果为:

21、通过双重配准提高配准的准确度,同时兼顾了效率。

22、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述粗配准包括:计算所述空间点云中每个点的简化点特征直方图,进而形成fpfh特征向量,使用随机采样一致性算法估计变换矩阵。

23、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述精配准包括:初始化旋转矩阵和平移向量,对待处理点云中每个点在根据所述三维模型得到的目标点云中寻找欧式距离最近的对应点,删除距离大于预设值的点对,利用奇异值分解求解最优变换,对待处理点云中每个点应用所述最优变换直到满足停止迭代条件,输出此时旋转矩阵和平移向量,由旋转矩阵和平移向量构成齐次变换矩阵,根据齐次变换矩阵得到所述全局绝对位姿。

24、根据本发明第一方面所述的拱架识别/拼装方法,在一种可能实现的方式中,所述步骤3)中,采用导纳控制策略反馈生成位姿补偿控制信号。

25、上述方案的有益效果为:

26、采用导纳控制策略,精度高、适应性强的柔性控制,实现了拱架快速拼装到精细对位装配的全流程自动化。

27、本发明第二方面提供一种拱架自动识别/拼装系统,包括存储器、处理器及存储在存储器上的计算机程序,所述处理器执行所述计算机程序以实现包括如下步骤的拱架识别/拼装方法:

28、1)在机械臂抓取拱架后,获得扫描机械臂的末端执行器抓取拱架后的工作区域形成的空间点云;

29、2)通过配准算法将空间点云与预存的拱架精确的三维模型进行配准,解算出拱架在隧道全局坐标系下的全局绝对位姿;

30、3)实时监测末端执行器在空间坐标系下三个方向的力和力矩;并生成位姿补偿控制信号;

31、4)根据所述全局绝对位姿对机械臂和末端执行器进行拱架位姿调整和快速拼装控制;还根据所述位姿补偿控制信号引导末端执行器完成拱架间的精细对位及装配控制。

32、本发明的有益效果为:

33、本发明能够结合激光雷达点云与拱架模型直接配准获取全局绝对位姿,避免了机械臂运动学链的累积误差,算法不依赖预设标记点,抗粉尘、水雾干扰能力强。“主从式”架构分工明确,主感知系统负责大范围高效定位与防撞,从控制系统负责小范围高精度装配,兼顾了效率与精度。利用六维力传感器及闭环控制,实现了高精度柔顺装配和主动防撞能力,避免了刚性碰撞。从激光雷达点云、中央控制器信息处理解算及控制信号输出执行形成了一套完整的自主拼装解决方案,自动化程度高。

34、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述步骤1)中,扫描所述工作区域形成工作空间点云,对工作空间点云进行降采样、滤波去噪、离群点剔除操作后得到预处理后的点云,作为所述空间点云。

35、上述方案的有益效果为:

36、对点云进行包括降采样、滤波去噪、离群点剔除操作的预处理,降低运算量的同时避免噪音对算法的干扰,提高控制精度。

37、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述降采样采用体素网格滤波。

38、上述方案的有益效果为:

39、通过体素网格滤波在保持点云几何特征基础之上降低点云数据量,降低算法对硬件的要求。

40、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述滤波去噪包括:对于待处理点云中的每个点,计算它到设定数量个最邻近点的平均距离,基于这些平均距离服从高斯分布计算整个点云中所有点的平均距离的平均值和标准差,根据平均值和标准差设置距离阈值,剔除平均距离大于距离阈值的点。

41、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述离群点剔除包括:对于待处理点云中的每个点,统计以其为中心、设定半径的球体内的点数,剔除所有点数小于预设点数阈值的点。

42、上述方案的有益效果为:

43、通过统计滤波去噪和半径滤波去噪,提高了点云数据的准确度,提高控制的精度。

44、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述步骤2)中,所述配准包括粗配准和精配准。

45、上述方案的有益效果为:

46、通过双重配准提高配准的准确度,同时兼顾了效率。

47、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述粗配准包括:计算所述空间点云中每个点的简化点特征直方图,进而形成fpfh特征向量,使用随机采样一致性算法估计变换矩阵。

48、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述精配准包括:初始化旋转矩阵和平移向量,对待处理点云中每个点在根据所述三维模型得到的目标点云中寻找欧式距离最近的对应点,删除距离大于预设值的点对,利用奇异值分解求解最优变换,对待处理点云中每个点应用所述最优变换直到满足停止迭代条件,输出此时旋转矩阵和平移向量,由旋转矩阵和平移向量构成齐次变换矩阵,根据齐次变换矩阵得到所述全局绝对位姿。

49、根据本发明第二方面所述的拱架自动识别/拼装系统,在一种可能实现的方式中,所述步骤3)中,采用导纳控制策略反馈生成位姿补偿控制信号。

50、上述方案的有益效果为:

51、采用导纳控制策略,精度高、适应性强的柔性控制,实现了拱架快速拼装到精细对位装配的全流程自动化。