一种基于三维平衡状态流形引导的动态平衡恢复控制方法技术

本公开是关于一种基于三维平衡状态流形引导的动态平衡恢复控制方法、装置、电子设备以及存储介质。该方法包括：基于外骨骼的传感器采集传感器信号计算多阶导数，生成系统质心运动状态；基于质心位置、质心速度、倒立摆摆长拟合三维平衡状态流形的前向、后向失稳边界函数；计算与所述最优回归运动状态点对应的目标瞬态捕捉点；基于瞬态捕捉点、质心状态点、压力中心点间的预设平衡约束关系，计算作用于质心位置处的水平动态平衡修正力；根据步态相位以及平衡调节作用分配到述外骨骼的各条腿的各个关节的动态平衡修正力，生成映射到各关节处的平衡恢复修正力矩。本公开有助于提高下肢外骨骼对期望目标平衡状态的检测和拟人化动态平衡调节的能力。平衡调节的能力。平衡调节的能力。

【技术实现步骤摘要】
一种基于三维平衡状态流形引导的动态平衡恢复控制方法


[0001]本公开涉及机器人
，具体而言，涉及一种基于三维平衡状态流形引导的动态平衡恢复控制方法、装置、电子设备以及计算机可读存储介质。

技术介绍

[0002]随着外骨骼机器人技术的快速发展，下肢外骨骼已广泛应用于医疗康复、负重携行、运动助行等各行方面。在穿戴者
‑
外骨骼人机耦合系统的运动过程中，当外力作用、坑地踩空、障碍牵绊外界干扰作用时系统易产生失稳甚至是摔倒的情况，此时外骨骼需要及时检测人机系统的动态平衡状态是否被打破，并对关节施加合适的力矩使得穿戴者能够快速恢复到原来的平衡状态，并且不同穿戴者的身高、体重、关节力量存在差异，需要在所施加的力矩作用下关节的运动趋势与穿戴者的目标运动意图能够保持一致。目前人机耦合系统的平衡状态评估多采用质心倒立摆模型，但是该模型的平衡判断依据多为矢状面内水平方向上的等效质心或瞬态捕捉点不超出足底边界或动态边界，然而当穿戴者的踝、髋、膝关节发生弯曲时，在不同的位姿下质心会产生水平
‑
竖直方向上的位置变化，导致倒立摆模本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于三维平衡状态流形引导的动态平衡恢复控制方法，其特征在于，所述方法包括：基于外骨骼的角度传感器、姿态传感器、压力传感器采集传感器信号，计算所述传感器信号的多阶导数，生成当前控制周期下矢状面内的系统质心运动状态；根据人机系统预设的失稳状态范围，基于质心位置、质心速度、倒立摆摆长拟合三维平衡状态流形的前向失稳边界函数和后向失稳边界函数；基于当前失稳状态点所处的动态失稳区域，搜索与所述动态失稳区域相对应的最优回归运动状态点，并计算与所述最优回归运动状态点对应的目标瞬态捕捉点；基于瞬态捕捉点、质心状态点、压力中心点间的预设平衡约束关系，计算作用于质心位置处的水平动态平衡修正力；根据预设的所述外骨骼的各条腿所处的步态相位以及发挥的平衡调节作用，基于所述水平动态平衡修正力计算分配到述外骨骼的各条腿的各个关节的动态平衡修正力，生成映射到各关节处的平衡恢复修正力矩。2.如权利要求1所述的方法，其特征在于，所述方法还包括：基于外骨骼的角度传感器采集关节角度传感器信号；基于外骨骼的姿态传感器采集线加速度传感器信号、姿态角度传感器信号；基于外骨骼的压力传感器采集传感器信号采集接触力信传感器信号。3.如权利要求1所述的方法，其特征在于，所述方法中根据人机系统预设的失稳状态范围，基于质心位置、质心速度、倒立摆摆长拟合三维平衡状态流形的约束条件包括：平衡恢复过程中倒立摆近似做变加速回转运动，下一个离散化时间节点的倒立摆角加速度由施加的踝关节力矩决定，角速度和角度的约束条件；平衡恢复过程中施加的力矩与踝关节力矩范围的约束条件；倒立摆模型与水平面的约束条件；零力矩点与有效支撑域的约束条件；倒立摆的目标平衡状态的微小邻域的约束条件。4.如权利要求1所述的方法，其特征在于，所述方法还包括：基于当前失稳状态点所处的动态失稳区域及质心运动状态点，计算质心运动状态点与最优回归运动状态点间的欧几里得范数的平方；对所述欧几里得范数的平方分别进行偏导数求解；基于偏导数求解的最小解，生成所述动态失稳区域相对应的最优回归运动状态点。5.如权利要求1所述的方法，其特征在于，所述方法还包括：基于广义函数及瞬态捕捉...

【专利技术属性】
技术研发人员：滑宇翔，吴庆勋，张利剑，刘昊，
申请(专利权)人：北京机械设备研究所，
类型：发明
国别省市：