一种基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法及系统

摘要: 本发明涉及机器人智能控制与多模态感知,尤其涉及一种基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法及系统。背景技术: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、参数融合单元,用于利用融合权重对初始阻抗刚度参数和初始阻尼参数与反馈分支阻抗参数进行加权融合,得到最终阻抗刚度参数和最终阻尼参数。

41、一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现所述基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法的步骤。

42、与现有技术相比,本发明具有如下优点和技术效果:

43、(1)接触前智能预配置:本发明通过视觉感知识别目标物材质类别与刚度等级,映射生成初始阻抗参数,使机械臂在接触瞬间即具备与目标物匹配的柔顺特性,有效降低初始冲击力,保障软质、易碎目标物的操作安全。

44、(2)视觉前馈与力反馈动态融合:本发明构建基于视觉置信度与力反馈误差的融合更新律,在线调节阻抗刚度与阻尼参数,实现视觉信息与力觉信息在控制中的合理分配,在保证响应速度的同时显著提升接触稳定性与环境适应能力。

45、(3)误差趋势感知与在线修正:本发明引入力误差变化率对阻尼参数进行修正,使系统能够感知接触力的变化趋势,提前抑制冲击与振荡;融合权重结构简洁、分量可测,便于工程实现与参数整定,可广泛适用于抓取、装配、打磨等多种接触式作业任务。

1.一种基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,包括:

2.根据权利要求1所述的基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,所述机械臂末端的初始阻抗刚度参数和初始阻尼参数分别为:

3.根据权利要求1所述的基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,构造表征所述视觉前馈信息可信程度的视觉置信度,包括:

4.根据权利要求1所述的基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,计算所述归一化力反馈误差为:

5.根据权利要求4所述的基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,所述融合权重为:

6.根据权利要求1所述的基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,所述反馈分支阻抗参数为:

7.根据权利要求6所述的基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,所述最终阻抗刚度参数和最终阻尼参数通过下式进行加权融合:

8.一种基于视觉材质先验与力反馈修正的机械臂在线阻抗调节系统,用于实现权利要求1-7任一项所述的基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法,其特征在于,包括:

9.根据权利要求8所述的系统,其特征在于,所述融合更新模块包括:

10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1-7中任一项所述基于视觉材质先验与力反馈修正的机械臂在线阻抗调节方法的步骤。