[发明专利]一种人机耦合重载携行系统装置及其控制方法

权利要求书

1.一种人机耦合重载携行系统的装置，包括与人体下部肢体对应耦合的刚肢体，所述刚肢体包括两组小腿零件和大腿零件，连接在所述小腿零件与所述大腿零件之间的两个膝关节和执行器，连接在所述小腿零件底部的两只传感靴，设置在两所述大腿零件上部且位于人体背部的背架，以及控制系统和供电电源；其特征在于：

每一所述执行器包括一液压缸，所述液压缸连接在所述大腿零件的中部，且通过油管依次连接伺服阀、电液换向阀、油箱和油泵，所述油箱和油泵设置在所述背架下部；所述液压缸的活塞杆连接所述小腿零件的中部，所述活塞杆的内端设置有一圈将所述液压缸分隔成一液压腔和一气体蓄能腔的凸缘；

所述控制系统包括设置在两所述传感靴内的两组足底压力传感器，设置在两所述膝关节处的两膝关节角度传感器，设置在所述背架上控制板卡中的步态判断模块、执行器位置计算模块、控制器模块、放大器模块、液压调节模块、执行器等效模块、支撑负重补偿模块和两加法器；

所述步态判断模块将得到的足底压力传感器信号与其内预置的给定阈值进行比较和判断；所述执行器位置计算模块将得到的膝关节传感器输出的膝关节角度变化值θ和其内预置的活塞杆位置Y与膝关节角度变化值θ的关系式，计算活塞杆位置Y；所述控制器模块通过其内预置的PID控制器的数学模型表达式G_PID，将其得到的偏差值转换为电压控制信号U_ctrl，并将其输出给所述放大器模块；所述放大器模块通过其内预置的关系式K_a将输入的电压控制信号U_ctrl转换为伺服电流量I，并将其输出给所述液压调节模块；所述液压调节模块通过其内预置的关系式G_sv将输入的伺服电流量I转换为伺服阀阀门的开度大小x_v，并将其输出给所述执行器等效模块，所述执行器等效模块通过其内预置的等效数学模型表达式G_eq，将伺服阀阀门的开度大小x_v和所述支撑负重补偿模块反馈回来的支撑负重补偿力F_comp，转换为所述活塞杆应该输出的位置Y_need，所述支撑负重补偿模块通过其内部预置的等效数学模型G_comp将活塞杆应该输出的位置Y_need转换为所述活塞杆应该输出的支撑负重补偿力F_comp，并将其再反馈回所述执行器等效模块。

2.如权利要求1所述的一种人机耦合重载携行系统的装置，其特征在于：一组所述足底压力传感器为两个，分别放置在与人体前脚掌和后脚跟接触的部位，所述足底压力传感器输出电压信号。

3.如权利要求1所述的一种人机耦合重载携行系统的装置，其特征在于：所述控制器模块中预置的PID控制器的数学模型表达式G_PID为：

G_PID＝K_P+T_Ds+T_I/s

式中：K_P为比例系数，T_D为微分系数，T_I为积分系数。

4.如权利要求2所述的一种人机耦合重载携行系统的装置，其特征在于：所述控制器模块中预置的PID控制器的数学模型表达式G_PID为：

G_PID＝K_P+T_Ds+T_I/s

式中：K_P为比例系数，T_D为微分系数，T_I为积分系数。