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

摘要

本发明属于自动控制技术领域，涉及一种用于助力外骨骼系统的控制方法。本发明根据人体对助力外骨骼系统的依赖程度，将助力外骨骼系统的控制分为粗调控制和精调控制；具体方法首先通过感知系统分析出目前人体的运动状态，根据不同的运动状态，如低速行走、站立、下蹲、起蹲和高速行走，通过粗调控制方法，利用电机控制，控制油源压力，以达到不同的运动状态所要求的液压控制量；同时，在粗调控制的基础上，为了更加精确地控制外骨骼的运动姿态，采用精调控制，通过液压缸伸长量调节外骨骼末端肢节的位姿，以达到期望的位姿，最终让外骨骼精确地实现不同的运动状态。所述助力外骨骼系统的动力控制装置为由伺服电机控制的液压泵和由伺服阀控制的液压缸构成；所述的粗调控制对应的是调节油源压力大小，所述的精调控制对应的是调节液压缸的位移大小。

主权项

一种用于助力外骨骼系统的控制方法，其特征在于，包括：根据人体对助力外骨骼系统的依赖程度，将助力外骨骼系统的控制分为粗调控制和精调控制；具体方法首先通过感知系统分析出目前人体的运动状态，根据不同的运动状态，如低速行走、站立、下蹲、起蹲和高速行走，通过粗调控制方法，利用电机控制，控制油源压力，以达到不同的运动状态所要求的液压控制量；同时，在粗调控制的基础上，为了更加精确地控制外骨骼的运动姿态，采用精调控制，通过液压缸伸长量调节外骨骼末端肢节的位姿，以达到期望的位姿，最终让外骨骼精确地实现不同的运动状态，所述助力外骨骼系统的动力控制装置为由伺服电机控制的液压泵和由伺服阀控制的液压缸构成，其中，液压泵连接有油箱，伺服电机的输出由油源压力期望值和液压泵输出的油源压力输出值共同调节，伺服电机控制液压泵的输出，液压泵的输出还与伺服阀连接，伺服阀由液压缸期望位移值、油源压力输出值以及液压缸实际位移值共同调节，伺服阀通过流量控制液压缸的位移进而控制助力外骨骼系统；所述的粗调控制对应的是调节油源压力大小，所述的精调控制对应的是调节液压缸的位移大小；则还包括：a.根据助力外骨骼系统感知装置所采集到的人体运动状态信号，判断当前状态下的人体运动特性，若当前状态下的人体运动特性为轻负载运动，则进入步骤b；若当前状态下的人体运动特性为高负载运动，则进入步骤c；b.助力外骨骼系统启用粗调控制，具体为：所述人体运动状态信号至少包括低速行走、站立、下蹲、起蹲和高速行走；设助力外骨骼系统的有效承载能达到70％，则还包括：b1.获取液压泵的油源压力期望值，具体方法为：b11.当人体运动状态信号为低速行走、站立、下蹲或起蹲时，则通过如下公式1计算当前液压泵的油源压力期望值为：公式1中，m0为仪器自重，mf为背部负荷，D是液压缸活塞直径大小，η为膝关节处力臂修正系数，Δp为伺服阀节流压力损失；背部负荷mf可以通过初始时刻脚底压力传感器数值进行估算，可通过如下公式2计算：公式2中Fsi为第i个脚底压力传感器数值，ζ为压力传感器误差修正系数；b12.当人体运动状态信号为高速行走时，则通过如下公式3计算当前液压泵的油源压力期望值为：公式3中，Pn为额定功率，qexp为液压缸流量，可通过如下公式4计算：公式4中，Ap表示液压缸横截面积，为：Ap＝πD2/4；为液压缸的收缩速率，假设高速行走时，人体单腿一个运动步态周期为T，支撑周期设为一个步态周期60％，设液压缸满行程为Lmax＝0.16m，在快速行走时，液压缸位移为一个行程的1/2～1/3，则液压缸收缩速率可通过如下公式5计算：b2.根据步骤b1中获得的油源压力期望值，通过转速控制器对伺服电机的转速进行调节，从而通过伺服电机控制液压泵来控制油源压力输出值；c.助力外骨骼系统启用精调控制，具体为：通过如下公式6计算液压缸期望位移值：公式6中，表示当前膝关节角度变化期望值；Dist1，Dist2以及当前液压缸的期望位置构成了一个三角形，它们分别表示三角边的大腿连接点或者小腿连接点与膝关节轴承的距离。