下肢外骨骼控制方法及装置与流程

本发明涉及机器人控制领域，尤其是一种下肢外骨骼控制方法及装置。

背景技术：

随着世界各国相继进入老龄化国家，脑卒中用户越来越多。通常脑卒中用户都残留各种各样的后遗症，包括偏瘫、语言不利、神志障碍、面瘫、大小便失禁等，其中偏瘫居首位，脑卒中治疗周期长，给用户本人、家庭以及社会带来极大地经济负担和心理压力，相关康复治疗设备的研发备受关注。国内外在康复训练机器人领域做了大量的研究，也有一些可用于肢体康复训练的产品，例如rewalk是一个由以色列制造商rewalk机械公司设计制造的外骨骼系统，主要用途是协助下肢瘫痪的病人能够再次站立行走，但是该外骨骼只能以恒定步态进行被动行走，又例如，中国的大艾机器人的下肢外骨骼康复机器人“艾动”及“艾康”能够进行下肢康复训练，但是与rewalk相似只能以恒定步态进行被动行走。因此需要提出一种能够根据用户步态实现健侧腿带动患侧腿，提高康复训练效果的下肢外骨骼主动控制方法。

技术实现要素：

本发明旨在至少在一定程度上解决相关技术中的技术问题之一。为此，本发明的目的是提供一种能够根据用户步态实现健侧腿带动患侧腿，提高康复训练效果的下肢外骨骼主动控制方法。

本发明所采用的技术方案是：

第一方面，本发明提供一种下肢外骨骼控制方法，包括：

获取足底压力传感器采集的用户数据，所述用户数据包括：健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值；

根据所述用户数据判断用户意图得到用户运动状态，所述用户运动状态包括：第一运动状态、第二运动状态、第三运动状态和第四运动状态；

根据所述运动状态选择对应的控制模式，所述控制模式包括：助力模式和随动模式；

根据不同的控制模式发送控制信号到驱动器驱动电机进行所述外骨骼控制。

进一步地，判断用户意图具体为：

设定起始状态为第一运动状态；

当状态持续时间大于第一阈值，且所述健侧脚足跟压力数据小于第二阈值时，切换当前用户运动状态为第二运动状态；

当状态持续时间大于第三阈值，且所述健侧脚足跟压力数据大于第四阈值时，切换当前用户运动状态为第三运动状态；

当状态持续时间大于第五阈值，且所述健侧脚足尖压力数据大于第六阈值时，切换当前用户运动状态为第四运动状态；

当状态持续时间大于第七阈值，且所述患侧脚足跟压力数据大于第八阈值时，切换当前用户运动状态为第一运动状态。

进一步地，患侧腿始终选择所述助力模式；当处于所述第二运动状态时，健侧腿选择所述随动模式，当处于其他用户运动状态时，所述健侧腿选择所述助力模式。

进一步地，所述随动模式为力矩pid控制模式，具体为：

根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差；

结合所述力矩误差和pid控制系数计算得到驱动器控制量；

利用所述驱动器控制量驱动电机进行所述外骨骼控制。

进一步地，所述助力模式为阻抗控制模式，具体为：

根据关节转动期望角度和关节实际转动角度计算关节转动角度误差；

根据所述关节转动角度误差进行阻抗控制，计算得到关节期望力矩；

根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差；

结合所述力矩误差和pid控制系数计算得到驱动器控制量；

利用所述驱动器控制量驱动电机进行所述外骨骼控制。

进一步地，所述随动模式下所述关节期望力矩设置为零。

进一步地，所述重力补偿具体为：根据关节转动角度以及系统补偿系数计算得到关节补偿力矩。

第二方面，本发明还提供一种下肢外骨骼控制装置，包括：

获取用户数据模块：用于获取足底压力传感器采集的用户数据，所述用户数据包括：健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值；

判断用户意图模块：用于根据所述用户数据判断用户意图得到用户运动状态，所述用户运动状态包括：第一运动状态、第二运动状态、第三运动状态和第四运动状态；

选择控制模式模块：用于根据所述运动状态选择对应的控制模式，所述控制模式包括：助力模式和随动模式；

外骨骼控制模块：用于根据不同的控制模式发送控制信号到驱动器驱动电机进行所述外骨骼控制。

第三方面，本发明还提供一种下肢外骨骼，利用如第一方面任一项所述的一种下肢外骨骼控制方法进行控制。

第四方面，本发明还提供一种下肢外骨骼控制设备，包括：

至少一个处理器；以及，与所述至少一个处理器通信连接的存储器；

其中，所述处理器通过调用所述存储器中存储的计算机程序，用于执行如第一方面任一项所述的方法。

本发明的有益效果是：

本发明通过获取足底压力传感器采集的用户数据，用户数据包括：健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值，根据用户数据判断用户意图得到包括第一运动状态、第二运动状态、第三运动状态和第四运动状态在内的用户运动状态，然后根据运动状态选择对应的控制模式，其中，控制模式包括：助力模式和随动模式，最后根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制。通过运动意图识别，可针对不同运动状态提供不同的控制模式，针对不同运动状态给穿戴者提供不同的助力模式，从而实现根据用户步态实现健侧腿带动患侧腿，而且行走速度可由用户健侧腿运动状态自主调节，能够激发用户的训练主动性，以及消除人机不匹配导致的安全隐患，具有更好的康复效果及安全性，可广泛应用于外骨骼助力领域。

附图说明

图1是本发明中下肢外骨骼控制方法的一具体实施例的实现流程图；

图2是本发明中下肢外骨骼控制方法的一具体实施例的用户运动状态切换示意图；

图3是本发明中下肢外骨骼控制方法的一具体实施例的重力补偿示意图；

图4是本发明中下肢外骨骼控制方法的一具体实施例的系统结构示意图；

图5是本发明中下肢外骨骼控制方法的一具体实施例的控制流程示意图；

图6是本发明中下肢外骨骼控制装置的一具体实施例的结构框图。

具体实施方式

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对照附图说明本发明的具体实施方式。显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图，并获得其他的实施方式。

除非另有定义，本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的，不是旨在于限制本发明。

实施例一：

本发明实施例一提供一种下肢外骨骼控制方法，图1为本发明实施例提供的下肢外骨骼控制方法的实现流程图，如图1所示，该方法包括以下步骤：

s1：获取足底压力传感器采集的用户数据。

本实施例中，用户数据包括：健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值，主要是根据用户步态实现健侧腿带动患侧腿训练，其行走速度可由用户健侧腿运动状态自主调节，不同行走速度下，足底压力传感器采集的用户数据不同，进一步地，足底压力传感器可以安装在外骨骼的足底。

s2：根据用户数据判断用户意图得到用户运动状态，所述用户运动状态包括：第一运动状态、第二运动状态、第三运动状态和第四运动状态；

s3：根据所述运动状态选择对应的控制模式，所述控制模式包括：助力模式和随动模式，具体的，患侧腿始终选择助力模式，当处于第二运动状态时，健侧腿选择随动模式，当处于其他用户运动状态时，健侧腿选择助力模式。

s4：根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制。

如图2所示，为本实施例中用户运动状态切换示意图，即判断用户意图得到用户运动状态，从图中可以看出，设定起始状态为第一运动状态(即双脚触地患侧在前状态)，当状态持续时间大于第一阈值f1，且健侧脚足跟压力数据小于第二阈值f2时，切换当前用户运动状态为第二运动状态(即健侧腿摆动相状态)；当状态持续时间大于第三阈值f3，且健侧脚足跟压力数据大于第四阈值f4时，切换当前用户运动状态为第三运动状态(即双脚触地健侧在前状态)；当状态持续时间大于第五阈值f5，且健侧脚足尖压力数据大于第六阈值f6时，切换当前用户运动状态为第四运动状态(即患侧腿摆动相状态)；当状态持续时间大于第七阈值f7，且患侧脚足跟压力数据大于第八阈值f8时，切换当前用户运动状态为第一运动状态(即双脚触地患侧在前状态)，即完成一个周期循环。

本实施例中，第一阈值～第八阈值均是根据实际动作采集获取的值，能够反应用户处于不同用户运动状态，根据采集的值判断用户运动状态，进一步地，第三阈值f3和第七阈值f7可选的值为1.5s，第一阈值f1和第五阈值f5可选的值为0.1s-0.2s之间的值，即满足压力大小条件的情况下，当状态持续时间大于1.5s时，从第二运动状态切换到第三运动状态或从第四运动状态切换到第一运动状态，当状态持续时间大于在0.1s-0.2s之间选取的阈值时，从第一运动状态切换到第二运动状态或从第三运动状态切换到第四运动状态，进一步地，第二阈值f2、第四阈值f4、第六阈值f6、第八阈值f8可选的值为2800。上述仅做取值示意，不做限定，凡是能够通过上述意图识别过程识别出用户运动状态的判断数值，均能作为本实施例的阈值取值。

步骤s3中，控制模式包括：助力模式和随动模式，具体的两种控制模式如下所述。

1)随动模式为力矩pid控制模式：

s311：根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差，表示为：

et＝td-tact+tg(1)

其中，td表示关节期望力矩，通过阻抗控制计算得到，tact表示关节实际力矩，通过惯性传感器测量得到，tg表示关节补偿力矩，通过重力补偿公式计算得到，et表示力矩误差。

s312：结合力矩误差和pid控制系数计算得到驱动器控制量，表示为：

其中，∫et·dt表示力矩误差的积分，表示力矩误差的微分，kp、ki、kd表示pid控制系数，分别为pid控制的比例、积分、微分系数，均可通过实验数据拟合得到，u表示驱动器控制量。

s313：利用驱动器控制量驱动电机进行外骨骼控制。

并且，随动模式下关节期望力矩td设置为零。

2)助力模式为阻抗控制模式：

s321：根据关节转动期望角度和关节实际转动角度计算关节转动角度误差，表示为：

eq＝qd-qact(3)

其中，qd表示关节转动期望角度，可通过程序实时规划生成，qact表示关节实际转动角度，通过惯性传感器测量得到，eq表示关节转动角度误差。

s322：根据关节转动角度误差进行阻抗控制，计算得到关节期望力矩，表示为：

其中，td表示关节期望力矩，表示关节转动角度误差的微分，ai表示阻抗控制刚度系数，bi表示阻抗控制阻尼系数，阻抗控制刚度系数和阻抗控制阻尼系数可以通过实验数据拟合得到。

s323：根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差，计算同公式(1)。

s324：结合力矩误差和pid控制系数计算得到驱动器控制量，计算同公式(2)。

s325：利用驱动器控制量驱动电机进行外骨骼控制。

如图3所示，为本实施例重力补偿示意图，如图所示，重力补偿具体为：根据关节转动角度以及系统补偿系数计算得到关节补偿力矩，例如对摆动侧腿进行重力补偿，包括膝关节补偿和髋关节补偿，即重力补偿力矩tg相应的包括膝关节补偿力矩和髋关节补偿力矩，公示表示为：

tknee＝kknee·sin(θk+θh)(5)

thip＝khip1·sinθh+khip2·sin(θk+θh)(6)

其中，tknee表示膝关节补偿力矩，thip表示髋关节补偿力矩，θk表示膝关节转动角度，θh表示髋关节转动角度，kknee、khip1、khip2分别表示系统辨识系数，该系数通过实验数据拟合得到。

如图4所示，为本实施例的系统结构示意图，包括足底压力传感器01、编码器02、主控板03、驱动器04及电机05，足底压力传感器01实时采集用户数据，编码器02用于进行阻抗控制和重力补偿过程中关节角度和关节力矩的获取，主控板03获取采集的数据并判断用户意图，进行用户运动状态切换，同时对应匹配不同的控制模式(随动模式和助力模式)，患侧腿始终选择助力模式，当处于第二运动状态时，健侧腿选择随动模式，当处于其他用户运动状态时，健侧腿选择助力模式，并将不同控制模式下的控制信号(驱动器控制量)发送给驱动器04，以驱动电机05运动实现外骨骼的闭环控制。

如图5所示，为本实施例控制流程示意图，首先采集用户数据，进行用户运动意图判断，如果当前处于第二运动状态时，健侧腿选择随动模式，进入随动模式，即根据关节期望力矩td(处于随动模式时，该值为零)、关节实际力矩tact和进行重力补偿得到的关节补偿力矩tg计算力矩误差et，结合力矩误差et和pid控制系数进行pid控制，计算得到驱动器控制量u，根据驱动器控制量u驱动电机进行人机交互，即实现对外骨骼的控制。

否则，患侧腿和健侧腿均选择助力模式，进入助力模式，即根据关节转动期望角度qd和关节实际转动角度qact计算关节转动角度误差eq，然后进行阻抗控制，即计算得到关节期望力矩td，结合关节期望力矩td、关节实际力矩tact和进行重力补偿得到的关节补偿力矩tg计算力矩误差et，结合力矩误差et和pid控制系数进行pid控制，计算得到驱动器控制量u，根据驱动器控制量u驱动电机进行人机交互，即实现对外骨骼的控制。

本实施例通过运动意图识别，可针对不同运动状态提供不同的控制模式，针对不同运动状态给穿戴者提供不同的助力模式，从而实现根据用户步态实现健侧腿带动患侧腿，而且行走速度可由用户健侧腿运动状态自主调节，能够激发用户的训练主动性，以及消除人机不匹配导致的安全隐患，具有更好的康复效果及安全性。

实施例二：

如图6所示，为本实施例提供的一种下肢外骨骼控制装置结构框图，用于执行如实施例一所述的一种下肢外骨骼控制方法，包括：

获取用户数据模块10：用于获取足底压力传感器采集的用户数据，用户数据包括：健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值；

判断用户意图模块20：用于根据用户数据判断用户意图得到用户运动状态，用户运动状态包括：第一运动状态、第二运动状态、第三运动状态和第四运动状态；

选择控制模式模块30：用于根据运动状态选择对应的控制模式，控制模式包括：助力模式和随动模式；

外骨骼控制模块40：用于根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制。

实施例三：

一种下肢外骨骼，只要能够利用如实施例一任一项所述的一种下肢外骨骼控制方法进行控制，即属于本实施例的保护范围。

另外，一种下肢外骨骼控制设备，包括：至少一个处理器；以及，与至少一个处理器通信连接的存储器；其中，处理器通过调用存储器中存储的计算机程序，用于执行如实施例一任一项所述的方法。

本发明通过获取足底压力传感器采集的用户数据，用户数据包括：健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值，根据用户数据判断用户意图得到包括第一运动状态、第二运动状态、第三运动状态和第四运动状态在内的用户运动状态，然后根据运动状态选择对应的控制模式，其中，控制模式包括：助力模式和随动模式，最后根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制，可广泛应用于外骨骼助力领域。

以上各实施例仅用以说明本发明的技术方案，而非对其限制，尽管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围，其均应涵盖在本发明的权利要求和说明书的范围当中。