一种集成视觉与激光测距的机械臂末端位置闭环控制装置的制作方法
本申请涉及控制或调节系统,具体属于位置调节系统的相关分类,特指一种集成视觉与激光测距的机械臂末端位置闭环控制装置。该装置及方法主要应用于高精密孔轴自动化装配场景下的基于多源传感器融合反馈的机械臂末端引导与控制。
背景技术:
1、在新能源汽车制造及航空航天精密组装场景中,控制机械臂末端将销轴等部件插入公差极小的目标孔内需要引入传感器进行实时引导与位姿闭环控制。常规的位置引导系统多采用单一的视觉方案,在机械臂末端逐渐靠近目标时,受限于视野盲区或景深极限,视觉系统在z轴深度的位置解算误差会急剧放大。弥补此缺陷的现有技术多通过在末端加装激光测距仪定位,采用基于距离阈值进行传感器硬切换的分步控制逻辑。该逻辑割裂了三维空间的耦合关系,在传感器发生硬切换时,控制环路的输入端会产生阶跃误差,导致执行机构内部的伺服电机电流激增,机械臂末端在极近距离处发生高频振荡,无法满足高精度、连续稳定的装配位置调节需求。
技术实现思路
1、本申请提供了一种集成视觉与激光测距的机械臂末端位置闭环控制装置,解决了现有机械臂控制方案在传感器切换临界点发生阶跃振荡、无法平滑引导的问题。
2、本申请实施例提供了一种集成视觉与激光测距的机械臂末端位置闭环控制装置,包括:工业机械臂,其末端固接有工业相机和激光测距仪,工业相机具有第一光轴,激光测距仪具有第二光轴,第一光轴与第二光轴相互平行;位置控制单元,与工业机械臂、工业相机和激光测距仪通信连接,位置控制单元运行多源融合位置闭环调节逻辑,位置控制单元包含xy轴位置控制器;位置控制单元被配置为获取工业相机的视觉z向观测值与激光测距仪的激光z向观测值,根据激光测距仪测得的实时激光距离自适应生成动态权重系数,并混合视觉z向观测值和激光z向观测值输出系统综合z向反馈量;位置控制单元还被配置为采用变增益控制律,将实时激光距离作为控制变量,动态衰减调度xy轴位置控制器的比例增益,输出连续的关节驱动控制指令。
3、进一步地,位置控制单元在自适应生成动态权重系数时,配置有第一距离阈值和第二距离阈值,第一距离阈值大于第二距离阈值;当实时激光距离大于第一距离阈值时,向视觉z向观测值分配初始最大权重;当实时激光距离小于第二距离阈值时,向激光z向观测值分配目标最大权重;当实时激光距离处于第一距离阈值和第二距离阈值之间时,采用预设的s型连续函数动态分配两者的动态权重系数。
4、进一步地,预设的s型连续函数的执行逻辑被配置为计算实时激光距离与第一距离阈值的距离差值,以及第一距离阈值与第二距离阈值的区间跨度值;计算距离差值与区间跨度值的比值并作为比例因子;将自然对数底数作为底数,将比例因子的负数倍数作为指数,计算对应的指数项结果;将数值1与指数项结果相加得到分母项,并将数值1除以分母项得到视觉权重系数;将数值1减去视觉权重系数的差值作为激光权重系数,视觉权重系数用于乘以视觉z向观测值,激光权重系数用于乘以激光z向观测值,两者的乘积之和作为系统综合z向反馈量。
5、进一步地,位置控制单元在执行动态衰减调度xy轴位置控制器的比例增益时,配置有表征进入逼近状态的第三距离阈值;响应于实时激光距离大于第三距离阈值,使用预设的基础比例增益作为xy轴位置控制器的当前比例增益;响应于实时激光距离小于或等于第三距离阈值,利用非线性衰减函数构建增益衰减系数,并将基础比例增益与增益衰减系数相乘后的结果作为更新后的当前比例增益。
6、进一步地,非线性衰减函数被配置为获取实时激光距离,并计算实时激光距离与第三距离阈值的比值,将比值作为距离衰减基数;提取预先配置的非线性调节指数,非线性调节指数为大于1的正数,表征逼近过程中的衰减曲率;将距离衰减基数计算为以非线性调节指数为幂的乘方结果,生成增益衰减系数;随着工业机械臂的末端向目标工件运动且实时激光距离逐渐减小,增益衰减系数以非线性指数级同步减小,促使更新后的当前比例增益发生连续收缩。
7、进一步地,该装置还包括固定安装于工业机械臂的末端的连接法兰;工业相机和激光测距仪均刚性固定于连接法兰的同一基准面上,且两者沿水平方向偏移预设的固定间距。
8、进一步地,位置控制单元还被配置为触发同步硬件中断信号,响应于同步硬件中断信号,在同一时间周期内并发提取工业相机输出的图像帧和激光测距仪输出的距离脉冲,为视觉z向观测值和激光z向观测值配置一致的时间戳。
9、相应地,本申请实施例提供了一种机械臂末端位置闭环控制方法,应用于上述的集成视觉与激光测距的机械臂末端位置闭环控制装置,包括获取工业相机的视觉z向观测值与激光测距仪的激光z向观测值;根据实时激光距离自适应生成动态权重系数;基于动态权重系数混合视觉z向观测值和激光z向观测值,输出系统综合z向反馈量;获取实时激光距离作为控制变量,采用变增益控制律动态衰减调度xy轴位置控制器的比例增益;根据系统综合z向反馈量和调度后的比例增益生成连续的关节驱动控制指令,并输出至工业机械臂。
10、相应地,本申请实施例提供了一种电子设备,包括至少一个处理器;与至少一个处理器通信连接的存储器;存储器存储有可被至少一个处理器执行的计算机程序,计算机程序被至少一个处理器执行,使至少一个处理器执行上述的机械臂末端位置闭环控制方法。
11、相应地,本申请实施例提供了一种计算机可读存储介质,计算机可读存储介质存储有计算机程序,计算机程序被处理器执行时实现上述的机械臂末端位置闭环控制方法。
12、本申请构建了包含动态权重系数调节和位置调节增益调度的多源融合机制,通过s型连续函数平滑混合深度反馈,并通过跨轴约束衰减xy平面的响应增益。该结构削弱了双模态传感器硬性切换产生的控制环路突变,抑制了近距操作时的震荡失控现象,实现了位置反馈调节的全量程平滑收敛,提高了机械臂末端位置控制系统的稳定性。
1.一种集成视觉与激光测距的机械臂末端位置闭环控制装置,其特征在于,包括:
2.根据权利要求1所述的集成视觉与激光测距的机械臂末端位置闭环控制装置,其特征在于,所述位置控制单元在自适应生成动态权重系数时,配置有第一距离阈值和第二距离阈值,所述第一距离阈值大于所述第二距离阈值;当所述实时激光距离大于所述第一距离阈值时,向所述视觉z向观测值分配初始最大权重;当所述实时激光距离小于所述第二距离阈值时,向所述激光z向观测值分配目标最大权重;当所述实时激光距离处于所述第一距离阈值和所述第二距离阈值之间时,采用预设的s型连续函数动态分配两者的所述动态权重系数。
3.根据权利要求2所述的集成视觉与激光测距的机械臂末端位置闭环控制装置,其特征在于,所述预设的s型连续函数的执行逻辑被配置为:计算所述实时激光距离与预设的临界距离阈值的差值;将所述差值与预设的权重平滑度系数相乘得到指数项参数;将自然对数底数作为底数,将所述指数项参数作为指数,计算对应的指数项结果;将数值1与所述指数项结果相加得到分母项,并将数值1除以所述分母项得到激光权重系数;将数值1减去所述激光权重系数的差值作为视觉权重系数,所述视觉权重系数用于乘以所述视觉z向观测值,所述激光权重系数用于乘以所述激光z向观测值,两者的乘积之和作为所述系统综合z向反馈量。
4.根据权利要求1所述的集成视觉与激光测距的机械臂末端位置闭环控制装置,其特征在于,所述位置控制单元响应于所述实时激光距离大于所述第三距离阈值,使用预设的基础比例增益作为所述xy轴位置控制器的当前比例增益。
5.根据权利要求1至4任一项所述的集成视觉与激光测距的机械臂末端位置闭环控制装置,其特征在于,还包括固定安装于所述工业机械臂的末端的连接法兰;所述工业相机和所述激光测距仪均刚性固定于所述连接法兰的同一基准面上,且两者沿水平方向偏移预设的固定间距。
6.根据权利要求1至4任一项所述的集成视觉与激光测距的机械臂末端位置闭环控制装置,其特征在于,所述位置控制单元还被配置为触发同步硬件中断信号,响应于所述同步硬件中断信号,在同一时间周期内并发提取所述工业相机输出的图像帧和所述激光测距仪输出的距离脉冲,为所述视觉z向观测值和所述激光z向观测值配置一致的时间戳。
7.一种机械臂末端位置闭环控制方法,其特征在于,应用于如权利要求1至6任一项所述的集成视觉与激光测距的机械臂末端位置闭环控制装置,包括:
8.一种电子设备,其特征在于,包括:至少一个处理器;与所述至少一个处理器通信连接的存储器;所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,使所述至少一个处理器执行如权利要求7所述的机械臂末端位置闭环控制方法。
9.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求7所述的机械臂末端位置闭环控制方法。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com