模块化电子皮肤的机器人触觉感知控制系统及方法与流程

摘要: 本发明涉及机器人触觉感知与智能控制,具体涉及一种模块化电子皮肤的机器人触觉感知控制系统及方法。背景技术:1、随着机器人由结构化环境下的预设轨迹执行逐渐向复杂动态...
模块化电子皮肤的机器人触觉感知控制系统及方法与流程

本发明涉及机器人触觉感知与智能控制,具体涉及一种模块化电子皮肤的机器人触觉感知控制系统及方法。

背景技术:

1、随着机器人由结构化环境下的预设轨迹执行逐渐向复杂动态环境下的自主交互发展,机器人对接触状态、接触位置、作用力以及滑移状态的实时感知需求不断提高。电子皮肤能够通过柔性压力、应变、压阻或其他触觉传感结构获取机器人与外部对象接触过程中的触觉信息,并可覆盖机器人机械臂、末端执行器及其他接触部位。然而,现有机器人电子皮肤通常采用固定区域或单一传感模块进行触觉采集,不同电子皮肤模块之间容易存在采样时间不同步、空间坐标不一致、灵敏度差异以及边界区域响应不连续等问题,导致多个电子皮肤模块形成的触觉数据难以进行统一表征。

2、另一方面,现有机器人触觉控制方法通常根据单一触觉参数或预设阈值进行控制调整,难以同时利用触觉空间分布、触觉动态变化及机器人运动状态进行协同决策。当机器人发生接触增强、稳定接触或滑移等交互状态变化时,固定控制参数难以及时调整位置、速度及作用力之间的控制关系;同时,电子皮肤模块在长期使用或不同受力条件下可能产生响应偏差,使部分异常模块的数据影响整体触觉感知结果,从而降低机器人触觉控制的稳定性和准确性。因此,需要一种能够对多个电子皮肤模块进行统一触觉表征,并结合触觉状态及交互意图实现机器人自适应控制,同时根据闭环反馈动态调整模块融合权重的触觉感知控制方法及系统。

技术实现思路

1、为了实现上述发明目的,本发明提供了以下技术方案:模块化电子皮肤的机器人触觉感知控制方法,包括以下步骤:

2、步骤s1、获取设置于机器人机械臂、机器人末端执行器及机器人接触部位的多个电子皮肤模块输出的原始触觉数据、模块位姿数据、模块标识数据及采样时间戳,对不同电子皮肤模块的所述原始触觉数据进行时间同步、空间坐标转换、基准响应校正、灵敏度归一化及模块边界关联融合,获得统一触觉场数据;

3、步骤s2、基于所述统一触觉场数据,按照机器人表面空间位置划分触觉区域,获取各触觉区域的压力特征、压力梯度特征、接触面积特征、触觉响应变化特征及空间邻接特征,构建触觉空间关联关系,对各触觉区域的空间触觉特征和时间变化特征进行联合建模,获得时空融合触觉特征,并基于所述时空融合触觉特征生成触觉状态向量及触觉意图表征数据;

4、步骤s3、获取机器人当前关节状态、末端位姿状态、末端速度、当前作用力及目标运动状态,将所述触觉状态向量、触觉意图表征数据与机器人当前运动状态进行耦合,获得触觉—运动耦合状态,根据所述触觉—运动耦合状态确定位置、速度及作用力控制维度对应的触觉自适应控制权重,并根据所述触觉自适应控制权重对机器人运动误差及触觉状态进行协同调节,获得机器人目标控制量,将所述机器人目标控制量作用于机器人执行机构;

5、步骤s4、获取机器人执行所述机器人目标控制量后的新一轮电子皮肤模块触觉感知数据,并按照步骤s1的统一表征方式获得新的统一触觉场数据,按照步骤s2的触觉状态识别方式获得实际触觉状态向量,将所述实际触觉状态向量与目标触觉状态进行比较,获得触觉状态偏差及运动状态偏差,根据所述触觉状态偏差和运动状态偏差对机器人目标控制量进行反馈修正,同时根据各电子皮肤模块的触觉响应一致性计算模块可信度,利用所述模块可信度更新各电子皮肤模块参与触觉融合的权重,获得更新后的机器人控制量及更新后的模块参与权重,并将所述新的统一触觉场数据重新输入步骤s2,以形成模块化电子皮肤触觉感知、触觉状态识别、机器人运动控制及模块权重自适应修正的闭环控制过程。

6、优选的,所述步骤s1具体包括:

7、获取第个电子皮肤模块在时刻输出的原始触觉数据、模块位姿数据、模块标识数据以及采样时间戳,首先按照采样时间戳对不同电子皮肤模块的原始触觉数据进行时间对齐,并根据模块位姿数据将各电子皮肤模块的触觉采样位置转换至机器人本体坐标系,得到空间统一后的触觉采样数据;

8、进一步获取各电子皮肤模块的无接触基准响应和标准载荷响应,根据所述无接触基准响应和标准载荷响应对空间统一后的触觉响应进行非线性灵敏度归一化,获得归一化触觉响应;

9、针对相邻电子皮肤模块之间的重叠区域及模块边界区域,根据触觉采样点之间的位置距离、触觉响应差异以及相邻模块的响应变化一致性建立模块关联权重,并利用所述模块关联权重对相邻电子皮肤模块的归一化触觉响应进行加权融合,得到统一触觉场数据。

10、优选的,所述步骤s2具体包括:

11、将所述统一触觉场数据按照机器人表面空间位置划分为多个触觉区域,并针对每一触觉区域提取区域平均压力、压力梯度、接触面积、触觉响应变化率以及区域质心位置,再按照各触觉区域之间的空间邻接关系及触觉响应相似程度构建触觉空间关联图;

12、针对触觉空间关联图中的每一触觉区域,将相邻触觉区域的状态特征按照模块关联权重进行空间传播,并结合当前触觉区域自身的状态特征以及前一采样时刻的状态特征,获得时空融合触觉特征;

13、进一步根据连续采样周期内的时空融合触觉特征,提取压力中心迁移、接触面积变化及局部压力梯度变化对应的动态特征,并建立接触状态与触觉变化趋势之间的耦合关系,得到触觉状态向量及触觉意图表征数据;

14、在获得所述触觉状态向量后,提取所述触觉状态向量中的接触强度、接触面积变化率、压力中心移动量及触觉响应变化率,并将各特征分别与预设的接触状态阈值进行比较,根据比较结果确定机器人当前的接触意图类别,当接触强度持续增加且接触面积变化率处于稳定范围时,将所述接触意图确定为接触增强意图,当压力中心持续向同一方向移动且触觉响应变化率超过预设变化阈值时,将所述接触意图确定为滑移修正意图,当接触强度和接触面积均保持稳定时,将所述接触意图确定为稳定保持意图,将所确定的接触意图类别与对应的触觉状态强度进行组合,形成触觉意图表征数据。

15、优选的,所述步骤s3具体包括:

16、获取机器人当前关节状态、末端位姿状态、末端速度、当前作用力、目标运动状态及目标触觉状态向量,将所述触觉状态向量、触觉意图表征数据与机器人当前运动状态进行联合编码,得到触觉—运动耦合状态;

17、根据所述触觉—运动耦合状态分别计算机器人位置控制误差、速度控制误差以及作用力控制误差,并利用触觉状态向量中的接触强度、接触稳定性和滑移状态对各控制误差进行动态加权,获得触觉自适应控制权重,所述触觉自适应控制权重表示为:

18、;

19、其中,表示触觉状态映射矩阵,表示触觉意图映射矩阵,表示触觉变化率映射矩阵;

20、所述位置控制误差、速度控制误差及作用力控制误差分别按照下式确定:

21、;

22、;

23、;

24、随后根据所述触觉自适应控制权重对位置控制误差、速度控制误差和作用力控制误差进行协同调节,得到机器人目标控制量,所述机器人目标控制量表示为:

25、;

26、其中,、和分别表示位置、速度及作用力控制维度对应的触觉自适应控制权重,、和分别表示位置、速度及作用力控制增益,表示触觉状态反馈增益。

27、优选的,所述步骤s4具体包括:

28、在机器人执行所述机器人目标控制量后,重新获取各电子皮肤模块输出的触觉感知数据,并按照步骤s1的数据处理方式生成新的统一触觉场数据,再按照步骤s2的触觉状态识别方式获得实际触觉状态向量,将所述实际触觉状态向量,与步骤s3产生的目标触觉状态向量进行差异计算,获得触觉状态偏差,并将机器人实际末端位姿与目标末端位姿进行比较,获得运动状态偏差;

29、根据所述触觉状态偏差和运动状态偏差建立控制反馈状态,并根据连续控制周期内各电子皮肤模块的触觉响应与所述触觉状态偏差之间的相关程度计算模块可信度,所述模块可信度表示为:

30、;

31、其中,表示第个电子皮肤模块的模块可信度,表示由第 个电子皮肤模块对应触觉数据得到的实际触觉状态,表示目标触觉状态,表示第个电子皮肤模块的归一化触觉响应,表示当前统一触觉场响应,表示触觉状态偏差尺度参数,表示触觉响应偏差尺度参数,表示电子皮肤模块数量;

32、进一步根据所述模块可信度更新电子皮肤模块参与触觉融合的权重,并根据所述触觉状态偏差和运动状态偏差对机器人目标控制量进行反馈修正,获得更新后的机器人控制量,所述反馈修正过程表示为:

33、;

34、其中, 表示当前机器人目标控制量,表示触觉状态偏差反馈增益,表示运动状态偏差反馈增益,表示触觉状态偏差变化率反馈增益,根据所述更新后的机器人控制量控制机器人执行机构,并利用更新后的电子皮肤模块参与权重重新生成统一触觉场数据,使新的统一触觉场数据再次输入步骤s2进行触觉状态识别,以形成模块权重自适应调整、触觉状态识别及机器人运动控制的闭环迭代过程。

35、本发明还提供了一种模块化电子皮肤的机器人触觉感知控制系统,包括以下模块:

36、模块化触觉数据采集与融合模块,用于对设置于机器人不同部位的多个电子皮肤模块产生的触觉数据进行采集、统一处理及融合,形成机器人表面的统一触觉感知数据,并将所述统一触觉感知数据输出至触觉状态识别与意图分析模块;

37、触觉状态识别与意图分析模块,用于对所述统一触觉感知数据进行触觉区域划分、时空特征提取及触觉状态分析,获得机器人的当前触觉状态及触觉交互意图,并将所述当前触觉状态及触觉交互意图输出至触觉驱动控制与闭环修正模块;

38、触觉驱动控制与闭环修正模块,用于根据所述当前触觉状态、触觉交互意图以及机器人当前运动状态生成机器人运动控制指令,并根据机器人执行所述运动控制指令后的触觉反馈及运动反馈对所述机器人运动控制指令进行修正,同时调整多个电子皮肤模块参与触觉数据融合的权重;

39、其中,所述模块化触觉数据采集与融合模块、触觉状态识别与意图分析模块以及触觉驱动控制与闭环修正模块依次连接,且所述触觉驱动控制与闭环修正模块将调整后的电子皮肤模块融合权重及反馈数据传输至所述模块化触觉数据采集与融合模块,以形成触觉数据采集、触觉数据融合、触觉状态识别、机器人运动控制及反馈修正的闭环处理过程。

40、所述模块化触觉数据采集与融合模块包括:

41、触觉数据采集子单元,用于获取设置于机器人机械臂、机器人末端执行器及机器人接触部位的多个电子皮肤模块输出的原始触觉数据,以及各电子皮肤模块对应的模块位置姿态信息、模块标识信息和采样时间信息,按照统一采样时间基准对不同电子皮肤模块输出的原始触觉数据进行时间对齐,并根据各电子皮肤模块的位置姿态信息将不同电子皮肤模块的触觉采样位置转换至机器人统一空间坐标系,对各电子皮肤模块的触觉响应进行基准校正和灵敏度归一化处理,获得具有统一时间基准、空间基准及响应尺度的标准化触觉数据;

42、触觉数据融合子单元,用于获取经过标准化处理的不同电子皮肤模块的触觉数据,识别相邻电子皮肤模块之间的重叠区域及模块边界区域,根据相邻电子皮肤模块的触觉采样位置关系、触觉响应差异以及触觉响应变化一致性确定模块之间的关联关系,并根据所述关联关系对相邻电子皮肤模块的触觉数据进行融合,使不同电子皮肤模块之间的触觉数据在空间边界处连续过渡,形成覆盖机器人多个接触区域的统一触觉感知数据。

43、所述触觉状态识别与意图分析模块包括:

44、时空触觉特征构建子单元,用于接收所述统一触觉感知数据,根据机器人表面空间位置将机器人触觉感知区域划分为多个触觉区域,分别提取各触觉区域的压力特征、压力梯度特征、接触面积特征、触觉响应变化特征以及区域位置特征,并根据不同触觉区域之间的空间邻接关系及触觉响应相似关系构建触觉区域空间关联关系,同时结合连续采样周期内各触觉区域的触觉特征变化进行时间关联分析,获得表征机器人触觉空间分布及动态变化的时空融合触觉特征;

45、触觉状态意图识别子单元,用于接收所述时空融合触觉特征,提取机器人当前接触区域的接触强度、接触面积变化、压力中心移动以及触觉响应变化特征,根据所述特征确定机器人当前的接触状态,并结合连续采样周期内接触状态的变化趋势确定机器人与外部对象之间的触觉交互意图,形成对应的触觉状态信息及触觉意图信息。

46、所述触觉驱动控制与闭环修正模块包括:

47、触觉自适应控制子单元,用于接收所述触觉状态信息及触觉意图信息,并获取机器人当前关节状态、末端位姿状态、末端速度、当前作用力及目标运动状态,将所述触觉状态信息及触觉意图信息与机器人当前运动状态进行耦合,根据耦合结果确定机器人位置控制、速度控制及作用力控制对应的控制需求,并根据不同控制需求对各控制维度进行动态调节,生成机器人运动控制指令并发送至机器人执行机构;

48、模块协同反馈子单元,用于获取机器人执行所述运动控制指令后的新一轮触觉感知数据及实际运动状态,根据所述新一轮触觉感知数据确定机器人实际触觉状态,并分别将所述实际触觉状态与目标触觉状态、所述实际运动状态与目标运动状态进行比较,获得触觉状态偏差及运动状态偏差;根据连续控制周期内不同电子皮肤模块的触觉响应与所述触觉状态偏差之间的一致程度确定各电子皮肤模块的模块可靠程度,并根据所述模块可靠程度调整各电子皮肤模块参与触觉数据融合的权重,同时根据所述触觉状态偏差及运动状态偏差对机器人运动控制指令进行反馈修正,将修正后的运动控制指令发送至机器人执行机构。

49、与现有技术相比,本发明的有益效果:

50、提高多模块触觉数据的一致性与连续性,通过对多个电子皮肤模块进行时间同步、空间坐标统一、基准响应校正和非线性灵敏度归一化,并结合模块边界处的空间位置、触觉响应及响应变化建立关联权重,实现不同电子皮肤模块触觉数据的关联融合,降低模块之间的响应差异及边界数据不连续问题。

51、提高机器人对复杂接触状态及交互意图的识别能力,通过将机器人表面划分为多个触觉区域,并联合利用压力、压力梯度、接触面积、压力中心移动及触觉响应变化等信息构建时空融合触觉特征,使机器人能够区分接触增强、稳定保持、滑移修正等不同触觉交互状态,为后续位置、速度及作用力协同控制提供触觉状态依据。

52、实现机器人触觉控制及电子皮肤模块融合权重的闭环自适应调整,根据机器人执行控制量后的实际触觉状态和运动状态计算触觉状态偏差及运动状态偏差,并根据不同电子皮肤模块的响应一致程度确定模块可靠程度,进而同步修正机器人运动控制指令和电子皮肤模块参与融合的权重,使触觉感知、机器人运动控制及模块状态调整形成闭环迭代,提高机器人在动态接触过程中的控制适应性。