一种同构型人机上肢主从增量映射方法及系统与流程

摘要: 本发明属于人机交互控制,尤其涉及一种同构型人机上肢主从增量映射方法及系统。背景技术:1、同构型人机上肢主从控制系统广泛应用于遥操作、医疗康复和工业机器人等领域。...
一种同构型人机上肢主从增量映射方法及系统与流程

本发明属于人机交互控制,尤其涉及一种同构型人机上肢主从增量映射方法及系统。

背景技术:

1、同构型人机上肢主从控制系统广泛应用于遥操作、医疗康复和工业机器人等领域。操作者通过上肢运动控制从端机械臂执行任务,主端操作者的关节角度增量经过映射后驱动从端机械臂各关节产生相应运动。

2、现有主从增量映射方法主要存在以下技术缺陷:

3、第一,映射比例系数固定或仅由操作者手动调节。现有系统中,主端关节角度增量到从端关节角度增量的映射比例系数通常为预设常数或由操作者通过开关手动切换。当从端负载变化或操作意图变化时,固定映射比例无法适应,导致从端响应过快或过慢、操作精度下降或安全性降低。

4、第二,未利用操作者的生理状态信息。现有方法仅将操作者的关节角度作为输入信号,未考虑操作者的肌肉状态、用力模式和运动策略对主从控制的影响。操作者在快速运动和精细运动时,其肌肉协调模式存在显著差异,现有方法无法区分这些差异并据此调整映射关系。

5、第三,未考虑从端环境交互力的影响。从端机械臂在受限环境中作业时,末端执行器与环境的接触力通过动力学耦合影响各关节的运动响应。现有方法将各关节独立映射,未考虑负载对关节运动耦合的影响,导致从端在受限环境中运动不平稳或与环境发生碰撞。

6、因此,需要一种能够利用操作者生理信号和从端环境交互力自适应调节各关节增量映射比例系数的方法。

技术实现思路

1、本发明提供一种同构型人机上肢主从增量映射方法及系统,用于解决上述至少一个技术问题。

2、第一方面,本发明提供一种同构型人机上肢主从增量映射方法,包括:

3、获取操作者上肢各关节的关节角度增量信号和所述操作者的表面肌电信号;

4、从所述表面肌电信号中提取各肌群的激活时序,根据所述激活时序确定所述操作者当前关节的肌肉协调滞后量;

5、根据所述关节角度增量信号中各关节的增量方向和增量幅值,结合所述肌肉协调滞后量,确定各关节的运动增益调节方向;

6、获取从端机械臂末端执行器与作业环境之间的接触力信号和接触力矩信号,以及所述从端机械臂各关节的当前关节角度;

7、根据所述接触力信号和所述接触力矩信号计算所述从端机械臂末端执行器的实际运动轨迹与期望运动轨迹之间的偏离方向,根据所述偏离方向和所述当前关节角度确定各关节的负载-运动耦合系数;

8、以所述各关节的运动增益调节方向与所述各关节的负载-运动耦合系数共同确定各关节的增量映射比例系数;

9、利用所述各关节的增量映射比例系数对所述关节角度增量信号进行缩放处理,得到从端机械臂各关节的角度增量指令,输出所述角度增量指令至所述从端机械臂的关节控制器执行。

10、第二方面,本发明提供一种同构型人机上肢主从增量映射系统,包括:

11、第一获取模块,配置为获取操作者上肢各关节的关节角度增量信号和所述操作者的表面肌电信号;

12、第一确定模块,配置为从所述表面肌电信号中提取各肌群的激活时序,根据所述激活时序确定所述操作者当前关节的肌肉协调滞后量;

13、第二确定模块,配置为根据所述关节角度增量信号中各关节的增量方向和增量幅值,结合所述肌肉协调滞后量,确定各关节的运动增益调节方向;

14、第二获取模块,配置为获取从端机械臂末端执行器与作业环境之间的接触力信号和接触力矩信号,以及所述从端机械臂各关节的当前关节角度;

15、计算模块,配置为根据所述接触力信号和所述接触力矩信号计算所述从端机械臂末端执行器的实际运动轨迹与期望运动轨迹之间的偏离方向,根据所述偏离方向和所述当前关节角度确定各关节的负载-运动耦合系数;

16、第三确定模块,配置为以所述各关节的运动增益调节方向与所述各关节的负载-运动耦合系数共同确定各关节的增量映射比例系数;

17、输出模块,配置为利用所述各关节的增量映射比例系数对所述关节角度增量信号进行缩放处理,得到从端机械臂各关节的角度增量指令,输出所述角度增量指令至所述从端机械臂的关节控制器执行。

18、第三方面,提供一种电子设备,其包括:至少一个处理器,以及与所述至少一个处理器通信连接的存储器,其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行本发明任一实施例的同构型人机上肢主从增量映射方法的步骤。

19、第四方面,本发明还提供一种计算机可读存储介质,其上存储有计算机程序,所述程序被处理器执行时,使所述处理器执行本发明任一实施例的同构型人机上肢主从增量映射方法的步骤。

20、本申请的同构型人机上肢主从增量映射方法及系统,具有以下有益效果:

21、从表面肌电信号中提取主动肌与拮抗肌的激活窗口,通过共激活时长与交替激活时长的差值判断操作者当前采用速度优先策略还是精度优先策略。该判断不依赖肌电幅值的绝对值,仅依赖激活窗口的时间结构特征,对不同操作者之间的肌电幅值差异具有免疫性。

22、速度优先模式下,增量幅值越大增益增强越强,使从端快速响应大幅值操作意图;精度优先模式下,增量幅值越大增益抑制越强,使从端平缓响应大幅值操作意图,避免精细操作中的过冲。两种模式下增益调节方向完全相反,实现了基于操作策略的自适应增益方向切换。

23、通过比较从端末端执行器实际运动方向与期望运动方向之间的偏离方向,结合等效接触力矩的符号,确定各关节在当前负载条件下是处于环境助力状态还是环境阻力状态。该耦合系数在速度优先模式下增强映射比例,在精度优先模式下抑制映射比例,实现了从端环境交互力的自适应利用和规避。

1.一种同构型人机上肢主从增量映射方法,其特征在于,包括:

2.根据权利要求1所述的一种同构型人机上肢主从增量映射方法,其特征在于,所述获取操作者上肢各关节的关节角度增量信号和所述操作者的表面肌电信号包括:

3.根据权利要求1所述的一种同构型人机上肢主从增量映射方法,其特征在于,所述从所述表面肌电信号中提取各肌群的激活时序,根据所述激活时序确定所述操作者当前关节的肌肉协调滞后量包括:

4.根据权利要求1所述的一种同构型人机上肢主从增量映射方法,其特征在于,所述根据所述关节角度增量信号中各关节的增量方向和增量幅值,结合所述肌肉协调滞后量,确定各关节的运动增益调节方向包括:

5.根据权利要求1所述的一种同构型人机上肢主从增量映射方法,其特征在于,所述根据所述接触力信号和所述接触力矩信号计算所述从端机械臂末端执行器的实际运动轨迹与期望运动轨迹之间的偏离方向,根据所述偏离方向和所述当前关节角度确定各关节的负载-运动耦合系数包括:

6.根据权利要求1所述的一种同构型人机上肢主从增量映射方法,其特征在于,所述以所述各关节的运动增益调节方向与所述各关节的负载-运动耦合系数共同确定各关节的增量映射比例系数包括:

7.根据权利要求1所述的一种同构型人机上肢主从增量映射方法,其特征在于,所述利用所述各关节的增量映射比例系数对所述关节角度增量信号进行缩放处理,得到从端机械臂各关节的角度增量指令,输出所述角度增量指令至所述从端机械臂的关节控制器执行包括:

8.一种同构型人机上肢主从增量映射系统,其特征在于,包括:

9.一种电子设备,其特征在于,包括:至少一个处理器,以及与所述至少一个处理器通信连接的存储器,其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行权利要求1至7任一项所述的方法。

10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述程序被处理器执行时实现权利要求1至7任一项所述的方法。