[发明专利]基于变刚度的外肢体机器人辅助支撑方法有效
申请号: | 202210231857.9 | 申请日: | 2022-03-09 |
公开(公告)号: | CN114800440B | 公开(公告)日: | 2023-07-25 |
发明(设计)人: | 曾洪;张华宇;张建喜;宋爱国 | 申请(专利权)人: | 东南大学 |
主分类号: | B25J9/00 | 分类号: | B25J9/00 |
代理公司: | 南京众联专利代理有限公司 32206 | 代理人: | 周蔚然 |
地址: | 210096 *** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 刚度 肢体 机器人 辅助 支撑 方法 | ||
1.基于变刚度的外肢体机器人辅助支撑方法,其特征在于,所述辅助支撑方法步骤为:
步骤1、实时获取放置于穿戴者手臂上的表面肌电传感器和惯性传感器的原始输出数据;
步骤2、对获取的惯性传感器数据进行处理,用于判断人体是否有操作意图,如果人体有操作意图,外肢体机器人协助人体将物体支撑到需要的位置;
所述惯性传感器数据包括俯仰角、偏航角和翻滚角,选用俯仰角作为操作意图识别的特征,具体计算方法如下:
其中,α为当前时刻的俯仰角,T=1表示有操作意图,T=0表示无操作意图;
步骤3、当物体处于支撑状态后,对原始的sEMG数据进行预处理,包括全波整流、低通滤波和归一化;
所述的预处理方法具体为:首先通过对原始sEMG进行全波整流处理,处理后的sEMG均为非负,处理方法如下:
P1(i)=|EMGraw(i)|
其中,i为采样点序号,EMGraw(i)为第i个采样点的原始sEMG信号幅值,P1(i)为全波整流处理后第i个采样点的sEMG信号幅值;
接下来,对经过全波整流处理后的sEMG进行低通滤波处理,低通滤波器选择二阶巴特沃斯滤波器,处理后的sEMG去除了噪声的包络,处理方法如下:
P2(i)=LPF(P1(i),f)
其中,P2(i)为低通滤波器处理后第i个采样点的sEMG信号幅值,LPF为信号幅值,f为低通滤波器的截止频率;
最后,对经过低通滤波处理后的sEMG包络基于最大自主收缩进行归一化,处理方法如下:
其中,P3(i)为归一化处理后第i个采样点的sEMG信号幅值,M为肌肉最大收缩时的sEMG信号幅值;
步骤4、预处理后的sEMG数据用于估计手臂的参考刚度;
计算参考刚度的方法具体为:首先需要计算一对主动肌和拮抗肌的肌肉激活度,计算方法如下;
其中,a(i)为肌肉激活度,A为非线性度参考,取值范围为(-3,0);
通过计算的主动肌和拮抗肌的肌肉激活度,人体手臂的参考刚度能够用主动肌和拮抗肌中较小的肌肉激活度表征,计算方法如下:
Kref=min(1,aagnist,aantagonist)
其中,Kref为手臂的参考刚度,aagnist和aantagonist分别为主动肌和拮抗肌的肌肉激活度;
步骤5、将人体手臂参考刚度映射到外肢体机器人的阻抗控制模型中;
所述的刚度映射方法具体为:首先将刚度水平映射到机械臂上,进而调节机械臂的刚度矩阵,计算方法如下:
Kmap=(Kmax-Kmin)Kref+Kmin
其中,Kmax和Kmin分别为机械臂的最大刚度和最小刚度,Kmap为映射刚度;
接下来,通过刚度映射得到机械臂的刚度矩阵和阻尼矩阵,计算方法如下:
Kd=Sk(1-Kmap)
其中,Kd、Bd分别为外肢体机器人的机械臂的刚度矩阵和阻尼矩阵,ζ为阻尼比,Sk为系数对角矩阵。
2.根据权利要求1所述的基于变刚度的外肢体机器人辅助支撑方法,其特征在于,步骤1所述的原始输出数据由程序自动地从表面肌电传感器和惯性传感器实时读取,其中表面肌电传感器放置于肱二头肌和肱三头肌这一对拮抗肌的位置,惯性传感器放置于人体手臂的腕部。
3.根据权利要求1所述的基于变刚度的外肢体机器人辅助支撑方法,其特征在于,步骤5中所述的阻抗控制模型用下式表示:
其中,Md、Bd、Kd为期望的惯性矩阵、阻尼矩阵和刚度矩阵,X、为实际的位移、速度和加速度,Xd、为期望的位移、速度和加速度,Fext为机械臂末端与环境间的交互力。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于东南大学,未经东南大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210231857.9/1.html,转载请声明来源钻瓜专利网。