CN110802603A - 一种主动式腰部助力外骨骼控制系统以及控制方法 - Google Patents

一种主动式腰部助力外骨骼控制系统以及控制方法 Download PDF

Info

Publication number
CN110802603A
CN110802603A CN201911222758.9A CN201911222758A CN110802603A CN 110802603 A CN110802603 A CN 110802603A CN 201911222758 A CN201911222758 A CN 201911222758A CN 110802603 A CN110802603 A CN 110802603A
Authority
CN
China
Prior art keywords
executing
condition
leg
right leg
left leg
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.)
Granted
Application number
CN201911222758.9A
Other languages
English (en)
Other versions
CN110802603B (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.)
Sinomach Intelligence Technology Co ltd
Shenzhen Institute of Advanced Technology of CAS
Original Assignee
National Aircraft Intelligence (suzhou) 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 National Aircraft Intelligence (suzhou) Co Ltd filed Critical National Aircraft Intelligence (suzhou) Co Ltd
Priority to CN201911222758.9A priority Critical patent/CN110802603B/zh
Publication of CN110802603A publication Critical patent/CN110802603A/zh
Application granted granted Critical
Publication of CN110802603B publication Critical patent/CN110802603B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0006Exoskeletons, i.e. resembling a human figure

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

本发明涉及助力机器人研究技术领域,具体涉及一种主动式腰部助力外骨骼控制系统以及控制方法。一种主动式腰部助力外骨骼控制系统,包括传感器模块、无刷直流电机、信号采集与处理模块、搬运模式切换运动控制模块、电机驱动模块、人机交互界面,所述传感器包括:肌电传感器、电机编码器。本发明有益之处是:实现了腰部外骨骼机器人搬运状态全自动切换的功能,体现产品的智能化,使用了较少的传感器设备,使得腰部外骨骼机器人可以按照人体动作意图进行工作,达到了人机一体化的效果。

Description

一种主动式腰部助力外骨骼控制系统以及控制方法
技术领域
本发明涉及助力机器人研究技术领域,具体涉及一种主动式腰部助力外骨骼控制系统以及控制方法。
背景技术
腰部助力外骨骼能减轻在物流业、建筑业、制造业、医疗业、农林业等行业工人的工作强度,提高工作效率,预防体力劳动导致的身体损伤,以及在助老方面辅助老年人的身体机能方面,减轻家庭和社会负担、降低对国外技术严重的依赖等方面具有重要的现实意义。
本发明最相近似的实现方案:发明专利-《助力外骨骼机器人的多相位步态切换控制系统及其控制方法》:一种助力外骨骼机器人的多相位步态切换控制系统及其控制方法,其特征是包括传感器模块、信号采集与处理模块、步态切换运动控制模块、电机驱动模块;传感器包括:惯性测量单元、足底压力传感器和电机编码器。本发明能在满足外骨骼机器人负载重物情况下,规划各相位步态下髋关节和膝关节电机助力力矩的输出和各相位步态之间的流畅切换,达到负重外骨骼装备肢体动作的协调性和灵活性的目的。
现有技术存在以下不足:
第一,现有的技术只考虑了助力系统在物资“运”的使用,没有考虑助力系统在物资“搬”的情况下的使用。
第二,现有技术无法实现全自动切换搬运状态的功能。一般采用按键形式完成搬运状态的切换,无法满足可穿戴搬运助力设备的智能化需求。
第三,现有技术无法结合肌电传感器进行人机协同工作。
第四,现有技术通过压力传感器检测足底压力,进而全自动计算外骨骼的助力值。但是现有技术无法手动设置其值,容易造成人体的二次伤害。
本发明内容
本发明的目的是:提供一种主动式腰部助力外骨骼控制系统,重点关注“搬”的功能实现。通过多传感器融合技术实现搬运状态全自动切换的功能,使本发明达到搬运助力设备自动化的效果。其次结合了平滑助力技术,本发明实现了柔顺助力的效果,防止对人体的二次伤害。。
为了实现上述目的,本发明提供如下的技术方案:
一种主动式腰部助力外骨骼控制系统,包括传感器模块、无刷直流电机、信号采集与处理模块、搬运模式切换运动控制模块、电机驱动模块、人机交互界面,所述传感器包括:肌电传感器、电机编码器;
所述肌电传感器放置在左右手小臂处,用于采集所述人体搬运重物的肌电信号。
所述电机编码器放置在所述外骨骼装置的左右腿髋关节外侧,用于采集所述外骨骼装置的左右腿髋关节无刷直流电机码盘值;
所述信号采集与处理模块:将电机编码器所采集的电机码盘值通过信号处理算法分别计算出左右腿髋关节角度变化值,包括:外骨骼装置左腿髋关节角度变化值、外骨骼装置右腿髋关节角度变化值、外骨骼装置左腿髋关节角速度值、外骨骼装置右腿髋关节角速度值;
搬运模式切换运动控制模块:通过信号采集与处理模块获取运动控制模块中所需的数据,根据上述数据进行所述搬运状态切换运动控制模块中的逻辑判断,最后根据逻辑判断结果自动切换搬运状态。
所述电机驱动模块将上述左右腿髋关节的输出力矩值转化为驱动器的指令,从而发送指令驱动电机辅助人体搬运。
所述人机交互模块将人所设定的最大力矩值作为限制条件,可由人机交互界面按键设置对应的最大力矩,达到舒适。
本发明的另一个目的,一种助力外骨骼机器人的搬运状态切换控制方法,包括以下步骤:
1、进入无动力模式并且周期进入步骤2;
2、获取肌电传感器的多通道肌电信号,如果肌电信号超过设定的肌电信号阈值,则执行步骤3;否则,执行步骤1;
3、获取左腿髋关节、右腿髋关节无刷直流电机编码器角度值,判断左右腿髋关节的角度值是否大于起身角度阈值,若是,执行步骤5(物体从下往上搬运模式逻辑图,见图3),否则执行步骤4;
4、判断髋关节角度值是否小于下蹲角度阈值,若是,执行步骤6,否则执行步骤1;
5、获取左腿髋关节、右腿髋关节无刷直流电机编码器角速度值,并判断条件a;
条件a:判断左右腿髋关节角度值是否小于起身角度阈值且左右腿髋关节角速度大于起身速度阈值,若是,则执行起身平滑助力指令,否则执行条件b;
条件b:判断左右腿髋关节角度值是否大于下蹲起身角度阈值且左右腿髋关节角速度大于下蹲速度阈值,若是,则执行下蹲平滑助力指令,否则执行条件c;
条件c:判断左右腿髋关节编码角度值是否大于起身的角度阈值且小于起身的速度阈值,若是,则结束助力状态且执行步骤1;否则执行上一次助力指令并执行条件a;
6、获取左腿髋关节、右腿髋关节无刷直流电机编码器角速度值,并进入条件d;
条件d:判断左右腿髋关节角度值是否大于下蹲角度阈值且左右腿髋关节角速度大于下蹲速度阈值,若是,则执行下蹲平滑助力指令,否则执行条件e;
条件e:判断左右腿髋关节角度值是否小于起身角度阈值且左右腿髋关节角速度大于起身速度阈值,若是,则执行起身平滑助力指令,否则执行条件f;
条件f:判断左右腿髋关节编码角度值是否小于下蹲的角度阈值且速度值小于下蹲的速度阈值,若是,则结束助力状态且执行步骤1;否则执行上一次助力指令并进入条件d。
本发明的有益效果为:
1、本发明方法实现了腰部外骨骼机器人搬运状态全自动切换的功能,体现产品的智能化。
2、本发明方法使用了较少的传感器设备,使得腰部外骨骼机器人可以按照人体动作意图进行工作,达到了人机一体化的效果。
3、本发明可以手动调整该系统提供的助力值,进而,各行业的工作人员均可穿戴腰部外骨骼机器人进行工作。
4、本发明结合了斜坡轨迹算法,平滑地提供辅助力矩,使得腰部外骨骼机器人柔顺辅助人体进行搬运工作。
附图说明
图1为本发明一种主动式腰部助力外骨骼控制系统图;
图2为本发明一种主动式腰部助力外骨骼控制系统逻辑图;
图3为本发明物体从下往上搬运模块逻辑图;
图4为本发明物体从上往下搬运模块逻辑图;
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要理解的是,术语“上”、“下”、“前”、“后”、“左”、“右”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
参考图1至图4,一种主动式腰部助力外骨骼控制系统,包括传感器模块、无刷直流电机、信号采集与处理模块、搬运模式切换运动控制模块、电机驱动模块、人机交互界面,所述传感器包括:肌电传感器、电机编码器;
所述肌电传感器放置在左右手小臂处,用于采集所述人体搬运重物的肌电信号。
所述电机编码器放置在所述外骨骼装置的左右腿髋关节外侧,用于采集所述外骨骼装置的左右腿髋关节无刷直流电机码盘值;
所述信号采集与处理模块:将电机编码器所采集的电机码盘值通过信号处理算法分别计算出左右腿髋关节角度变化值,包括:外骨骼装置左腿髋关节角度变化值、外骨骼装置右腿髋关节角度变化值、外骨骼装置左腿髋关节角速度值、外骨骼装置右腿髋关节角速度值;
搬运模式切换运动控制模块:通过信号采集与处理模块获取运动控制模块中所需的数据,根据上述数据进行所述搬运状态切换运动控制模块中的逻辑判断,最后根据逻辑判断结果自动切换搬运状态。
所述电机驱动模块将上述左右腿髋关节的输出力矩值转化为驱动器的指令,从而发送指令驱动电机辅助人体搬运。
所述人机交互模块将人所设定的最大力矩值作为限制条件,可由人机交互界面按键设置对应的最大力矩,达到舒适。
一种助力外骨骼机器人的搬运状态切换控制方法,包括以下步骤:
1、进入无动力模式并且周期进入步骤2;
2、获取肌电传感器的多通道肌电信号,如果肌电信号超过设定的肌电信号阈值,则执行步骤3;否则,执行步骤1;
3、获取左腿髋关节、右腿髋关节无刷直流电机编码器角度值,判断左右腿髋关节的角度值是否大于起身角度阈值,若是,执行步骤5(物体从下往上搬运模式逻辑图,见图3),否则执行步骤4;
4、判断髋关节角度值是否小于下蹲角度阈值,若是,执行步骤6,否则执行步骤1;
5、获取左腿髋关节、右腿髋关节无刷直流电机编码器角速度值,并判断条件a;
条件a:判断左右腿髋关节角度值是否小于起身角度阈值且左右腿髋关节角速度大于起身速度阈值,若是,则执行起身平滑助力指令,否则执行条件b;
条件b:判断左右腿髋关节角度值是否大于下蹲起身角度阈值且左右腿髋关节角速度大于下蹲速度阈值,若是,则执行下蹲平滑助力指令,否则执行条件c;
条件c:判断左右腿髋关节编码角度值是否大于起身的角度阈值且小于起身的速度阈值,若是,则结束助力状态且执行步骤1;否则执行上一次助力指令并执行条件a;
6、获取左腿髋关节、右腿髋关节无刷直流电机编码器角速度值,并进入条件d;
条件d:判断左右腿髋关节角度值是否大于下蹲角度阈值且左右腿髋关节角速度大于下蹲速度阈值,若是,则执行下蹲平滑助力指令,否则执行条件e;
条件e:判断左右腿髋关节角度值是否小于起身角度阈值且左右腿髋关节角速度大于起身速度阈值,若是,则执行起身平滑助力指令,否则执行条件f;
条件f:判断左右腿髋关节编码角度值是否小于下蹲的角度阈值且速度值小于下蹲的速度阈值,若是,则结束助力状态且执行步骤1;否则执行上一次助力指令并进入条件d。
本发明使用了人机交互界面。系统可按动助力开关键,开关其助力功能。同时系统也可按动助力值增减键设定大小。
上述实施例用于对本发明作进一步的说明,但并不将本发明局限于这些具体实施方式。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应理解为在本发明的保护范围之内。

Claims (2)

1.一种主动式腰部助力外骨骼控制系统,其特征在于:包括传感器模块、无刷直流电机、信号采集与处理模块、搬运模式切换运动控制模块、电机驱动模块、人机交互界面,所述传感器包括:肌电传感器、电机编码器;
所述肌电传感器放置在左右手小臂处,用于采集所述人体搬运重物的肌电信号。
所述电机编码器放置在所述外骨骼装置的左右腿髋关节外侧,用于采集所述外骨骼装置的左右腿髋关节无刷直流电机码盘值;
所述信号采集与处理模块:将电机编码器所采集的电机码盘值通过信号处理算法分别计算出左右腿髋关节角度变化值,包括:外骨骼装置左腿髋关节角度变化值、外骨骼装置右腿髋关节角度变化值、外骨骼装置左腿髋关节角速度值、外骨骼装置右腿髋关节角速度值;
搬运模式切换运动控制模块:通过信号采集与处理模块获取运动控制模块中所需的数据,根据上述数据进行所述搬运状态切换运动控制模块中的逻辑判断,最后根据逻辑判断结果自动切换搬运状态。
所述电机驱动模块将上述左右腿髋关节的输出力矩值转化为驱动器的指令,从而发送指令驱动电机辅助人体搬运。
所述人机交互模块将人所设定的最大力矩值作为限制条件,可由人机交互界面按键设置对应的最大力矩,达到舒适。
2.一种助力外骨骼机器人的搬运状态切换控制方法,根据权利要求1一种主动式腰部助力外骨骼控制系统所述,其特征在于,包括以下步骤:
1、进入无动力模式并且周期进入步骤2;
2、获取肌电传感器的多通道肌电信号,如果肌电信号超过设定的肌电信号阈值,则执行步骤3;否则,执行步骤1;
3、获取左腿髋关节、右腿髋关节无刷直流电机编码器角度值,判断左右腿髋关节的角度值是否大于起身角度阈值,若是,执行步骤5(物体从下往上搬运模式逻辑图,见图3),否则执行步骤4;
4、判断髋关节角度值是否小于下蹲角度阈值,若是,执行步骤6,否则执行步骤1;
5、获取左腿髋关节、右腿髋关节无刷直流电机编码器角速度值,并判断条件a;
条件a:判断左右腿髋关节角度值是否小于起身角度阈值且左右腿髋关节角速度大于起身速度阈值,若是,则执行起身平滑助力指令,否则执行条件b;
条件b:判断左右腿髋关节角度值是否大于下蹲起身角度阈值且左右腿髋关节角速度大于下蹲速度阈值,若是,则执行下蹲平滑助力指令,否则执行条件c;
条件c:判断左右腿髋关节编码角度值是否大于起身的角度阈值且小于起身的速度阈值,若是,则结束助力状态且执行步骤1;否则执行上一次助力指令并执行条件a;
6、获取左腿髋关节、右腿髋关节无刷直流电机编码器角速度值,并进入条件d;
条件d:判断左右腿髋关节角度值是否大于下蹲角度阈值且左右腿髋关节角速度大于下蹲速度阈值,若是,则执行下蹲平滑助力指令,否则执行条件e;
条件e:判断左右腿髋关节角度值是否小于起身角度阈值且左右腿髋关节角速度大于起身速度阈值,若是,则执行起身平滑助力指令,否则执行条件f;
条件f:判断左右腿髋关节编码角度值是否小于下蹲的角度阈值且速度值小于下蹲的速度阈值,若是,则结束助力状态且执行步骤1;否则执行上一次助力指令并进入条件d。
CN201911222758.9A 2019-12-03 2019-12-03 一种主动式腰部助力外骨骼控制系统以及控制方法 Expired - Fee Related CN110802603B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911222758.9A CN110802603B (zh) 2019-12-03 2019-12-03 一种主动式腰部助力外骨骼控制系统以及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911222758.9A CN110802603B (zh) 2019-12-03 2019-12-03 一种主动式腰部助力外骨骼控制系统以及控制方法

Publications (2)

Publication Number Publication Date
CN110802603A true CN110802603A (zh) 2020-02-18
CN110802603B CN110802603B (zh) 2022-07-12

Family

ID=69492422

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911222758.9A Expired - Fee Related CN110802603B (zh) 2019-12-03 2019-12-03 一种主动式腰部助力外骨骼控制系统以及控制方法

Country Status (1)

Country Link
CN (1) CN110802603B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114762644A (zh) * 2021-01-04 2022-07-19 纬创资通股份有限公司 行动辅助装置以及其驱动方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101791255A (zh) * 2010-03-08 2010-08-04 上海交通大学 助行外骨骼机器人系统及控制方法
CN106325273A (zh) * 2016-08-22 2017-01-11 中国科学院合肥物质科学研究院 助力外骨骼机器人的多相位步态切换控制系统及其控制方法
CN107753241A (zh) * 2017-11-20 2018-03-06 中航创世机器人(东莞)有限公司 一种下肢康复治疗智能外骨骼机器人的控制方法
CN109434806A (zh) * 2018-10-15 2019-03-08 孙红梅 一种辅助搬运的可穿戴智能设备控制方法
CN110103215A (zh) * 2019-04-12 2019-08-09 上海中研久弋科技有限公司 多节点协同感知外骨骼神经控制系统、方法、设备和介质
CN110385697A (zh) * 2019-07-16 2019-10-29 北京机械设备研究所 外骨骼的控制方法及装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101791255A (zh) * 2010-03-08 2010-08-04 上海交通大学 助行外骨骼机器人系统及控制方法
CN106325273A (zh) * 2016-08-22 2017-01-11 中国科学院合肥物质科学研究院 助力外骨骼机器人的多相位步态切换控制系统及其控制方法
CN107753241A (zh) * 2017-11-20 2018-03-06 中航创世机器人(东莞)有限公司 一种下肢康复治疗智能外骨骼机器人的控制方法
CN109434806A (zh) * 2018-10-15 2019-03-08 孙红梅 一种辅助搬运的可穿戴智能设备控制方法
CN110103215A (zh) * 2019-04-12 2019-08-09 上海中研久弋科技有限公司 多节点协同感知外骨骼神经控制系统、方法、设备和介质
CN110385697A (zh) * 2019-07-16 2019-10-29 北京机械设备研究所 外骨骼的控制方法及装置

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114762644A (zh) * 2021-01-04 2022-07-19 纬创资通股份有限公司 行动辅助装置以及其驱动方法
CN114762644B (zh) * 2021-01-04 2024-05-10 纬创资通股份有限公司 行动辅助装置以及其驱动方法

Also Published As

Publication number Publication date
CN110802603B (zh) 2022-07-12

Similar Documents

Publication Publication Date Title
CN106325273B (zh) 助力外骨骼机器人的多相位步态切换控制系统及其控制方法
US10512583B2 (en) Forward or rearward oriented exoskeleton
CN203020441U (zh) 一种类人机器人脚
CN103802907A (zh) 类人机器人脚
CN102431604A (zh) 具有双足步行与轮式移动互变功能的仿人机器人
CN106737584A (zh) 一种基于空心驱动器、微型驱动器的人形机器人
CN103722550A (zh) 外骨骼机器人的嵌入式系统
CN110802603B (zh) 一种主动式腰部助力外骨骼控制系统以及控制方法
CN105446345A (zh) 仿人双足机器人控制系统
CN207329166U (zh) 一种自动行走载货箱
EP0856457A3 (en) Gait generation system of legged mobile robot
CN108214458B (zh) 可穿戴上肢机械臂
CN110721055B (zh) 下肢助行外骨骼机器人的控制方法及外骨骼机器人
CN206932110U (zh) 带刹车外转子直流一体电机
Long et al. Physical human-robot interaction estimation based control scheme for a hydraulically actuated exoskeleton designed for power amplification
Yu et al. Gesture-based telemanipulation of a humanoid robot for home service tasks
CN110561391B (zh) 用于下肢外骨骼系统的惯性信息前馈控制装置及控制方法
CN102722186A (zh) 一种基于语音识别的移动伺服平台及语音控制方法
KR101814732B1 (ko) 기립보조장치 및 이를 포함하는 시스템
CN204488503U (zh) 单手柄控制的履带底盘式高空作业平台行走和转向系统
CN114750133B (zh) 一种腰部外骨骼机器人系统及其助力控制方法
CN104526697A (zh) 排泄辅助机器人
Wang et al. Research on a kind of leg-wheel stair-climbing wheelchair
CN2807312Y (zh) 一种嵌入式智能轮椅控制装置
Lee et al. Walking-support robot system for walking rehabilitation: design and control

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
TA01 Transfer of patent application right

Effective date of registration: 20200227

Address after: 215000 22 / F, 19 aigehao Road, Weitang Town, Xiangcheng District, Suzhou City, Jiangsu Province

Applicant after: SINOMACH INTELLIGENCE TECHNOLOGY Co.,Ltd.

Applicant after: SHENZHEN INSTITUTES OF ADVANCED TECHNOLOGY CHINESE ACADEMY OF SCIENCES

Address before: 215000 22 / F, 19 aigehao Road, Weitang Town, Xiangcheng District, Suzhou City, Jiangsu Province

Applicant before: SINOMACH INTELLIGENCE TECHNOLOGY Co.,Ltd.

TA01 Transfer of patent application right
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20220712

CF01 Termination of patent right due to non-payment of annual fee