一种基于步态相位感知与风险约束的下肢外骨骼控制方法

摘要: 本发明涉及视觉处理,具体而言,涉及一种基于步态相位感知与风险约束的下肢外骨骼控制方法。背景技术:1、下肢外骨骼是一种与人体下肢协同运动的可穿戴助力设备,通过驱动...
一种基于步态相位感知与风险约束的下肢外骨骼控制方法

本发明涉及视觉处理,具体而言,涉及一种基于步态相位感知与风险约束的下肢外骨骼控制方法。

背景技术:

1、下肢外骨骼是一种与人体下肢协同运动的可穿戴助力设备,通过驱动髋关节、膝关节等部位,为佩戴者提供行走辅助。在平地、坡道、楼梯及不规则地面等不同环境中,人体行走所需的关节运动轨迹、助力力矩和抬脚高度存在差异。下肢外骨骼的控制则通过足底压力传感器、惯性传感器及关节编码器等获取人体运动和足部接触信息,并据此识别步态状态、调整关节助力。然而,仅依靠传感信息进行控制时,地形变化则需要在足部接触或人体运动状态发生变化后才能得到确认,提前调整助力参数的时间会受到限制,但采用视觉识别时,识别区域会包含佩戴者不会经过的地形或背景物体,导致识别结果与实际落脚区域不匹配,同时,地形类别相同并不意味着其几何条件相同,不同坡度、台阶高度和台阶深度对应的运动需求存在差异,仅根据地形类别配置助力参数,难以适应这些差异。

2、因此,有必要设计一种基于步态相位感知与风险约束的下肢外骨骼控制方法用以解决当前技术中存在的问题。

技术实现思路

1、鉴于此,本发明提出了一种基于步态相位感知与风险约束的下肢外骨骼控制方法,旨在解决采用视觉识别时,识别结果与实际落脚区域不匹配,仅根据地形类别配置助力参数,难以适应这些差异的问题。

2、本发明提出了一种基于步态相位感知与风险约束的下肢外骨骼控制方法,包括:

3、获取彩色图像和深度图像,基于所述彩色图像将所述深度图像中的像素点转换至外骨骼本体坐标系,确定三维地形点云,基于归一化步态相位预测足部落脚位置,并以所述预测足部落脚位置为中心在三维地形点云中构建动态感兴趣区域;

4、对所述动态感兴趣区域进行多任务视觉识别,输出地形语义概率向量和连续几何参数向量,基于地形边界与所述预测落脚点的空间关系以及预设提前调节时间确定地形参数;

5、基于所述地形语义概率向量、所述连续几何参数向量、所述归一化步态相位以及个体参数确定外骨骼控制参数以及关节期望输出力矩,并基于最小关节角度和最大关节角度对所述关节期望输出力矩进行约束,基于地形识别结果、深度图像完整度和图像模糊程度计算综合地形感知风险值;

6、将所述综合地形感知风险值和风险阈值进行对比,若所述综合地形感知风险值大于或等于所述风险阈值,则停止视觉预测生成摆动轨迹,若检测到足部触地,基于足底压力确定实际触地状态,并基于预测协方差和触地测量噪声计算校正增益,基于所述校正增益更新所述地形参数以及视觉深度偏差。

7、进一步的,在确定三维地形点云时,包括:

8、在第k个视觉处理时刻,根据下列公式将像素点转换至外骨骼本体坐标系:

9、;

10、其中,(u,v)为像素坐标,cx、c为视觉传感器光心在图像上的像素坐标,fx、f分别表示在x轴和y轴方向上的像素焦距,和分别为视觉传感器坐标系至外骨骼本体坐标系的旋转矩阵和平移向量,为变换后的三维地形点,表示第k个视觉处理时刻像素坐标处的深度值。

11、进一步的,在构建动态感兴趣区域时,包括:

12、根据所述归一化步态相位获取第j次足部触地相对于当前时刻的剩余时间,并基于外骨骼本体位置、预测行走速度、预测行进方向、预测步宽及预测触地腿的左右标识,确定第j次预测足部落脚位置;

13、以所述预测足部落脚位置为中心,在横向和竖直方向上分别设定半尺寸限制,构建第j个动态感兴趣区域

14、所述动态感兴趣区域的纵向半尺寸和横向半尺寸基于所述预测行走速度、所述剩余时间以及上一时刻的视觉不确定性进行调整。

15、进一步的,在进行多任务视觉识别时,包括:

16、将所述彩色图像、所述深度图像和所述动态感兴趣区域和所述归一化步态相位输入多任务地形识别模型,确定地形语义概率向量,地形语义类别至少包括平地、上坡、下坡、上楼梯、下楼梯和不规则地面;

17、所述连续几何参数向量包括地面坡度、台阶高度、台阶深度、地形边界位置、障碍物高度,地形粗糙度,落脚区域平整度,目标地形与佩戴者的距离。

18、进一步的,在确定地形参数时,包括:

19、根据地形边界分布和所述预测足部落脚位置,确定未来首次进入新地形的落脚序号,所述落脚序号由下列公式确定:

20、;

21、其中,为落脚序号,为当前支撑地形类别,为预测足部落脚位置对应的预测地形类别,预测到达地形转换区域的剩余步数为所述落脚序号减1,基于所述落脚序号获取预测到达地形转换区域剩余时间,并基于所述预设提前调节时间和所述预测到达地形转换区域剩余时间的差值确定过渡进度,并基于连续可导平滑函数确定融合后的地形参数。

22、进一步的,在确定外骨骼控制参数以及关节期望输出力矩时,包括:

23、所述个体参数包括腿长、体重、关节活动范围、步长、初始肌力和在线自适应参数;

24、所述外骨骼控制参数为所述归一化步态相位及佩戴者个体参数对应的基础控制参数项、针对第c类地形对应的控制参数增量项和所述连续几何参数向量至控制参数的映射矩阵项的求和结果。

25、进一步的,在确定外骨骼控制参数以及关节期望输出力矩时,还包括:

26、获取关节角度参考值,并获取关节角速度参考值,所述关节角度参考值为膝关节参考角度和膝关节参考角度,所述关节角速度参考值为膝关节参考角速度和膝关节参考角速度;

27、获取第k视觉处理时刻检测的关节角度实际值和关节角速度实际值,获取所述关节角度参考值和所述关节角度实际值的第一差值,获取所述关节角速度参考值和所述关节角速度实际值的第二差值;

28、将关节等效刚度矩阵和所述第一差值的乘积值,阻尼矩阵和所述第二差值的乘积值以及前馈助力力矩的求和结果作为所述关节期望输出力矩。

29、进一步的,在对所述关节期望输出力矩进行约束时,包括:

30、

31、其中,为最小关节角度,为最大关节角度,表示关节角度参考值,为关节期望输出力矩,为k-1时刻的关节期望输出力矩,为最大关节输出力矩,表示相邻控制时刻的最大力矩变化量,表示参考关节轨迹的加加速度,表示最大轨迹加加速度。

32、进一步的,在计算综合地形感知风险值时,包括:

33、所述综合地形感知风险值基于地形语义概率向量、图像与传感器之间的归一化冲突程度、第c类地形的预测概率、归一化分类熵、深度图像缺失比例、图像模糊程度和遮挡比例与对应的权重确定,且各权重大于或等于0,各权重的总和等于1。

34、进一步的,所述的基于步态相位感知与风险约束的下肢外骨骼控制方法,还包括:所述风险阈值大于0,且小于或等于1,基于所述校正增益更新融合后的地形参数以及视觉深度偏差。

35、与现有技术相比,本发明的有益效果在于:通过基于步态相位构建动态感兴趣区域,将视觉感知范围限定于实际的落脚走廊,降低了背景物体、无关地形及摄像机晃动的干扰,实现了对即将接触地形的提前精准感知。通过地形语义类别与连续几何参数的联合识别,避免了同一地形类别下不同几何条件采用相同控制参数的风险,提升了外骨骼对复杂地形差异的适应能力。通过预测地形转换时刻并提前平滑过渡控制参数,解决了控制模式切换滞后或过早导致的人机运动不协调问题,实现了地形交界处的平顺助力,且从地形参数到助力参数的连续映射机制,结合多重安全约束,避免了模式切换带来的力矩冲击,保障了运动平稳性与佩戴安全性。基于综合风险评估在视觉感知不可靠时自动切换至本体传感控制,规避了错误视觉识别引发的安全风险。通过视觉预测与足部触地反馈的闭环校正,随着行走过程不断提升了感知与控制精度。