灵巧手及其自适应阻抗柔顺控制方法、系统、装置和介质与流程

摘要: 本发明涉及机器人灵巧手控制,具体涉及一种灵巧手及其自适应阻抗柔顺控制方法、系统、装置和介质。背景技术:1、人形机器人灵巧手作为实现人机交互、柔性物体精密操作的核...
灵巧手及其自适应阻抗柔顺控制方法、系统、装置和介质与流程

本发明涉及机器人灵巧手控制,具体涉及一种灵巧手及其自适应阻抗柔顺控制方法、系统、装置和介质。

背景技术:

1、人形机器人灵巧手作为实现人机交互、柔性物体精密操作的核心执行机构,需要完成易碎、异形、易滑工件的柔顺夹持作业,柔顺力控是决定抓取稳定性、操作安全性的核心技术。

2、当前主流灵巧手柔顺控制方案主要分为两大类:基于外置触觉传感器的力闭环控制方案和基于电机电流观测的无传感器力控方案,两类方案均存在固有技术缺陷。

3、第一类是仅靠指尖触觉传感器的柔顺抓取方案。目前商用灵巧手普遍在指尖布置分布式触觉传感阵列,通过触觉反馈直接构建阻抗控制闭环,该类方案多采用固定参数的阻抗控制模型。该类方案存在以下缺陷:

4、(1)硬件集成与可靠性受限:微型手指内部空间狭小,微型电机与多级减速器占用大量结构空间,触觉传感器布线、fpc线束装配难度大;传感器厚度限制指尖夹持行程,大幅降低灵巧手轻量化与集成度;同时触觉传感器成本高、易受冲击磨损,长期往复抓取工况下故障率高,不利于批量量产。

5、(2)动态响应滞后:触觉传感器采集、信号滤波、数据传输存在固定时延,当物体发生滑动、碰撞冲击时,触觉反馈滞后导致阻抗调节不及时,极易出现夹持力骤增压碎工件,或夹持力不足发生物料滑落。

6、(3)环境抗干扰能力差:抓取环境粉尘、油污会降低触觉传感精度;高低温工况下传感零点漂移,造成夹持力观测误差,柔顺控制刚度匹配失效。

7、第二类是仅靠电机电流观测的无传感器柔顺控制方案。现有无传感器力控通过电机q轴电流换算关节输出扭矩,结合减速比、力臂模型推算指尖夹持力,无需外置触觉元件,结构集成度更高。但该方案存在以下显著不足:

8、(1)传动非线性误差无法消除:灵巧手采用大减速比行星减速器传动,存在回程间隙、滞回摩擦等非线性扰动,电机电流仅能反映电机电磁扭矩,无法区分电机损耗、传动摩擦损耗与真实指尖夹持载荷,力观测模型漂移严重,柔顺控制精度差。

9、(2)静态辨识存在盲区:当抓取轻质工件、轻载精细操作时,电机q轴电流幅值极小,电流采样噪声、绕组温升带来的观测误差被放大,无法精准识别微小接触力,难以实现软质物料低刚度柔顺抓取。

10、(3)无外部碰撞识别能力:灵巧手指尖未接触工件时,仅依靠电机电流无法区分空载摩擦与外部碰撞冲击,容易误触发过载保护,中断抓取作业。

11、综上,现有灵巧手单一依赖触觉传感器或电机电流进行抓取控制,感知信息维度片面,无法同时获取指尖外部接触交互状态与手指关节内部真实力矩负载,存在力控误差大、抗干扰能力弱、无法准确区分空载、接触、夹持、滑移等多种抓取工况的问题;传统固定参数阻抗控制方式无法依据抓取物体刚度及实时接触状态动态调整控制参数,对不同软硬、不同材质物体适配性差,易出现物体挤压破损或夹持滑脱现象;现有技术缺乏触觉感知与电机电流感知的有效融合校正机制,两类感知信号时序、量纲特性差异无法有效补偿,易造成控制系统超调、振荡及控制滞后;同时,传统控制架构控制层级割裂,抓取模式切换冲击大、动态响应能力不足,难以适配非结构化环境下未知物体的精密、柔顺、稳定抓取作业的技术问题。

12、因此,当前亟需一种能够融合多源感知信息、可动态调整阻抗控制参数的灵巧手柔顺控制方案,解决现有技术存在的上述缺陷,满足非结构化作业场景下不同特性未知物体的稳定柔顺抓取需求。

技术实现思路

1、有鉴于此,本发明提供了一种灵巧手及其自适应阻抗柔顺控制方法、系统、装置和介质,以解决现有灵巧手柔顺控制技术中感知维度片面、力控精度不足、工况辨识能力弱,以及传统固定参数阻抗控制无法依据物体刚度与接触状态动态调整参数、适配性差等问题。

2、本发明提供了一种灵巧手自适应阻抗柔顺控制方法,应用于包含多根独立运动的手指的灵巧手,每根手指均配置有用于触觉感知的多个触觉传感器以及用于驱动关节运动的多个关节驱动电机;

3、所述方法包括:

4、分别对每个触觉传感器和每个关节驱动电机进行标定,获取每个触觉传感器对应的触觉力标定参数以及每个关节驱动电机对应的关节力矩标定参数;并分别对每个关节进行阻抗模型初始化,得到每根手指上每个关节所对应的初始阻抗参数;

5、控制所述灵巧手按照预设轨迹进行闭合运动,并行采集闭合过程中每个触觉传感器所感知到的压力电压信号和每个关节驱动电机对应的转矩电流;并基于每个触觉传感器的触觉力标定参数对对应采集的压力电压信号进行预处理,得到每个触觉传感器所在位置处的触觉压力数据;基于每个关节驱动电机的关节力矩标定参数对对应采集的转矩电流进行预处理,得到每个驱动电机所在关节处的关节等效接触力矩;

6、基于每根手指上的所有触觉压力数据和所有关节等效接触力矩,采用分区加权融合的方法,分别计算得到每根手指上的多个单点综合接触力;再对每根手指上的所有单点综合接触力分别进行累加,得到每根手指的总夹持力;

7、在每根手指上,根据计算得到的总夹持力,匹配出对应的自适应阻抗调整策略;并根据匹配出的自适应阻抗调整策略对对应手指上的每个关节的初始阻抗参数分别进行自适应调整,得到每根手指上每个关节所对应的目标阻抗参数;

8、将每个关节的目标阻抗参数分别下发至对应的关节驱动电机,利用所有关节所配置的关节驱动电机基于调整后的目标阻抗参数完成柔顺抓取控制。

9、可选地,在每根手指上,触觉传感器均布置于指尖的多个采样点位上以及指节侧壁的多个采样点位上;

10、基于每根手指上的所有触觉压力数据和所有关节等效接触力矩,采用分区加权融合的方法,分别计算得到每根手指上的多个单点综合接触力;再对每根手指上的所有单点综合接触力分别进行累加,得到每根手指的总夹持力,包括:

11、任选一根手指,按照触觉传感器的布置位置,将对应的手指的接触面划分为指尖正接触区域和侧壁摩擦受力盲区;

12、为两个区域的接触面分别分配对应的触觉权重和电流力矩权重;

13、任选一个采样点位,基于选取的采样点位所在区域的触觉权重和电流力矩权重,对对应的触觉压力数据和关节等效接触力矩进行加权融合,得到选取的手指上对应采样点位的单点综合接触力;

14、遍历每个采样点位,按照同样的方法,计算得到选取的手指上每个采样点位的单点综合接触力;

15、将选取的手指上所有采样点位的单点综合接触力进行累加,得到选取的手指对应的总夹持力;

16、遍历每根手指,按照同样的方法,得到每根手指的总夹持力。

17、可选地,第j根手指上第i个采样点位的单点综合接触力的具体计算公式为:

18、;

19、其中,为单点综合接触力,和分别为第j根手指上第i个采样点位的触觉压力数据和关节等效接触力矩,和分别为第j根手指上第i个采样点位所在区域的触觉权重和电流力矩权重;

20、第j根手指的总夹持力具体计算公式为:

21、;

22、其中,为第j根手指的总夹持力,n为第j根手指的采样点位数量。

23、可选地,对于每根手指,两个区域分配的触觉权重和电流力矩权重满足:指尖正接触区域所分配的触觉权重大于对应区域的电流力矩权重,侧壁摩擦受力盲区所述分配的触觉权重小于对应区域的电流力矩权重。

24、可选地,对于每根手指,指尖正接触区域所分配的触觉权重的范围为0.6~0.9,侧壁摩擦受力盲区所述分配的触觉权重的范围为0.1~0.4。

25、可选地,在每根手指上,根据计算得到的总夹持力,匹配出对应的自适应阻抗调整策略,包括:

26、预设第一分界力阈值和第二分界力阈值,且所述第一分界力阈值小于所述第二分界力阈值;

27、任选一根手指,当选取的手指对应的总夹持力小于所述第一分界力阈值时,将预接触区间的调整策略确定为匹配的自适应阻抗调整策略;当选取的手指对应的总夹持力大于或等于所述第一分界力阈值、且小于所述第二分界力阈值时,将触碰过渡区间的调整策略确定为匹配的自适应阻抗调整策略;当选取的手指对应的总夹持力大于或等于所述第二分界力阈值时,将稳态夹持区间的调整策略确定为匹配的自适应阻抗调整策略;

28、遍历每根手指,按照相同的方法,匹配出每根手指的自适应阻抗调整策略。

29、可选地,每根手指上每个关节所对应的初始阻抗参数均包括阻抗初始基准刚度和阻抗初始基准阻尼,则每根手指上每个关节所对应的目标阻抗参数均包括阻抗目标刚度和阻抗目标阻尼;

30、对于第j根手指上的第k个关节,预接触区间的调整策略的具体表达式为:

31、;

32、其中,和分别为第j根手指上的第k个关节对应的阻抗目标刚度和阻抗目标阻尼,为第j根手指的总夹持力;和分别为第j根手指上的第k个关节对应的阻抗初始基准刚度和阻抗初始基准阻尼。

33、可选地,每根手指上每个关节所对应的初始阻抗参数均包括阻抗初始基准刚度和阻抗初始基准阻尼,则每根手指上每个关节所对应的目标阻抗参数均包括阻抗目标刚度和阻抗目标阻尼;

34、对于第j根手指上的第k个关节,触碰过渡区间的调整策略的具体表达式为:

35、;

36、其中,和分别为第j根手指上的第k个关节对应的阻抗目标刚度和阻抗目标阻尼,为第j根手指的总夹持力;和分别为第j根手指上的第k个关节对应的阻抗初始基准刚度和阻抗初始基准阻尼,和分别为过渡区间刚度允许下限和过渡区间阻尼允许上限;和分别为所述第一分界力阈值和所述第二分界力阈值,表示过渡区间归一化权重。

37、可选地,当选取的手指对应的总夹持力大于或等于所述第二分界力阈值时,在将稳态夹持区间的调整策略确定为匹配的自适应阻抗调整策略之前,所述方法还包括:

38、预先计算出选取的手指的触觉压力变化斜率;

39、根据计算出的触觉压力变化斜率,判断所述灵巧手所对应的被抓取物件的软硬属性;

40、对应地,将稳态夹持区间的调整策略确定为匹配的自适应阻抗调整策略,包括:

41、当判断所述被抓取物件的软硬属性硬质时,将稳态夹持区间的第一调整策略确定为匹配的自适应阻抗调整策略;

42、当判断所述被抓取物件的软硬属性为软质时,将稳态夹持区间的第二调整策略确定为匹配的自适应阻抗调整策略。

43、可选地,每根手指上每个关节所对应的目标阻抗参数均包括阻抗目标刚度和阻抗目标阻尼;

44、对于第j根手指上的第k个关节,稳态夹持区间的第一调整策略的具体表达式包括:

45、;

46、其中,和分别为第j根手指上的第k个关节对应的阻抗目标刚度和阻抗目标阻尼,为第j根手指的总夹持力;和分别为过渡区间刚度允许下限和过渡区间阻尼允许上限;和分别为硬质物件刚度修正系数和硬质物件阻尼修正系数;

47、稳态夹持区间的第二调整策略的具体表达式包括:

48、;

49、其中,和分别为软质物件刚度修正系数和软质物件阻尼修正系数。

50、可选地,根据计算出的触觉压力变化斜率,判断所述灵巧手所对应的被抓取物件的软硬属性,包括:

51、当计算出的触觉压力变化斜率大于或等于预设软硬斜率分界阈值时,判定所述被抓取物件的软硬属性为硬质;

52、当计算出的触觉压力变化斜率小于所述预设软硬斜率分界阈值时,判定所述被抓取物件的软硬属性为软质。

53、可选地,当选取第j根手指,预先计算出选取的手指的触觉压力变化斜率,包括:

54、在所述灵巧手的闭合运动过程中,基于第j根手指所配置的每个触觉传感器的触觉压力数据,分别计算出第j根手指上每个触觉传感器在当前采样时刻相对于上一采样时刻的触觉压力增量;

55、将触觉压力增量最大值确定为第j根手指的目标触觉压力增量,并根据第j根手指的目标触觉压力增量计算得到对应的触觉压力变化斜率;

56、或者,在所述灵巧手的闭合运动过程中,将第j根手指位于指尖正接触区域内的所有触觉传感器在当前采样时刻的触觉压力数据和在上一采样时刻的触觉压力数据分别进行进行加权平均,得到第j根手指的当前时刻平均触觉压力和上一时刻平均触觉压力;

57、根据第j根手指的当前时刻平均触觉压力和上一时刻平均触觉压力,计算得到第j根手指的目标触觉压力增量,并根据第j根手指的目标触觉压力增量计算得到对应的触觉压力变化斜率。

58、可选地,第j根手指的触觉压力变化斜率的具体计算公式为:

59、;

60、其中,为第j根手指的触觉压力变化斜率,为第j根手指的目标触觉压力增量,为所述灵巧手的采样周期。

61、可选地,每个触觉传感器的触觉力标定参数均包括对应的零点基准值和电压-接触力转换系数;

62、获取每个触觉传感器对应的触觉力标定参数,包括:

63、对每个触觉传感器执行零点压力标定与空载零点偏移校准,确定出每个触觉传感器的零点基准值;

64、基于每个触觉传感器的零点基准值,对每个触觉传感器施加分级标准负载,拟合得到每个触觉传感器的电压-接触力转换系数。

65、可选地,每个关节驱动电机的关节力矩标定参数均包括对应的电流-关节力矩转换系数;

66、获取每个关节驱动电机的关节力矩标定参数,包括:

67、对每个关节施加分级标准负载,采集对应的关节驱动电机的标准转矩电流,拟合得到电流-关节力矩转换系数。

68、可选地,基于每个触觉传感器的触觉力标定参数对对应采集的压力电压信号进行预处理,得到每个触觉传感器所在位置处的触觉压力数据,包括:

69、基于每个触觉传感器的触觉力标定参数,将对应触觉传感器所采集的压力电压信号换算为初始触觉压力值;

70、对每个触觉传感器的初始触觉压力值进行低通滤波处理,得到每个触觉传感器所在位置处的触觉压力数据。

71、可选地,基于每个关节驱动电机的关节力矩标定参数对对应采集的转矩电流进行预处理,得到每个驱动电机所在关节处的关节等效接触力矩,包括:

72、基于每个关节驱动电机的关节力矩标定参数,将每个关节驱动电机的转矩电流换算为初始关节力矩;

73、对每个关节驱动电机的初始关节力矩进行滑动均值滤波处理,得到每个驱动电机所在关节处的关节等效接触力矩。

74、可选地,利用所有关节所配置的关节驱动电机基于调整后的目标阻抗参数完成柔顺抓取控制,包括:

75、所述灵巧手的每个关节驱动电机分别接收其对应的目标阻抗参数,并以内环力矩闭环、外环阻抗控制的控制架构运行,输出目标力矩以完成柔顺抓取;

76、其中,内环力矩闭环、外环阻抗控制的控制架构具体为:

77、外环阻抗控制环根据目标阻抗参数修正位置偏差所对应的目标力矩,内环电流环根据修正的目标力矩驱动对应的关节驱动电机输出扭矩,以完成抓取。

78、此外,本发明还提供一种灵巧手自适应阻抗柔顺控制系统,应用于包含多根独立运动的手指的灵巧手,每根手指均配置有用于触觉感知的多个触觉传感器以及用于驱动关节运动的多个关节驱动电机;

79、所述系统应用于前述的灵巧手自适应阻抗柔顺控制方法中,包括:

80、标定初始化模块,用于分别对每个触觉传感器和每个关节驱动电机进行标定,获取每个触觉传感器对应的触觉力标定参数以及每个关节驱动电机对应的关节力矩标定参数;并分别对每个关节进行阻抗模型初始化,得到每根手指上每个关节所对应的初始阻抗参数;

81、采集预处理模块,控制所述灵巧手按照预设轨迹进行闭合运动,并行采集闭合过程中每个触觉传感器所感知到的压力电压信号和每个关节驱动电机对应的转矩电流;并基于每个触觉传感器的触觉力标定参数对对应采集的压力电压信号进行预处理,得到每个触觉传感器所在位置处的触觉压力数据;基于每个关节驱动电机的关节力矩标定参数对对应采集的转矩电流进行预处理,得到每个驱动电机所在关节处的关节等效接触力矩;

82、分区融合处理模块,用于基于每根手指上的所有触觉压力数据和所有关节等效接触力矩,采用分区加权融合的方法,分别计算得到每根手指上的多个单点综合接触力;再对每根手指上的所有单点综合接触力分别进行累加,得到每根手指的总夹持力;

83、自适应调整模块,用于在每根手指上,根据计算得到的总夹持力,匹配出对应的自适应阻抗调整策略;并根据匹配出的自适应阻抗调整策略对对应手指上的每个关节的初始阻抗参数分别进行自适应调整,得到每根手指上每个关节所对应的目标阻抗参数;

84、柔顺抓取控制模块,用于将每个关节的目标阻抗参数分别下发至对应的关节驱动电机,利用所有关节所配置的关节驱动电机基于调整后的目标阻抗参数完成柔顺抓取控制。

85、此外,本发明还提供了一种灵巧手自适应阻抗柔顺控制装置,包括处理器、存储器和存储在所述存储器中且可运行在所述处理器上的计算机程序,所述计算机程序运行时实现前述的灵巧手自适应阻抗柔顺控制方法中的方法步骤。

86、此外,本发明还提供了一种计算机存储介质,所述计算机存储介质包括:至少一个指令,在所述指令被计算机执行时实现前述的灵巧手自适应阻抗柔顺控制方法中的方法步骤。

87、此外,本发明还提供了一种灵巧手,包括:

88、灵巧手本体;

89、多根独立运动的手指,设于所述灵巧手本体上,每根手指上均设有用于触觉感知的多个触觉传感器以及用于驱动关节运动的多个关节驱动电机;

90、主控制器,与每个触觉传感器和每个关节驱动电机均通信连接,所述主控制器被配置为执行前述的灵巧手自适应阻抗柔顺控制方法中的方法步骤。

91、本发明的有益效果:首先通过对灵巧手每根手指上所配置的每个触觉传感器进行标定,能够获取到各触觉传感器的触觉力标定参数,进而便于在后续数据并行采集过程中,将各触觉传感器所采集到的压力电压信号转换为统一的标准触觉压力数据;同时对每个关节驱动电机进行标定,获取对应的关节力矩标定参数,便于后续数据并行采集过程中,将各关节驱动电机的转矩电流等效为关节处的实际接触力矩(即关节等效接触力矩),保证后续总夹持力计算所需原始数据的准确性;其次通过分区加权融合的处理方式,结合触觉压力数据与关节等效接触力矩计算得到每根手指的总夹持力,相较于仅依靠单一类型传感器计算接触力的方案,有效降低了单一检测方式所带来的系统误差,得到更贴合实际接触状态的总夹持力数值,总夹持力的计算精度与稳定性更高;进一步通过总夹持力来匹配对应的自适应阻抗调整策略,能够根据各手指的区域特性、所接触的物件特性等因素之间的差异性,匹配出最合适的阻抗参数调整方案;根据匹配出的自适应阻抗调整策略对各关节在初始化过程中标定得到的初始阻抗参数进行动态调节,能够得到随抓取接触过程变化的目标阻抗参数,实现阻抗参数的动态自适应调整;相较于传统固定阻抗参数的抓取控制方案,能够更好地适配不同夹持阶段、不同物件特性下的抓取需求,既能够避免抓取过程中因刚度不足导致抓取位置偏移打滑,也能够避免因阻尼不合适导致抓取过程震颤,有效提升了灵巧手抓取作业的平稳性;

92、本发明的灵巧手及其自适应阻抗柔顺控制方法、系统、装置和介质,实现了阻抗参数的动态自适应调节,有效解决了传统灵巧手柔顺控制技术中感知维度片面、力控精度不足、工况辨识能力弱,以及传统固定参数阻抗控制无法依据物体刚度与接触状态动态调整参数、适配性差等问题;在保证抓取稳定性的同时,能够有效降低对被抓取物件造成损伤的风险,提升灵巧手对不同应用场景、不同物理特性物件的柔顺抓取适配能力,为机器人灵巧手完成高精度、高可靠性的抓取作业提供了可靠的技术支撑,可广泛应用于工业分拣、服务机器人、特种操作等各类需要柔性抓取作业的领域。