一种谐振匹配的下肢外骨骼扭矩-物理刚度协同控制方法
本发明涉及可穿戴机器人、人机交互控制和外骨骼助力控制,尤其涉及一种谐振匹配的下肢外骨骼扭矩-物理刚度协同控制方法。
背景技术:
1、下肢外骨骼机器人能够穿戴于人体下肢外侧,通过主动驱动髋关节、膝关节或踝关节向用户提供运动辅助,在康复训练、老年助行、工业搬运和长时间行走助力等场景中具有重要应用价值。现有外骨骼助力控制方法多以关节轨迹跟踪、助力扭矩幅值设计或虚拟阻抗调节为核心。轨迹跟踪方法通常要求用户跟随预设运动轨迹,容易限制自然步态变化;单纯扭矩轮廓控制虽然能够避免强制轨迹约束,但主要通过改变助力幅值改善辅助效果;虚拟阻抗控制能够在控制层面调节等效柔顺性,但不能直接改变执行器物理刚度和人机耦合系统的能量储存释放特性。
2、人体步行具有显著的周期性和节律性。下肢肌肉系统通过周期性调节关节扭矩和关节刚度,使人体在接近自然频率的状态下完成稳定行走,并在特定步态相位向系统注入能量以维持运动。对于具有物理刚度可调能力的变刚度外骨骼而言,关节物理刚度不应仅作为被动柔顺参数或安全参数,而应作为主动控制量参与人机耦合系统自然频率调节和能量流动调节。因此,需要一种区别于既有变刚度关节结构保护和按需柔顺控制的谐振控制方法,利用物理刚度调节实现自然频率匹配,并利用相位对齐扭矩实现能量注入,从而提高单位助力扭矩下的辅助效率。
技术实现思路
1、本发明所要解决的技术问题是针对背景技术的缺陷,提供一种谐振匹配的下肢外骨骼扭矩-物理刚度协同控制方法,在步态节律变化及局部传感扰动条件下快速、稳定地获得连续步态相位,并以所述连续步态相位和步行频率为统一时基,协同生成目标物理刚度轮廓和相位对齐助力扭矩轮廓,实现自然频率匹配和正功区间能量注入。
2、本发明为解决上述技术问题采用以下技术方案:
3、一种谐振匹配的下肢外骨骼扭矩-物理刚度协同控制方法,包括以下步骤:
4、步骤s1,采集用户行走过程中的足底压力信息、髋关节角度、膝关节角度和外骨骼姿态信息。
5、具体地,足底压力信息可由安装于足底支撑件的足底压力传感器阵列获得,髋关节角度和膝关节角度可由安装于外骨骼关节处的绝对编码器、增量编码器或磁编码器获得,外骨骼姿态信息可由安装于腰部、骨盆部位或下肢连杆上的惯性测量单元获得。对于第j个外骨骼关节,记其实时关节角度为qj(t),关节角速度为,当前物理刚度为ke,j(t)。采集得到的传感信息经滤波、归一化和时间同步处理后输入控制系统。
6、步骤s2,根据足底压力信息、关节角度信息或外骨骼姿态信息中的至少一种识别脚尖离地事件和足跟着地事件,根据所述脚尖离地事件和足跟着地事件确定支撑状态和摆动状态,并将所述脚尖离地事件和足跟着地事件中的至少一种作为当前步态周期起点和连续步态相位校正的事件锚点。
7、具体地,对于同一侧下肢,自足跟着地事件发生至下一脚尖离地事件发生的时间区间为支撑状态,自脚尖离地事件发生至下一足跟着地事件发生的时间区间为摆动状态。脚尖离地事件和足跟着地事件中的任一种均可作为步态周期起点,也可作为连续步态相位估计的事件锚点。所述步态事件识别不限于固定阈值方法,也可采用状态机、分类器、概率模型或多传感器融合方法实现。
8、步骤s3,将左右下肢髋关节角度和膝关节角度输入对称自适应振荡器,利用共享基础角频率的振荡相位及其π相位偏移分别重构左右对应关节角度,并根据各关节角度的重构误差联合更新所述基础角频率和振荡相位;当检测到被选定为事件锚点的脚尖离地事件或足跟着地事件时,根据当前步态事件对应的基准相位与当前振荡相位确定相位误差,并通过连续相位误差学习更新相位补偿量,获得连续步态相位和用户当前步行角频率。
9、具体地,所述对称自适应振荡器包括与髋关节和膝关节对应的多组振荡单元,各组振荡单元共享基础角频率。对于任一组左右对应关节,左侧关节重构信号采用相应振荡相位,右侧关节重构信号采用在所述振荡相位上叠加π后的相位,各关节对应的振荡幅值和偏置量分别独立更新;左右髋关节和左右膝关节的重构误差共同参与共享基础角频率的更新。
10、对于髋关节和膝关节中的任一关节类型j,其中j=h表示髋关节,j=k表示膝关节,左右两侧关节角度的重构信号分别满足:
11、(1)
12、(2)
13、其中, qlj(t)和qrj(t)分别为左侧和右侧第j类关节的关节角度,和分别为对应的重构信号,αlj,0(t)和αrj,0(t)为偏置量,αlj,i(t)和αrj,i(t)为振荡幅值,φj,i(t)为第i个振荡单元的振荡相位,n为每组振荡器包含的振荡单元数量。
14、左右两侧关节角度对应的重构误差满足:
15、(3)
16、各关节对应的振荡幅值和偏置量根据其自身重构误差分别独立更新,左右髋关节和左右膝关节对应的多组振荡单元共享基础角频率。所述共享基础角频率按照下式更新:
17、(4)
18、所述髋关节和膝关节对应的振荡相位按照下式更新:
19、(5)
20、其中, 为共享基础角频率的导数,vω和vφ分别为频率学习率和相位学习率。
21、将所述共享基础角频率积分并进行周期取模,获得取值范围为[0,2π)的振荡器输出相位:
22、(6)
23、当在时刻tk检测到被选定为事件锚点的步态事件ek时,根据该步态事件对应的预设基准相位φref(ek)与当前振荡器输出相位确定相位误差:
24、(7)
25、其中,ek为脚尖离地事件或足跟着地事件,用于将相位差映射至预设相位差区间,pe(tk)为当前步态事件对应的事件相位误差。
26、根据所述相位误差,按照连续相位误差学习方程更新相位补偿量φe(t)。在一种实施方式中,连续相位误差学习方程满足:
27、(8)
28、其中,ke为相位误差学习系数,为相位补偿量φe(t)的导数。
29、校正后的连续步态相位满足:
30、(9)
31、其中,φc(t)为校正后的连续步态相位。
32、用户当前步行角频率根据所述共享基础角频率确定:
33、(10)
34、其中,ωg为用户当前步行角频率。
35、当以一侧下肢的连续步态相位为参考相位时,另一侧下肢的连续步态相位满足:
36、(11)
37、其中,φc,opp(t)为另一侧下肢的连续步态相位。
38、与依赖单路关节信号的自适应振荡方法相比,多路髋、膝关节信号共同更新共享基础角频率,能够增加每个控制周期中用于步态节律学习的有效信息,加快基础角频率收敛,并降低单路关节信号短时波动对相位估计的影响。连续相位误差补偿则避免了步态事件发生时直接重置振荡相位造成的输出跳变。
39、步骤s4,根据当前步行频率、人机耦合系统等效惯量、人体关节等效刚度和外骨骼关节当前物理刚度,计算人机耦合系统自然频率及自然频率偏差。
40、具体地,控制系统将人体下肢与外骨骼视为人机耦合动力系统。对于第j个关节,人机耦合系统自然频率满足:
41、(12)
42、其中,ωn,j(t)为第j个关节对应的人机耦合系统自然频率,kh,j(t)为人体关节等效刚度,ke,j(t)为外骨骼关节当前物理刚度,jeq,j(t)为人机耦合系统等效惯量。自然频率偏差为:
43、(13)
44、其中,eω,j(t)为第j个关节对应的人机耦合系统自然频率与用户当前步行频率之间的偏差。当ωn,j(t)低于ωg(t)时,表明系统相对于当前步态节律偏软;当ωn,j(t)高于ωg(t)时,表明系统相对于当前步态节律偏硬。
45、通过将外骨骼关节当前物理刚度纳入人机耦合系统自然频率计算,使物理刚度不再仅作为预先设定的柔顺参数,而成为能够根据用户实时步行节律进行反馈调节的动力学控制量。
46、步骤s5,根据自然频率偏差确定外骨骼关节物理刚度的调节方向,并根据用户当前步行角频率和人机耦合参数计算谐振刚度项;同时根据连续步态相位和步态状态生成步态调制刚度项,将所述谐振刚度项和步态调制刚度项融合得到目标物理刚度轮廓。
47、所述谐振刚度项用于使人机耦合系统自然频率趋近于用户当前步行角频率,所述步态调制刚度项用于使外骨骼在支撑相具有较高物理刚度、在摆动相具有较低物理刚度,并使物理刚度在步态状态切换过程中连续变化。
48、具体地,谐振刚度项用于实现自然频率匹配,其表达式为:
49、(14)
50、其中,kres,j(t)为第j个关节的谐振刚度项,kmin,j和kmax,j分别为第j个关节的最小和最大可调物理刚度,为饱和函数。
51、步态调制刚度项用于体现支撑相和摆动相的不同力学需求,其表达式为:
52、(15)
53、其中,kslip,j(φc)为步态调制刚度项,ksu,j为支撑相刚度参数,ksw,j为摆动相刚度参数,h(φc)为连续支撑相权重函数。h(φc)可采用分段多项式函数、样条函数、sigmoid函数、高斯基函数加权函数或查表函数,使其在支撑相趋近于1,在摆动相趋近于0,并在支撑相与摆动相转换区间连续变化。
54、目标物理刚度为:
55、(16)
56、其中,kref,j(t)为目标物理刚度,λj为谐振刚度项权重。由式(14)至式(16)可知,目标物理刚度同时受步行频率和步态相位影响:一方面通过kres,j(t)使人机耦合系统自然频率趋近于步行频率,另一方面通过kslip,j(φc)使外骨骼在支撑相具有较高刚度、在摆动相具有较低刚度。
57、与固定刚度控制或仅按照支撑相、摆动相切换刚度的方式相比,该步骤同时考虑步行节律匹配和不同步态阶段的力学需求,避免仅提高刚度造成摆动受限,或者仅降低刚度导致支撑能力不足。
58、步骤s6,根据连续步态相位生成相位对齐的目标助力扭矩轮廓,并根据目标助力扭矩与关节角速度确定助力功率方向,使外骨骼在设定步态相位区间向人机耦合系统注入能量。
59、具体地,目标助力扭矩轮廓由连续步态相位、助力比例、相位轮廓函数和相位偏置生成,其表达式为:
60、(17)
61、其中,τref,j(t)为第j个关节的目标助力扭矩,ηj为助力比例系数,aj(φc)为相位相关幅值函数,pj(φc+δj)为相位轮廓函数,δj为相位偏置。所述相位轮廓函数可采用正弦函数、分段多项式函数、高斯基函数加权函数、样条函数或查表函数,使助力扭矩峰值与人体关节正功输出区间或推进相关相位区间相匹配。
62、为避免助力扭矩在不合适相位阻碍人体自然运动,可根据关节功率方向对目标助力扭矩进行调制。当 时,τcmd,j(t)=τref,j(t);当时,τcmd,j(t)=ρj·τref,j(t);其中,τcmd,j(t)为经功率方向调制后的目标助力扭矩,为第j个关节角速度,ρj为负功抑制系数,且0≤ρj≤1。通过式(17),外骨骼主要在关节正功区间进行相位对齐能量注入,并抑制可能阻碍用户自然运动的负功输出。
63、与按照固定时间或固定步态百分比输出预设扭矩的方式相比,所述目标助力扭矩以校正后的连续步态相位为时基,能够随用户实时步频变化保持助力时序对齐;通过功率方向校核,可减少助力扭矩在不适当相位对人体运动形成阻碍。
64、步骤s7,根据目标助力扭矩轮廓和目标物理刚度轮廓分别控制外骨骼驱动执行单元和刚度调节执行单元,重复步骤s1至步骤s7直至行走助力任务结束。
65、具体地,控制系统通过驱动执行单元跟踪目标助力扭矩,通过刚度调节执行单元跟踪目标物理刚度。所述扭矩跟踪和刚度跟踪可采用闭环反馈控制、前馈补偿控制、鲁棒控制或其组合实现。控制系统在每个控制周期内重复执行步骤s1至步骤s7,从而根据用户实时步态节律、步态相位和关节状态持续更新目标助力扭矩和目标物理刚度。
66、当检测到步态事件缺失、相位估计异常、关节角度超限、物理刚度调节超限、估计输出异常或通信异常时,控制系统将目标助力扭矩按斜坡函数衰减至预设安全值,并将目标物理刚度调整为预设安全刚度,以保证人机交互安全。
67、由此,目标助力扭矩和目标物理刚度不是两个相互独立的控制量:连续步态相位用于协调二者的步态时序,当前步行角频率用于确定物理刚度的自然频率匹配目标,物理刚度调节改变人机耦合系统的能量储放条件,助力扭矩则在相位对齐的正功区间补充系统能量,从而形成扭矩-物理刚度协同控制关系。
68、与现有技术相比,本发明具有以下有益效果:
69、1. 本发明利用左右下肢半周期对称关系,将左右髋、膝关节的多路运动信息用于共享基础角频率和振荡相位的联合学习,相比依赖单路关节信号的自适应振荡方法,能够加快步态频率收敛并降低局部运动波动对相位估计的影响。
70、2. 本发明通过将变刚度外骨骼的物理刚度与助力扭矩进行协同调节,使外骨骼能够依据步行频率和连续步态相位调节人机耦合系统动力学特性,从而提高助力过程中的节律匹配性和能量传递效率。
71、3. 本发明将外骨骼关节物理刚度作为人机耦合系统动力学调节量,根据用户当前步行频率、人机耦合系统等效惯量及关节刚度计算自然频率偏差,并据此生成谐振刚度项。相比固定物理刚度或仅以柔顺性为目标的刚度调节方法,能够使人机耦合系统自然频率随用户步行节律进行调整,改善外骨骼与人体之间的节律匹配和弹性能量储存释放过程。
72、4. 本发明将谐振刚度项与步态调制刚度项融合生成目标物理刚度轮廓,在进行自然频率匹配的同时,根据支撑状态和摆动状态调节关节物理刚度,使外骨骼在支撑阶段保持所需的承载和支撑能力,在摆动阶段保持较好的运动柔顺性,并在不同步态阶段切换时实现物理刚度的连续过渡。
73、5. 本发明提出相位对齐助力扭矩生成和功率方向进行二次调制,使助力能量主要注入人体关节正功区间,减少不适当相位下的负功输出及其对自然运动的阻碍。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com