CN106325273B - 助力外骨骼机器人的多相位步态切换控制系统及其控制方法 - Google Patents

助力外骨骼机器人的多相位步态切换控制系统及其控制方法 Download PDF

Info

Publication number
CN106325273B
CN106325273B CN201610701182.4A CN201610701182A CN106325273B CN 106325273 B CN106325273 B CN 106325273B CN 201610701182 A CN201610701182 A CN 201610701182A CN 106325273 B CN106325273 B CN 106325273B
Authority
CN
China
Prior art keywords
leg
value
magnitude
right leg
angular velocity
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201610701182.4A
Other languages
English (en)
Other versions
CN106325273A (zh
Inventor
何锋
王容川
赵江海
叶晓东
赵子毅
丁玲
刘曼曼
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Zhongke winsis Intelligent Robot Technology Co. Ltd.
Original Assignee
Jiangsu Zhongke Winsis Intelligent Robot Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jiangsu Zhongke Winsis Intelligent Robot Technology Co Ltd filed Critical Jiangsu Zhongke Winsis Intelligent Robot Technology Co Ltd
Priority to CN201610701182.4A priority Critical patent/CN106325273B/zh
Publication of CN106325273A publication Critical patent/CN106325273A/zh
Application granted granted Critical
Publication of CN106325273B publication Critical patent/CN106325273B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Rehabilitation Tools (AREA)

Abstract

本发明公开了一种助力外骨骼机器人的多相位步态切换控制系统及其控制方法,其特征是包括传感器模块、信号采集与处理模块、步态切换运动控制模块、电机驱动模块;传感器包括:惯性测量单元、足底压力传感器和电机编码器。本发明能在满足外骨骼机器人负载重物情况下,规划各相位步态下髋关节和膝关节电机助力力矩的输出和各相位步态之间的流畅切换,达到负重外骨骼装备肢体动作的协调性和灵活性的目的。

Description

助力外骨骼机器人的多相位步态切换控制系统及其控制方法
技术领域
本发明属于机器人领域,具体的说是一种助力外骨骼机器人的多相位步态切换控制系统及其控制方法。
背景技术
助力外骨骼机器人是一种穿戴方式的下肢步行仿生机械腿,它以人为中心,通过传感器采集人体运动的趋势,在助力方面给予与人相同步态方向的关节助力,协助负重情况下人走路的能力和速度;传统的助力外骨骼机器人在机械结构与人体运动的协调性及负载重物情况下运动的灵活性都存在缺陷。
中国专利公开号CN103315834B发明一种穿戴式下肢助力外骨骼,它通过仿生智能控制程序控制电机,实现穿戴式下肢助力外骨骼的行走步态,该发明用于下肢助力和下肢康复领域,但该专利并没有对一些复杂突发情况下保持行走或作出应急处理部分进行描述,因此,该装置并不能满足负重情况下步态协调控制情况。
发明内容
本发明针对现有外骨骼机器人在负重情况下肢体运动与机构运动协调性和灵活性的不足之处,提供一种助力外骨骼机器人的多相位步态切换控制系统及其控制方法,以期能在满足外骨骼机器人负载重物情况下,规划各相位步态下髋关节和膝关节电机助力力矩的输出和各相位步态之间的流畅切换,达到负重外骨骼装备肢体动作的协调性和灵活性的目的。
为了达到上述目的,本发明所采用的技术方案为:
本发明一种助力外骨骼机器人的多相位步态切换控制系统的特点是包括:传感器模块、直流伺服电机、信号采集与处理模块、步态切换运动控制模块、电机驱动模块;所述传感器包括:惯性测量单元、足底压力传感器、电机编码器;
所述惯性测量单元分别设置在穿戴者左腿大腿、左腿小腿、右腿大腿、右腿小腿和腰部,用于获得穿戴者运动时左右大小腿的角速度值和姿态角度值,包括:左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值、腰部俯仰角度值、左腿大腿俯仰角度值、左腿小腿俯仰角度值、右腿大腿俯仰角度值、右腿小腿俯仰角度值,并提供给所述信号采集与处理模块;
所述足底压力传感器设置在所述外骨骼装置的足部,并用于采集所述外骨骼装置的足部压力值,包括:左足大脚趾压力值、左足小脚趾压力值、左足脚跟压力值、右足大脚趾压力值、右足小脚趾压力值、右足脚跟压力值,并提供给所述信号采集与处理模块;
所述电机编码器设置在所述外骨骼装置的左右腿髋关节和膝关节处,并用于采集所述外骨骼装置的左右腿髋关节和膝关节的直流伺服电机编码器值,包括:左腿髋关节直流伺服电机编码器值、左腿膝关节直流伺服电机编码器值、右腿髋关节直流伺服电机编码器值、右腿膝关节直流伺服电机编码器值,并提供给所述信号采集与处理模块;由所述信号采集与处理模块通过所述左右腿髋关节和膝关节的直流伺服电机编码器值分别获得左右腿髋关节和膝关节的变化角度值,包括:外骨骼装置左腿髋关节变化角度值、外骨骼装置左腿膝关节变化角度值、外骨骼装置右腿髋关节变化角度值、外骨骼装置右腿膝关节变化角度值;
所述信号采集与处理模块将所述足部压力值、左右大小腿的角速度值和姿态角度值、左右腿髋关节和膝关节的直流伺服电机编码器值及其变化角度值分别传递给所述步态切换运动控制模块进行逻辑判断,获得逻辑判断结果,包括:负重在左右脚的分布、外骨骼装置与穿戴者身体运动契合度参数和当前左右腿所属的步态相位;再根据所述逻辑判断结果与所述左右大小腿的角速度值一起进行计算,获得左右腿髋关节和膝关节的输出力矩值并传递给所述电机驱动模块;所述左右腿髋关节和膝关节的输出力矩值包括:左腿髋关节直流伺服电机输出力矩值、左腿膝关节直流伺服电机输出力矩值、右腿髋关节直流伺服电机输出力矩值、右腿膝关节直流伺服电机输出力矩值;
所述电机驱动模块将所述左右腿髋关节和膝关节的输出力矩值转化为驱动器指令,用于控制所述直流伺服电机驱动所述外骨骼装置进行多相位步态切换。
本发明一种助力外骨骼机器人的多相位步态切换控制方法的特点是按如下步骤进行:
步骤1、获取左腿髋关节直流伺服电机编码器值、左腿膝关节直流伺服电机编码器值、右腿髋关节直流伺服电机编码器值、右腿膝关节直流伺服电机编码器值,并进行脉冲与角度换算关系计算,得到左右腿髋关节和膝关节的变化角度值,包括:外骨骼装置左腿髋关节变化角度值、外骨骼装置左腿膝关节变化角度值、外骨骼装置右腿髋关节变化角度值、外骨骼装置右腿膝关节变化角度值;
步骤2、获取穿戴外骨骼装置的足部压力值,包括:左足大脚趾压力值、左足小脚趾压力值、左足脚跟压力值、右足大脚趾压力值、右足小脚趾压力值、右足脚跟压力值,并进行计算,得到左右足各自的负重压力值;
步骤3、获取穿戴外骨骼装置运动时左右大小腿的角速度值,包括:左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值,并与所述左右腿髋关节和膝关节的变化角度值一起进行计算,获得外骨骼装置与穿戴者身体运动契合度参数;
步骤4、获取穿戴外骨骼装置运动时左右大小腿和腰部的姿态角度值,包括:左腿大腿俯仰角度值、左腿小腿俯仰角度值、右腿大腿俯仰角度值、右腿小腿俯仰角度值、腰部俯仰角度值,并与所述足部压力值一起进行逻辑判断,获得当前左右腿所属的步态相位;
步骤5、对所述左右大小腿的角速度值、当前左右腿所属的步态相位、外骨骼装置当前姿态、负重在左右脚的分布进行计算,得到左右腿髋关节和膝关节的输出力矩值,包括:左腿髋关节直流伺服电机输出力矩值、左腿膝关节直流伺服电机输出力矩值、右腿髋关节直流伺服电机输出力矩值、右腿膝关节直流伺服电机输出力矩值,并用于控制所述外骨骼装置进行多相位步态切换。
本发明所述的多相位步态切换控制方法的特点也在于,
所述步骤1中,脉冲与角度换算关系的计算方法为:
各关节变化角度值=编码器当前脉冲数/(电机转动一圈脉冲数×减速器减速比)。
所在步骤2中,左右足各自负重压力值的计算方法为:
左足压力值=(左足大脚趾压力权重系数×左足大脚趾压力值+左足小脚趾压力权重系数×左足小脚趾压力值+左足脚跟压力权重系数×左足脚跟压力值);
右足压力值=(右足大脚趾压力权重系数×右足大脚趾压力值+右足小脚趾压力权重系数×右足小脚趾压力值+右足脚跟压力权重系数×右足脚跟压力值);
根据空载和负重两种情况下分别计算左足压力值和右足压力值,则左脚负重=负重左足压力值-空载左足压力值;右脚负重=负重右足压力值-空载右足压力值。
所述步骤3中,外骨骼装置与穿戴者身体运动契合度参数计算方法为:
左腿髋关节契合度参数=左腿大腿角速度值/外骨骼装置左腿髋关节变化角度值;
左腿膝关节契合度参数=左腿小腿角速度值/外骨骼装置左腿膝关节变化角度值;
右腿髋关节契合度参数=右腿大腿角速度值/外骨骼装置右腿髋关节变化角度值;
右腿膝关节契合度参数=右腿小腿角速度值/外骨骼装置右腿膝关节变化角度值。
所述步骤4中的逻辑判断是按如下过程进行:
步骤4.1、判断腰部俯仰角度值是否大于起步动作触发的角度阈值;若大于,则执行步骤4.3;否则,执行步骤4.2;
步骤4.2、保持外骨骼装置当前的姿态,并执行步骤4.1;
步骤4.3、判断左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值是否满足条件1或条件2或条件3;若不满足条件1、条件2或条件3,则执行步骤4.2;
条件1:若左腿大腿角速度值和左腿小腿角速度值均大于角速度活跃阈值,则判断右足足底压力值与左足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值,则执行步骤4.5;
条件2:若右腿大腿角速度值和右腿小腿角速度值均大于角速度活跃阈值,则判断左足足底压力值与右足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值,则执行步骤4.4;
条件3:若左腿大腿角速度值和左腿小腿角速度值、右腿大腿角速度值和右腿小腿角速度值均大于角速度活跃阈值,则执行步骤4.6;
步骤4.4、执行右腿摆动相位,左腿支撑相位的步态,执行结束后转至步骤4.7;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
式(1)中,kvb1为所述左腿髋关节契合度参数,为左腿大腿的角速度值,ksb1为满足左腿支撑负重情况下的髋关节助力调节系数,Tsb1为左腿髋关节静止下最小输出力矩;
左腿膝关节直流伺服电机输出力矩Txs1为:
式(2)中,kvs1为所述左腿膝关节契合度参数,为左腿小腿的角速度值,kss1为满足左腿支撑负重情况下的膝关节助力调节系数,Tss1为左腿膝关节静止下最小输出力矩;
右腿髋关节直流伺服电机输输出力矩Txb2为:
式(3)中,kvb2为所述右腿髋关节契合度参数,为右腿大腿的角速度值,kwb2为右腿摆动情况下的髋关节助力调节系数,Twb2为右腿髋关节静止下最小输出力矩;
右腿膝关节直流伺服电机输出力矩Txs2为:
式(4)中,kvs2为所述右腿膝关节契合度参数,为右腿小腿的角速度值,kws2为右腿摆动情况下的膝关节助力调节系数,Tws2为右腿膝关节静止下最小输出力矩;
步骤4.5、执行左腿摆动相位,右腿支撑相位的步态;执行结束后,转至步骤4.8;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
式(5)中,kwb1为左腿摆动情况下的髋关节助力调节系数,Twb1为左腿髋关节静止下最小输出力矩;
左腿膝关节直流伺服电机输出力矩Txs1为:
式(6)中,kws1为左腿摆动情况下的膝关节助力调节系数,Tws1为左腿膝关节静止下最小输出力矩;
右腿髋关节直流伺服电机输出力矩Txb2为:
式(7)中,ksb2为满足右腿支撑负重情况下的髋关节助力调节系数,Tsb2为右腿髋关节静止下最小输出力矩;
右腿膝关节直流伺服电机输出力矩Txs2为:
式(8)中,kss2为满足右腿支撑负重情况下的膝关节助力调节系数,Tss2为右腿膝关节静止下最小输出力矩;
步骤4.6、执行原地站立到下蹲或下蹲到站立的运动相位该,执行结束后转至步骤4.1;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
左腿膝关节直流伺服电机输出力矩Txs1为:
右腿髋关节直流伺服电机输出力矩Txb2为:
右腿膝关节直流伺服电机输出力矩Txs2为:
步骤4.7:判断是否同时满足条件4、条件5、条件6和条件7;若同时满足,则执行步骤4.5;若有一项条件不满足,则执行步骤4.2;
条件4:腰部俯仰角度值大于起步动作触发的角度阈值;
条件5:左腿大腿角速度值和左腿小腿角速度值均大于角速度活跃阈值;
条件6:右足足底压力值与左足足底压力值的差值为正;
条件7:右足足底压力值与左足足底压力值的差值大于起步触发的压力差设定阈值;
步骤4.8:判断是否同时满足条件8、条件9、条件10和条件11;若同时满足,则执行步骤4.4;若有一项条件不满足,则执行步骤4.2;
条件8:腰部俯仰角度值大于起步动作触发的角度阈值;
条件9:右腿大腿角速度值和右腿小腿角速度值均大于角速度活跃阈值;
条件10:左足足底压力值与右足足底压力值的差值为正;
条件11:左足足底压力值与右足足底压力值的差值大于起步触发的压力差设定阈值。
与现有技术相比,本发明的有益效果体现在:
1、本发明系统通过采集加速度及足底压力传感器来获得步态切换运动控制模块所需的信号,通过电机驱动模块接收步态切换运动控制模块计算的各个电机的力矩输出值,并驱动电机实现运动,从而能使穿戴者在负载远超普通人体负重的情况下,仍能以正常姿态进行行走,为特种行业作业人员负重作业提高工作效率,更有效保护作业人员的人身安全。
2、本发明方法对当前相位和步态进行意图识别和分流处理,根据人体负重情况在线调整控制系统的力矩输出模型,从而使人体行走的装备助力具备预判性,解决了负重状态下,人体步行活动的灵敏度,提高了外骨骼装备的助力效果。
3、本发明通过关节契合度系数来将负重情况下的外骨骼装备与人体肢体运动进行协调性处理,使外骨骼装备能更好执行人体动作的意图。
4、本发明通过对各关节的助力调节系数的设置,使关节在负重情况下的对助力的大小进行调节,可灵活根据负重情况调节助力,使关节运动更加灵活。
5、本发明中关节输出力矩的在线计算方法与传统的输出力矩计算需要求解雅各比矩阵伪逆不同,仅仅为基本运算,就能满足在线实时计算的需求。
附图说明
图1为本发明控制系统结构框架设计图;
图2为本发明外骨骼机器人多相位步态切换控制算法流程图。
具体实施方式
本实施例中,一种助力外骨骼机器人的多相位步态切换控制系统和控制方法,是当外骨骼装备加载负重后,对行走的相位步态进行意图识别并进行分流处理,获得双腿髋关节电机和膝关节电机的输出力矩,通过契合度系数和助力调节系数来调整外骨骼装备与人体动作的协调性和灵活性。具体的说,如图1所示,一种助力外骨骼机器人的多相位步态切换控制系统包括:传感器模块、直流伺服电机、传感器信号采集与处理模块、步态切换运动控制模块、电机驱动模块、CAN总线网络和工业PC机;并通过给各关节直流伺服电机输出指定力矩来协调外骨骼装备负重情况下的行动。传感器包括:惯性测量单元、足底压力传感器、电机编码器;电机编码器可获取当前外骨骼装置的当前姿态;
惯性测量单元分别设置在穿戴者左腿大腿、左腿小腿、右腿大腿、右腿小腿和腰部,用于获得穿戴者运动时左右大小腿的角速度值和姿态角度值,包括:左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值、腰部俯仰角度值、左腿大腿俯仰角度值、左腿小腿俯仰角度值、右腿大腿俯仰角度值、右腿小腿俯仰角度值,并提供给信号采集与处理模块;
足底压力传感器设置在外骨骼装置的足部,并用于采集外骨骼装置的足部压力值,包括:左足大脚趾压力值、左足小脚趾压力值、左足脚跟压力值、右足大脚趾压力值、右足小脚趾压力值、右足脚跟压力值,并提供给信号采集与处理模块;
电机编码器设置在外骨骼装置的左右腿髋关节和膝关节处,并用于采集外骨骼装置的左右腿髋关节和膝关节的直流伺服电机编码器值,包括:左腿髋关节直流伺服电机编码器值、左腿膝关节直流伺服电机编码器值、右腿髋关节直流伺服电机编码器值、右腿膝关节直流伺服电机编码器值,并提供给信号采集与处理模块;由信号采集与处理模块通过左右腿髋关节和膝关节的直流伺服电机编码器值分别获得左右腿髋关节和膝关节的变化角度值,包括:外骨骼装置左腿髋关节变化角度值、外骨骼装置左腿膝关节变化角度值、外骨骼装置右腿髋关节变化角度值、外骨骼装置右腿膝关节变化角度值;外骨骼机器人助力是基于人体穿戴外骨骼装置后,由佩戴在人体上的姿态传感器进行运动检测,由此计算外骨骼装备的关节力输出,来驱动装备进行动作的。
信号采集与处理模块将足部压力值、左右大小腿的角速度值和姿态角度值、左右腿髋关节和膝关节的直流伺服电机编码器值及其变化角度值分别传递给步态切换运动控制模块进行逻辑判断,获得逻辑判断结果,包括:负重在左右脚的分布、外骨骼装置与穿戴者身体运动契合度参数和当前左右腿所属的步态相位;其中,负重在左右脚的分布是指在负重情况下,计算左足和右足分别受到的负重的重力值。外骨骼装置与穿戴者身体运动契合度参数是指人体在运动时,外骨骼装置结构运动与穿戴者人体运动髋关节、膝关节的滞后或超前的比率值。当前左右腿所属的步态相位是指步态的摆动相、支撑相和初始站立姿态;
信号采集与处理模块再根据逻辑判断结果与左右大小腿的角速度值一起进行计算,获得左右腿髋关节和膝关节的输出力矩值并传递给电机驱动模块;左右腿髋关节和膝关节的输出力矩值包括:左腿髋关节直流伺服电机输出力矩值、左腿膝关节直流伺服电机输出力矩值、右腿髋关节直流伺服电机输出力矩值、右腿膝关节直流伺服电机输出力矩值;
电机驱动模块将左右腿髋关节和膝关节的输出力矩值转化为驱动器指令,用于控制直流伺服电机驱动外骨骼装置进行多相位步态切换。
本实施例中,一种助力外骨骼机器人的多相位步态切换控制方法是按如下步骤进行:
步骤1、获取左腿髋关节直流伺服电机编码器值、左腿膝关节直流伺服电机编码器值、右腿髋关节直流伺服电机编码器值、右腿膝关节直流伺服电机编码器值,并进行脉冲与角度换算关系计算,得到左右腿髋关节和膝关节的变化角度值,包括:外骨骼装置左腿髋关节变化角度值、外骨骼装置左腿膝关节变化角度值、外骨骼装置右腿髋关节变化角度值、外骨骼装置右腿膝关节变化角度值;具体的说,脉冲与角度换算关系的计算方法为:
各关节变化角度值=编码器当前脉冲数/(电机转动一圈脉冲数×减速器减速比)。
步骤2、获取穿戴外骨骼装置但不额外负重情况下的足部压力值,包括:左足大脚趾压力值、左足小脚趾压力值、左足脚跟压力值、右足大脚趾压力值、右足小脚趾压力值、右足脚跟压力值,并进行计算,得到左右足各自的负重压力值;具体的说,左右足各自负重压力值的计算方法为:
左足压力值=(左足大脚趾压力权重系数×左足大脚趾压力值+左足小脚趾压力权重系数×左足小脚趾压力值+左足脚跟压力权重系数×左足脚跟压力值);
右足压力值=(右足大脚趾压力权重系数×右足大脚趾压力值+右足小脚趾压力权重系数×右足小脚趾压力值+右足脚跟压力权重系数×右足脚跟压力值);
根据空载和负重两种情况下分别计算左足压力值和右足压力值,则左脚负重=负重左足压力值-空载左足压力值;右脚负重=负重右足压力值-空载右足压力值。
步骤3、获取穿戴外骨骼装置运动时左右大小腿的角速度值,包括:左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值,并与左右腿髋关节和膝关节的变化角度值一起进行计算,获得外骨骼装置与穿戴者身体运动契合度参数;具体的说,外骨骼装置与穿戴者身体运动契合度参数计算方法为:
左腿髋关节契合度参数=左腿大腿角速度值/外骨骼装置左腿髋关节变化角度值;
左腿膝关节契合度参数=左腿小腿角速度值/外骨骼装置左腿膝关节变化角度值;
右腿髋关节契合度参数=右腿大腿角速度值/外骨骼装置右腿髋关节变化角度值;
右腿膝关节契合度参数=右腿小腿角速度值/外骨骼装置右腿膝关节变化角度值。
步骤4、获取穿戴外骨骼装置运动时左右大小腿和腰部的姿态角度值,包括:左腿大腿俯仰角度值、左腿小腿俯仰角度值、右腿大腿俯仰角度值、右腿小腿俯仰角度值、腰部俯仰角度值,并与足部压力值一起进行逻辑判断,获得当前左右腿所属的步态相位;
具体的说,如图2所示,逻辑判断是按如下过程进行:
步骤4.1、判断腰部俯仰角度值是否大于起步动作触发的角度阈值Aw1;若大于,则执行步骤4.3;否则,执行步骤4.2。
步骤4.2、保持外骨骼装置当前的姿态,并执行步骤4.1;
步骤4.3、判断左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值是否满足条件1或条件2或条件3;若不满足条件1、条件2或条件3,则执行步骤4.2;
条件1:若左腿大腿角速度值和左腿小腿角速度值均大于角速度活跃阈值Twb1,则判断右足足底压力值与左足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值Pdb,则执行步骤4.5;
条件2:若右腿大腿角速度值和右腿小腿角速度值均大于角速度活跃阈值Twb2,则判断左足足底压力值与右足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值Pdb,则执行步骤4.4;
条件3:若左腿大腿角速度值和左腿小腿角速度值、右腿大腿角速度值和右腿小腿角速度值均大于角速度活跃阈值Twb3,则执行步骤4.6;
步骤4.4、执行右腿摆动相位,左腿支撑相位的步态,执行结束后转至步骤4.7;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
式(1)中,kvb1为左腿髋关节契合度参数,为左腿大腿的角速度值,ksb1为满足左腿支撑负重情况下的髋关节助力调节系数,Tsb1为左腿髋关节静止下最小输出力矩;
左腿膝关节直流伺服电机输出力矩Txs1为:
式(2)中,kvs1为左腿膝关节契合度参数,为左腿小腿的角速度值,kss1为满足左腿支撑负重情况下的膝关节助力调节系数,Tss1为左腿膝关节静止下最小输出力矩;
右腿髋关节直流伺服电机输输出力矩Txb2为:
式(3)中,kvb2为右腿髋关节契合度参数,为右腿大腿的角速度值,kwb2为右腿摆动情况下的髋关节助力调节系数,Twb2为右腿髋关节静止下最小输出力矩;
右腿膝关节直流伺服电机输出力矩Txs2为:
式(4)中,kvs2为右腿膝关节契合度参数,为右腿小腿的角速度值,kws2为右腿摆动情况下的膝关节助力调节系数,Tws2为右腿膝关节静止下最小输出力矩;
步骤4.5、执行左腿摆动相位,右腿支撑相位的步态;执行结束后,转至步骤4.8;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
式(5)中,kwb1为左腿摆动情况下的髋关节助力调节系数,Twb1为左腿髋关节静止下最小输出力矩;
左腿膝关节直流伺服电机输出力矩Txs1为:
式(6)中,kws1为左腿摆动情况下的膝关节助力调节系数,Tws1为左腿膝关节静止下最小输出力矩;
右腿髋关节直流伺服电机输出力矩Txb2为:
式(7)中,ksb2为满足右腿支撑负重情况下的髋关节助力调节系数,Tsb2为右腿髋关节静止下最小输出力矩;
右腿膝关节直流伺服电机输出力矩Txs2为:
式(8)中,kss2为满足右腿支撑负重情况下的膝关节助力调节系数,Tss2为右腿膝关节静止下最小输出力矩;
步骤4.6、执行原地站立到下蹲或下蹲到站立的运动相位该,执行结束后转至步骤4.1;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
左腿膝关节直流伺服电机输出力矩Txs1为:
右腿髋关节直流伺服电机输出力矩Txb2为:
右腿膝关节直流伺服电机输出力矩Txs2为:
步骤4.7、连续行走的左腿摆动右腿支撑相位的执行判断:判断腰部俯仰角度值大于起步动作触发的角度阈值Aw1;若大于,则判断左腿大腿角速度值和左腿小腿角速度值均大于角速度活跃阈值Twb1;若大于,则判断判断右足足底压力值与左足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值Pdb;则执行步骤4.5;若有一项条件不满足,则执行步骤4.2;
步骤4.8、连续行走的左腿支撑右腿摆动相位的执行判断:判断部俯仰角度值是否大于起步动作触发的角度阈值Aw1;若大于,则判断右腿大腿角速度值和右腿小腿角速度值均大于角速度活跃阈值Twb2,若大于,则判断左足足底压力值与右足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值Pdb,则执行步骤4.4;若有一项条件不满足,则执行步骤4.2;
步骤5、对左右大小腿的角速度值、当前左右腿所属的步态相位、外骨骼装置当前姿态、负重在左右脚的分布进行计算,得到左右腿髋关节和膝关节的输出力矩值,包括:左腿髋关节直流伺服电机输出力矩值、左腿膝关节直流伺服电机输出力矩值、右腿髋关节直流伺服电机输出力矩值、右腿膝关节直流伺服电机输出力矩值,并用于控制外骨骼装置进行多相位步态切换;从而在外骨骼带动人体完成各种步态动作的条件下,对额外负重状态进行外骨骼机器人各关节输出力进行补偿处理,满足了负重下人体动作的连贯性和稳定性。

Claims (1)

1.一种助力外骨骼机器人的多相位步态切换控制方法,其特征是按如下步骤进行:
步骤1、获取左腿髋关节直流伺服电机编码器值、左腿膝关节直流伺服电机编码器值、右腿髋关节直流伺服电机编码器值、右腿膝关节直流伺服电机编码器值,并进行脉冲与角度换算关系计算,得到左右腿髋关节和膝关节的变化角度值,包括:外骨骼装置左腿髋关节变化角度值、外骨骼装置左腿膝关节变化角度值、外骨骼装置右腿髋关节变化角度值、外骨骼装置右腿膝关节变化角度值;
所述步骤1中,脉冲与角度换算关系的计算方法为:
各关节变化角度值=编码器当前脉冲数/(电机转动一圈脉冲数×减速器减速比);
步骤2、获取穿戴外骨骼装置的足部压力值,包括:左足大脚趾压力值、左足小脚趾压力值、左足脚跟压力值、右足大脚趾压力值、右足小脚趾压力值、右足脚跟压力值,并进行计算,得到左右足各自的负重压力值;
所在步骤2中,左右足各自负重压力值的计算方法为:
左足压力值=(左足大脚趾压力权重系数×左足大脚趾压力值+左足小脚趾压力权重系数×左足小脚趾压力值+左足脚跟压力权重系数×左足脚跟压力值);
右足压力值=(右足大脚趾压力权重系数×右足大脚趾压力值+右足小脚趾压力权重系数×右足小脚趾压力值+右足脚跟压力权重系数×右足脚跟压力值);
根据空载和负重两种情况下分别计算左足压力值和右足压力值,则左脚负重=负重左足压力值-空载左足压力值;右脚负重=负重右足压力值-空载右足压力值;
步骤3、获取穿戴外骨骼装置运动时左右大小腿的角速度值,包括:左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值,并与所述左右腿髋关节和膝关节的变化角度值一起进行计算,获得外骨骼装置与穿戴者身体运动契合度参数;
所述步骤3中,外骨骼装置与穿戴者身体运动契合度参数计算方法为:
左腿髋关节契合度参数=左腿大腿角速度值/外骨骼装置左腿髋关节变化角度值;
左腿膝关节契合度参数=左腿小腿角速度值/外骨骼装置左腿膝关节变化角度值;
右腿髋关节契合度参数=右腿大腿角速度值/外骨骼装置右腿髋关节变化角度值;
右腿膝关节契合度参数=右腿小腿角速度值/外骨骼装置右腿膝关节变化角度值;
步骤4、获取穿戴外骨骼装置运动时左右大小腿和腰部的姿态角度值,包括:左腿大腿俯仰角度值、左腿小腿俯仰角度值、右腿大腿俯仰角度值、右腿小腿俯仰角度值、腰部俯仰角度值,并与所述足部压力值一起进行逻辑判断,获得当前左右腿所属的步态相位;
对所述左右大小腿的角速度值、当前左右腿所属的步态相位、外骨骼装置当前姿态、负重在左右脚的分布进行计算,得到左右腿髋关节和膝关节的输出力矩值,包括:左腿髋关节直流伺服电机输出力矩值、左腿膝关节直流伺服电机输出力矩值、右腿髋关节直流伺服电机输出力矩值、右腿膝关节直流伺服电机输出力矩值,并用于控制所述外骨骼装置进行多相位步态切换;
所述步骤4是按如下过程进行:
步骤4.1、判断腰部俯仰角度值是否大于起步动作触发的角度阈值;若大于,则执行步骤4.3;否则,执行步骤4.2;
步骤4.2、保持外骨骼装置当前的姿态,并执行步骤4.1;
步骤4.3、判断左腿大腿角速度值、左腿小腿角速度值、右腿大腿角速度值、右腿小腿角速度值是否满足条件1或条件2或条件3;若不满足条件1、条件2或条件3,则执行步骤4.2;
条件1:若左腿大腿角速度值和左腿小腿角速度值均大于第一角速度活跃阈值Twb1,则判断右足足底压力值与左足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值,则执行步骤4.5;
条件2:若右腿大腿角速度值和右腿小腿角速度值均大于第二角速度活跃阈值Twb2,则判断左足足底压力值与右足足底压力值的差值,若差值为正,且正值大于起步触发的压力差设定阈值,则执行步骤4.4;
条件3:若左腿大腿角速度值和左腿小腿角速度值、右腿大腿角速度值和右腿小腿角速度值均大于第三角速度活跃阈值Twb3,则执行步骤4.6;
步骤4.4、执行右腿摆动相位,左腿支撑相位的步态,执行结束后转至步骤4.7;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
式(1)中,kvb1为所述左腿髋关节契合度参数,为左腿大腿的角速度值,ksb1为满足左腿支撑负重情况下的髋关节助力调节系数,Tsb1为左腿髋关节静止下最小输出力矩;
左腿膝关节直流伺服电机输出力矩Txs1为:
式(2)中,kvs1为所述左腿膝关节契合度参数,为左腿小腿的角速度值,kss1为满足左腿支撑负重情况下的膝关节助力调节系数,Tss1为左腿膝关节静止下最小输出力矩;
右腿髋关节直流伺服电机输输出力矩Txb2为:
式(3)中,kvb2为所述右腿髋关节契合度参数,为右腿大腿的角速度值,kwb2为右腿摆动情况下的髋关节助力调节系数,Twb2为右腿髋关节静止下最小输出力矩;
右腿膝关节直流伺服电机输出力矩Txs2为:
式(4)中,kvs2为所述右腿膝关节契合度参数,为右腿小腿的角速度值,kws2为右腿摆动情况下的膝关节助力调节系数,Tws2为右腿膝关节静止下最小输出力矩;
步骤4.5、执行左腿摆动相位,右腿支撑相位的步态;执行结束后,转至步骤4.8;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
式(5)中,kwb1为左腿摆动情况下的髋关节助力调节系数,Twb1为左腿髋关节静止下最小输出力矩;
左腿膝关节直流伺服电机输出力矩Txs1为:
式(6)中,kws1为左腿摆动情况下的膝关节助力调节系数,Tws1为左腿膝关节静止下最小输出力矩;
右腿髋关节直流伺服电机输出力矩Txb2为:
式(7)中,ksb2为满足右腿支撑负重情况下的髋关节助力调节系数,Tsb2为右腿髋关节静止下最小输出力矩;
右腿膝关节直流伺服电机输出力矩Txs2为:
式(8)中,kss2为满足右腿支撑负重情况下的膝关节助力调节系数,Tss2为右腿膝关节静止下最小输出力矩;
步骤4.6、执行原地站立到下蹲或下蹲到站立的运动相位该,执行结束后转至步骤4.1;
在当前相位下,各直流伺服电机力矩输出值计算方法为:
左腿髋关节直流伺服电机输出力矩Txb1为:
左腿膝关节直流伺服电机输出力矩Txs1为:
右腿髋关节直流伺服电机输出力矩Txb2为:
右腿膝关节直流伺服电机输出力矩Txs2为:
步骤4.7:判断是否同时满足条件4、条件5、条件6和条件7;若同时满足,则执行步骤4.5;若有一项条件不满足,则执行步骤4.2;
条件4:腰部俯仰角度值大于起步动作触发的角度阈值;
条件5:左腿大腿角速度值和左腿小腿角速度值均大于第一角速度活跃阈值Twb1;
条件6:右足足底压力值与左足足底压力值的差值为正;
条件7:右足足底压力值与左足足底压力值的差值大于起步触发的压力差设定阈值;
步骤4.8:判断是否同时满足条件8、条件9、条件10和条件11;若同时满足,则执行步骤4.4;若有一项条件不满足,则执行步骤4.2;
条件8:腰部俯仰角度值大于起步动作触发的角度阈值;
条件9:右腿大腿角速度值和右腿小腿角速度值均大于第二角速度活跃阈值Twb2;
条件10:左足足底压力值与右足足底压力值的差值为正;
条件11:左足足底压力值与右足足底压力值的差值大于起步触发的压力差设定阈值。
CN201610701182.4A 2016-08-22 2016-08-22 助力外骨骼机器人的多相位步态切换控制系统及其控制方法 Active CN106325273B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610701182.4A CN106325273B (zh) 2016-08-22 2016-08-22 助力外骨骼机器人的多相位步态切换控制系统及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610701182.4A CN106325273B (zh) 2016-08-22 2016-08-22 助力外骨骼机器人的多相位步态切换控制系统及其控制方法

Publications (2)

Publication Number Publication Date
CN106325273A CN106325273A (zh) 2017-01-11
CN106325273B true CN106325273B (zh) 2019-04-12

Family

ID=57742567

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610701182.4A Active CN106325273B (zh) 2016-08-22 2016-08-22 助力外骨骼机器人的多相位步态切换控制系统及其控制方法

Country Status (1)

Country Link
CN (1) CN106325273B (zh)

Families Citing this family (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3576707B1 (en) * 2017-02-03 2024-01-31 Roam Robotics Inc. System and method for user intent recognition
CN109421081A (zh) * 2017-09-01 2019-03-05 淮安信息职业技术学院 一种基于重载搬运的智能助力机器人系统的研制方法
CN109953761B (zh) * 2017-12-22 2021-10-22 浙江大学 一种下肢康复机器人运动意图推理方法
CN108379038B (zh) * 2018-01-15 2019-07-09 浙江大学 一种下肢康复外骨骼系统及其步行控制方法
CN110236890B (zh) * 2018-03-07 2024-04-23 北京大艾机器人科技有限公司 用于外骨骼机器人的控制装置
CN108451748A (zh) * 2018-05-30 2018-08-28 中国工程物理研究院总体工程研究所 一种直驱式康复外骨骼及训练方法
CN109746902A (zh) * 2019-03-13 2019-05-14 北京理工大学 一种具有动态负载补偿的上肢外骨骼协同控制方法
CN110053684B (zh) * 2019-04-24 2021-06-01 哈尔滨理工大学 一种适于斜坡路面的爬行机器人腿部装置及控制
CN110027002B (zh) * 2019-04-24 2021-09-17 深圳市智能机器人研究院 一种基于多电机驱动的仿生关节控制系统及方法
CN110123334A (zh) * 2019-05-15 2019-08-16 中国矿业大学(北京) 一种煤矿井下人体姿态监测系统
CN110163347A (zh) * 2019-05-24 2019-08-23 刘斌 一种煤矿井下人体姿态监测方法
CN110215648B (zh) * 2019-06-28 2021-03-26 华中科技大学 基于人体步态运动协调特性的外骨骼协调步态控制方法
TWI704911B (zh) * 2019-07-22 2020-09-21 緯創資通股份有限公司 外骨骼穿戴管理系統與外骨骼穿戴管理方法
CN110587613B (zh) * 2019-10-15 2023-10-24 北京理工大学 一种负压气动柔性膝关节外骨骼实时反馈与闭环控制方法
CN110721055B (zh) * 2019-10-17 2021-11-02 深圳市迈步机器人科技有限公司 下肢助行外骨骼机器人的控制方法及外骨骼机器人
CN110802603B (zh) * 2019-12-03 2022-07-12 国机智能(苏州)有限公司 一种主动式腰部助力外骨骼控制系统以及控制方法
CN111898487A (zh) * 2020-07-15 2020-11-06 贵州航天控制技术有限公司 一种柔性外骨骼系统的人体运动模式实时识别方法
CN111880544B (zh) * 2020-08-07 2024-03-22 深圳市优必选科技股份有限公司 仿人机器人步态规划方法、装置和仿人机器人
CN114376865B (zh) * 2020-10-16 2023-07-21 深圳市肯綮科技有限公司 带有延时调整模块的运动辅助装置及其延时控制方法
CN112224303B (zh) * 2020-10-23 2021-12-21 之江实验室 一种基于惯性测量单元组的双足运动数据采集系统
CN112560594B (zh) * 2020-11-30 2024-06-07 贵州航天控制技术有限公司 一种柔性外骨骼系统的人体步态识别方法
CN112641603A (zh) * 2020-12-17 2021-04-13 迈宝智能科技(苏州)有限公司 一种外骨骼装置及外骨骼运动控制方法
CN112494284A (zh) * 2020-12-18 2021-03-16 深圳市迈步机器人科技有限公司 一种髋关节外骨骼的控制方法及装置
CN112618283B (zh) * 2020-12-21 2022-12-27 南京伟思医疗科技股份有限公司 一种外骨骼机器人主动训练用步态协调助力控制系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103263339A (zh) * 2013-05-17 2013-08-28 大连交通大学 老年人外骨骼助行机器人及防摔倒步态的仿生控制方法
CN103431929A (zh) * 2013-08-29 2013-12-11 电子科技大学 一种力量增强型动力外骨骼行走步态感知方法及装置
CN103622792A (zh) * 2013-11-25 2014-03-12 北京林业大学 外骨骼助力机器人的信息采集与控制系统
CN105105973A (zh) * 2015-08-14 2015-12-02 浙江大学 可穿戴式助力外骨骼下肢机构
CN105150211A (zh) * 2015-09-08 2015-12-16 中国科学院合肥物质科学研究院 一种负重型下肢外骨骼机器人的控制系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103263339A (zh) * 2013-05-17 2013-08-28 大连交通大学 老年人外骨骼助行机器人及防摔倒步态的仿生控制方法
CN103431929A (zh) * 2013-08-29 2013-12-11 电子科技大学 一种力量增强型动力外骨骼行走步态感知方法及装置
CN103622792A (zh) * 2013-11-25 2014-03-12 北京林业大学 外骨骼助力机器人的信息采集与控制系统
CN105105973A (zh) * 2015-08-14 2015-12-02 浙江大学 可穿戴式助力外骨骼下肢机构
CN105150211A (zh) * 2015-09-08 2015-12-16 中国科学院合肥物质科学研究院 一种负重型下肢外骨骼机器人的控制系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
下肢外骨骼康复机器人结构设计及控制方法研究;周海涛;《中国优秀硕士学位论文全文数据库(电子期刊)信息科技辑》;20160228(第2期);全文
可穿戴型下肢助力机器人感知系统研究;孙建 等;《微纳电子技术》;20070831(第7/8期);全文

Also Published As

Publication number Publication date
CN106325273A (zh) 2017-01-11

Similar Documents

Publication Publication Date Title
CN106325273B (zh) 助力外骨骼机器人的多相位步态切换控制系统及其控制方法
CN111604890B (zh) 一种适用于外骨骼机器人的运动控制方法
CN105213156B (zh) 一种动力外骨骼及其控制方法
el Zahraa Wehbi et al. Active impedance control of a knee-joint orthosis during swing phase
Bougrinat et al. Design and development of a lightweight ankle exoskeleton for human walking augmentation
Chen et al. Development and hybrid control of an electrically actuated lower limb exoskeleton for motion assistance
EP3156010A1 (en) Worn-prosthetic-limb movement assistance device and worn movement assistance device
CN108283564A (zh) 一种轻量型绳驱动智能踝关节外骨骼系统
Tricomi et al. Underactuated soft hip exosuit based on adaptive oscillators to assist human locomotion
CN110721055B (zh) 下肢助行外骨骼机器人的控制方法及外骨骼机器人
Yan et al. A novel adaptive oscillators-based control for a powered multi-joint lower-limb orthosis
Wang et al. An underwater lower-extremity soft exoskeleton for breaststroke assistance
Zhang et al. A control strategy for maintaining gait stability and reducing body-exoskeleton interference force in load-carrying exoskeleton
Gambon et al. Effects of user intent changes on onboard sensor measurements during exoskeleton-assisted walking
Zhang et al. Active knee joint exoskeleton for stair ascent augmentation
Sergey et al. Approach to motion control of an exoskeleton in “verticalization-to-walking” regime utilizing pressure sensors
Wang et al. Mechatronic design and control of a rigid-soft hybrid knee exoskeleton for gait intervention
CN111728827B (zh) 动力下肢外骨骼控制方法、装置和系统
Chen et al. WPAL for enhancing human strength and endurance during walking
CN110587613B (zh) 一种负压气动柔性膝关节外骨骼实时反馈与闭环控制方法
Park et al. Design of a lower limb exoskeleton including roll actuation to assist walking and standing up
CN114903750A (zh) 一种用于截瘫患者的下肢外骨骼控制系统及下肢外骨骼控制方法
Zhang et al. Experiment study of impedance control on horizontal lower limbs rehabilitation robot
Luo et al. Design and development of a wearable lower limb exoskeleton robot
Wierciak et al. Orthotic Robot as a Mechatronic System

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20170509

Address after: 230031 Shushan Lake Road, Anhui, China, No. 350, No.

Applicant after: Hefei Inst. of Matter Sciences, Chinese Academy of Sciences

Address before: 230031 Shushan District, Anhui City, Dong Dong Island

Applicant before: Hefei Inst. of Matter Sciences, Chinese Academy of Sciences

Applicant before: Institute of Advanced Manufacturing Technology

TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20171222

Address after: 213164, room 3, room 307, Changzhou science and Education City, No. 18, Changwu Middle Road, Wujin District, Changzhou, Jiangsu

Applicant after: Jiangsu Zhongke winsis Intelligent Robot Technology Co. Ltd.

Address before: 230031 Shushan Lake Road, Anhui, China, No. 350, No.

Applicant before: Hefei Inst. of Matter Sciences, Chinese Academy of Sciences

GR01 Patent grant
GR01 Patent grant