基于图像检测的收料牵引墙板位置感知方法、装置和设备与流程

摘要: 本发明涉及收料牵引墙板,尤其涉及基于图像检测的收料牵引墙板位置感知方法、装置和设备。背景技术:1、在墙板收料牵引设备中,两侧牵引墙板(又称浮动墙板)是保证收卷精...
基于图像检测的收料牵引墙板位置感知方法、装置和设备与流程

本发明涉及收料牵引墙板,尤其涉及基于图像检测的收料牵引墙板位置感知方法、装置和设备。

背景技术:

1、在墙板收料牵引设备中,两侧牵引墙板(又称浮动墙板)是保证收卷精度和输送精度的关键部件。收卷辊、导滑辊等核心执行部件均设置在牵引墙板上,两侧牵引墙板必须保持精确的同步移动和正确的空间方位,才能确保收料过程的精准性。传统校正方式依赖人工目视检测与手动调整,效率低下且精度难以保证。操作人员通过观察和经验判断墙板是否偏移,再通过机械手段进行粗放式调整,无法满足现代高速生产线对精度的要求。而且现有校正装置多采用单一的机械限位或液压推动方式,缺乏多维度的位置感知能力。校正动作通常仅在一个或两个自由度上进行,无法同时对平移偏差、旋转偏差和姿态偏差进行综合校正。

技术实现思路

1、本发明克服了现有技术的不足,提供了基于图像检测的收料牵引墙板位置感知方法、装置和设备。

2、为达上述目的,本发明采用的技术方案为:

3、本发明第一方面提供基于图像检测的收料牵引墙板位置感知方法,包括以下步骤:

4、在牵引墙板两侧及上方安装多源数据采集设备,利用所述多源数据采集设备采集图像、imu姿态数据、激光位移数据和磁栅尺位置数据;

5、根据所述图像、imu姿态数据、激光位移数据和磁栅尺位置数据计算出各驱动关节的指令位移量和旋转量,同时,在牵引墙板与校正执行机构的连接处安装六维力/力矩传感器实时测量三个方向的力和三个方向的力;

6、构建阻抗控制方程,结合所述阻抗控制方程和三个方向的力、三个方向的力实时计算最优的阻抗参数组合,基于阻抗控制方程,将期望的阻抗参数和当前的力觉反馈代入计算,得到位置修正量;

7、根据所述各驱动关节的指令位移量和旋转量以及位置修正量对收料牵引墙板位置进行修正。

8、进一步的,在基于图像检测的收料牵引墙板位置感知方法中,在牵引墙板两侧及上方安装多源数据采集设备,利用所述多源数据采集设备采集图像、imu姿态数据、激光位移数据和磁栅尺位置数据,具体包括:

9、在牵引墙板两侧及上方安装至少4组高分辨率工业相机,配合环形led光源,对墙板表面预设的多个特征标记点进行同步图像采集,采集图像数据;

10、在两侧牵引墙板的顶部和底部各安装一个六轴imu传感器,实时采集墙板的角速度、加速度数据,用于感知墙板的动态姿态变化数据;

11、在牵引墙板运行轨道两侧沿线布置不少于8个激光位移传感器,形成线性传感阵列,实时测量墙板边缘与基准线的距离偏差,在牵引墙板的驱动导轨上安装高精度磁栅尺实时反馈墙板的实际位移量;

12、通过硬件触发信号实现所有传感器的时间同步,在同一时刻采集图像、imu姿态数据、激光位移数据和磁栅尺位置数据。

13、进一步的,在基于图像检测的收料牵引墙板位置感知方法中,根据所述图像、imu姿态数据、激光位移数据和磁栅尺位置数据计算出各驱动关节的指令位移量和旋转量,具体包括:

14、将采集到的多视角图像进行畸变校正、滤波降噪和图像增强处理,并对墙板表面的特征标记点进行实时检测与定位,获取多视角二维特征点坐标;

15、将检测到的多视角二维特征点坐标输入基于pnp算法的三维位姿解算模块,结合相机内外参数,解算出墙板在当前时刻的六自由度位姿;

16、将视觉解算的位姿数据、imu姿态数据、激光位移数据和磁栅尺位置数据输入扩展卡尔曼滤波器进行最优融合估计,根据各传感器当前的信噪比和数据有效性,动态计算融合结果的置信度;

17、将融合后的当前位姿与预设的标准位姿进行比较,计算出六个自由度上的偏差值,基于偏差值,通过逆运动学算法将笛卡尔空间偏差转换为各驱动关节的指令位移量和旋转量。

18、进一步的,在基于图像检测的收料牵引墙板位置感知方法中,在牵引墙板与校正执行机构的连接处安装六维力/力矩传感器实时测量三个方向的力和三个方向的力,具体包括:

19、在牵引墙板与校正执行机构的连接处安装六维力/力矩传感器,实时测量三个方向的力和力矩,对六维力/力矩传感器进行零点校准和温度补偿标定,消除重力偏置和温度漂移的影响;

20、在校正过程中,力觉传感器以2000hz的频率持续监测墙板与导向机构、限位装置之间的接触力,根据接触力的大小和方向判断当前的接触状态。

21、进一步的,在基于图像检测的收料牵引墙板位置感知方法中,构建阻抗控制方程,具体包括:

22、构建阻抗控制方程,所述阻抗控制方程满足以下关系式:

23、

24、其中,m为惯性参数,b为阻尼参数,k为刚度参数,e为位置偏差,为外部接触力,为表示牵引墙板当前实际位置与目标位置之间偏差量对时间的二阶导数,即偏差加速度矢量,为表示牵引墙板当前实际位置与目标位置之间偏差量对时间的一阶导数,即偏差速度矢量。

25、进一步的,在基于图像检测的收料牵引墙板位置感知方法中,,结合所述阻抗控制方程和三个方向的力、三个方向的力实时计算最优的阻抗参数组合,基于阻抗控制方程,将期望的阻抗参数和当前的力觉反馈代入计算,得到位置修正量,具体为:

26、根据当前接触状态和工况参数,动态计算最优的阻抗参数组合,在自由运动阶段,采用高刚度、低阻尼参数,在接近接触阶段,逐步降低刚度、增加阻尼;

27、在接触挤压阶段,采用低刚度、高阻尼参数,实现柔顺顺应,在危险接近阶段,刚度降至最低,以力控制为主,同时,设置期望的阻抗参数;

28、基于阻抗控制方程,将期望的阻抗参数和当前的力觉反馈代入计算,得到位置修正量;

29、持续监控接触力和接触力变化率,当检测到异常冲击时,立即触发紧急保护,执行机构反向运动并停止,同时发出声光报警。

30、进一步的,在基于图像检测的收料牵引墙板位置感知方法中,根据所述各驱动关节的指令位移量和旋转量以及位置修正量对收料牵引墙板位置进行修正,具体为:

31、根据所述各驱动关节的指令位移量和旋转量,经逆运动学解算后,首先映射为墙板在笛卡尔空间中的刚性期望位姿矩阵,基于所述位置修正量构建在当前接触力作用下的柔顺修正微动矢量;

32、引入动态融合权重系数,基于所述刚性期望位姿矩阵以及柔顺修正微动矢量进行合成,生成最终的合成期望位姿矩阵;

33、将所述最终的合成期望位姿矩阵分解到每一个具体的驱动关节,将融合后的笛卡尔修正矢量通过雅可比矩阵的伪逆映射到关节空间,得到各驱动关节的力觉修正补偿量;

34、将所述各驱动关节的力觉修正补偿量下发给伺服驱动器,伺服驱动器内部的位置环、速度环和电流环按优先级执行。

35、本发明第二方面提供了基于图像检测的收料牵引墙板位置感知装置,包括存储器以及处理器,所述存储器包括基于图像检测的收料牵引墙板位置感知方法程序,所述基于图像检测的收料牵引墙板位置感知方法程序被所述处理器执行时,实现任一项所述的基于图像检测的收料牵引墙板位置感知方法的步骤。

36、本发明第三方面提供了一种设备,包括基于图像检测的收料牵引墙板位置感知方法程序,所述基于图像检测的收料牵引墙板位置感知方法程序被处理器执行时,实现任一项所述的基于图像检测的收料牵引墙板位置感知方法的步骤。

37、本发明解决了背景技术中存在的缺陷,本发明具备以下有益效果:

38、本发明将六自由度位姿辨识引入牵引墙板校正领域,实现从单一维度校正到全维度综合校正的跨越;而且多源异构传感器融合方案有效克服了单一传感器在精度、鲁棒性和动态响应方面的局限性;而且将力觉感知引入牵引墙板校正,实现了从“盲目位置校正”到“感知式柔顺校正”的升级;其中,利用阻抗参数的动态自适应调节使系统能够适应不同材质、不同厚度的墙板,具有极强的通用性。最后,本发明的力觉碰撞检测机制有效保护了设备和墙板,显著降低了校正过程中的损坏风险。