[发明专利]一种用于助力外骨骼系统的控制方法

说明书

技术领域

本发明属于自动控制技术领域，涉及一种用于助力外骨骼系统的控制方法。

背景技术

在抢险救灾或山地环境中，人们往往需要携带大量的装备和物资，这样会影响行进速度、行走距离和机动能力，因此，各国正在加速研制符合人体工程学的外骨骼携行助力系统，以实现减少体能消耗，提高负重能力和机动能力。目前的助力外骨骼系统主要的控制方法为采用液压控制系统，并结合PID控制方法进行控制，而PID控制方法需要先给出控制参数，目前常用的PID参数给定方法为试凑法，就是根据控制器各参数对系统性能的影响程度，观察系统的运行，边修改参数，直到满意为止，而对于像液压这样的系统，由于系统参数在运行过程中是不断变化的，如在伺服阀零位，液压尼系数很小而流量放大Kq系数却很大，且电液伺服阀有时不在零位工作等，当系统的参数发生变化时，系统的模型也随之改变，以不变的控制参数去控制易发生变化的对象，PID控制效果很难保证。

发明内容

本发明的目的，就是针对上述问题，提供一种电机控制与液压控制相结合的用于助力外骨骼系统的控制方法。

本发明的技术方案为：一种用于助力外骨骼系统的控制方法，其特征在于，包括：

根据人体对助力外骨骼系统的依赖程度，将助力外骨骼系统的控制分为粗调控制和精调控制；具体方法首先通过感知系统分析出目前人体的运动状态，根据不同的运动状态，如低速行走、站立、下蹲、起蹲和高速行走，通过粗调控制方法，利用电机控制，控制油源压力，以达到不同的运动状态所要求的液压控制量；同时，在粗调控制的基础上，为了更加精确地控制外骨骼的运动姿态，采用精调控制，通过液压缸伸长量调节外骨骼末端肢节的位姿，以达到期望的位姿，最终让外骨骼精确地实现不同的运动状态。所述助力外骨骼系统的动力控制装置为由伺服电机控制的液压泵和由伺服阀控制的液压缸构成，其中，液压泵连接有油箱，伺服电机的输出由油源压力期望值和液压泵输出的油源压力输出值共同调节，伺服电机控制液压泵的输出，液压泵的输出还与伺服阀连接，伺服阀由液压缸期望位移值、油源压力输出值以及液压缸实际位移值共同调节，伺服阀通过流量控制液压缸的位移进而控制助力外骨骼系统；所述的粗调控制对应的是调节油源压力大小，所述的精调控制对应的是调节液压缸的位移大小；则还包括：

a.根据助力外骨骼系统感知装置所采集到的人体运动状态信号，判断当前状态下的人体运动特性，若当前状态下的人体运动特性为轻负载运动，则进入步骤b；若当前状态下的人体运动特性为高负载运动，则进入步骤c；

b.助力外骨骼系统启用粗调控制，具体为：所述人体运动状态信号至少包括低速行走、站立、下蹲、起蹲和高速行走；设助力外骨骼系统的有效承载能达到70％，则还包括：

b1.获取液压泵的油源压力期望值，具体方法为：

b11.当人体运动状态信号为低速行走、站立、下蹲或起蹲时，则通过如下公式1计算当前液压泵的油源压力期望值为：

公式1中，m₀为仪器自重，m_f为背部负荷，D是液压缸活塞直径大小，η为膝关节处力臂修正系数，Δp为伺服阀节流压力损失；

背部负荷m^f可以通过初始时刻脚底压力传感器数值进行估算，可通过如下公式2计算：

公式2中F_si为第i个脚底压力传感器数值，ζ为压力传感器误差修正系数；

b12.当人体运动状态信号为高速行走时，则通过如下公式3计算当前液压泵的油源压力期望值为：

公式3中，P_n为额定功率，q^exp为液压缸流量，可通过如下公式4计算：

公式4中，A_p表示液压缸横截面积，为：A_p＝πD²/4；S为液压缸的收缩速率，假设高速行走时，人体单腿一个运动步态周期为T，支撑周期设为一个步态周期60％，设液压缸满行程为L_max＝0.16m，在快速行走时，液压缸位移为一个行程的1/2～1/3，则液压缸收缩速率可通过如下公式5计算：

b2.根据步骤b1中获得的油源压力期望值，通过转速控制器对伺服电机的转速进行调节，从而通过伺服电机控制液压泵来控制油源压力输出值；

c.助力外骨骼系统启用精调控制，具体为：通过如下公式6计算液压缸期望位移值：