CN108247605A - 一种紧急姿态控制方法和*** - Google Patents

一种紧急姿态控制方法和*** Download PDF

Info

Publication number
CN108247605A
CN108247605A CN201711317621.2A CN201711317621A CN108247605A CN 108247605 A CN108247605 A CN 108247605A CN 201711317621 A CN201711317621 A CN 201711317621A CN 108247605 A CN108247605 A CN 108247605A
Authority
CN
China
Prior art keywords
parameter
knee joint
motion
period
ankle
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
CN201711317621.2A
Other languages
English (en)
Other versions
CN108247605B (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.)
SHENZHEN ROBO MEDICAL TECHNOLOGY CO., LTD.
Original Assignee
Shenzhen Rob Medical Robot Research Institute
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 Shenzhen Rob Medical Robot Research Institute filed Critical Shenzhen Rob Medical Robot Research Institute
Priority to CN201711317621.2A priority Critical patent/CN108247605B/zh
Publication of CN108247605A publication Critical patent/CN108247605A/zh
Application granted granted Critical
Publication of CN108247605B publication Critical patent/CN108247605B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/0006—Exoskeletons, i.e. resembling a human figure
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1612—Programme controls characterised by the hand, wrist, grip control
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1633—Programme 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)
  • Health & Medical Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Rehabilitation Tools (AREA)

Abstract

本发明公开了一种紧急姿态控制方法和***，该方法包括：获取下肢运动参数，包括膝关节角度参数、膝关节角度变化参数、踝关节压力参数和踝关节压力变化参数；根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期，所述运动周期包括行走支撑期和行走摆动期；基于所述运动周期、所述膝关节角度变化参数和/或所述踝关节压力变化参数输出对应的控制指令以控制所述液压动力装置。该***用于执行方法。本发明根据下肢姿态载入对应的运动配置文件，能够针对性的处理对应的膝关节角度和/或踝关节压力的变化，输出对应合适的指令以控制液压动力装置辅助人的行走。

Description

一种紧急姿态控制方法和***
技术领域
本发明涉及运动辅助设备领域，尤其涉及一种紧急姿态控制方法和***。
背景技术
由于老龄和疾病原因导致的行动不便会极大的影响人们的正常生活，因此用于辅助人运动的仪器也广泛运用在现实生活中，现在，这些仪器在正常工作的情况下都能很好的辅助人行走，但是在遇到例如滑倒、磕绊等紧急情况则不能很好的辅助人行走。
发明内容
为了解决紧急情况下的辅助人行走的问题，本发明通过提供一种紧急姿态控制方法和***。
本发明采用的技术方案一方面为一种紧急姿态控制方法，适用于采用液压动力装置的下肢辅助装置，包括步骤：获取下肢运动参数，包括膝关节角度参数、膝关节角度变化参数、踝关节压力参数和踝关节压力变化参数；根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期，所述运动周期包括行走支撑期和行走摆动期；基于所述运动周期、所述膝关节角度变化参数和/或所述踝关节压力变化参数输出对应的控制指令以控制所述液压动力装置。
优选地，当运动周期为行走支撑期，判断所述踝关节压力变化参数是否超过压力阈值，是则增大所述液压动力装置的阻尼；当运动周期为行走摆动期，如果所述膝关节角度参数在预设时间内保持不变则锁死所述液压动力装置。
优选地，根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期的步骤包括：当膝关节角度参数大于角度阈值且所述膝关节角度变化参数小于变化阈值时，标记所述下肢辅助装置处于行走支撑期，反之则为行走摆动期。
本发明采用的技术方案一方面为一种紧急姿态控制***，用于执行上述方法，包括：采集模块，用于获取下肢运动参数，包括膝关节角度参数、膝关节角度变化参数、踝关节压力参数和踝关节压力变化参数；处理模块，用于根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期，所述运动周期包括行走支撑期和行走摆动期；控制模块，用于基于所述运动周期、所述膝关节角度变化参数和/或所述踝关节压力变化参数输出对应的控制指令以控制所述液压动力装置。
优选地，当运动周期为行走支撑期，判断所述踝关节压力变化参数是否超过压力阈值，是则增大所述液压动力装置的阻尼；当运动周期为行走摆动期，如果所述膝关节角度参数在预设时间内保持不变则锁死所述液压动力装置。
优选地，根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期的步骤包括：当膝关节角度参数大于角度阈值且所述膝关节角度变化参数小于变化阈值时，标记所述下肢辅助装置处于行走支撑期，反之则为行走摆动期。
本发明的有益效果为根据下肢运动参数标记下肢辅助装置处于的运动周期，根据不同的运动周期和下肢运动参数输出对应的控制指令以控制所述液压动力装置。
附图说明
图1所示为基于本发明实施例的一种紧急姿态控制方法的示意图；
图2所示为基于本发明实施例的磕绊状态信号采集过程的示意图；
图3所示为基于本发明实施例的脚滑状态信号采集过程的示意图；
图4所示为基于本发明实施例的***进入防磕绊保护模式的流程图；
图5所示为基于本发明实施例的***进入防脚滑倒保护模式的流程图。
具体实施方式
以下结合实施例对本发明进行说明。
基于发明的实施例，如图1所示的一种紧急姿态控制方法，适用于采用液压动力装置的下肢辅助装置，包括步骤：获取下肢运动参数，包括膝关节角度参数、膝关节角度变化参数、踝关节压力参数和踝关节压力变化参数；根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期，所述运动周期包括行走支撑期和行走摆动期；基于所述运动周期、所述膝关节角度变化参数和/或所述踝关节压力变化参数输出对应的控制指令以控制所述液压动力装置。
当运动周期为行走支撑期，判断所述踝关节压力变化参数是否超过压力阈值，是则增大所述液压动力装置的阻尼；当运动周期为行走摆动期，如果所述膝关节角度参数在预设时间内保持不变则锁死所述液压动力装置。
根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期的步骤包括：当膝关节角度参数大于角度阈值且所述膝关节角度变化参数小于变化阈值时，标记所述下肢辅助装置处于行走支撑期，反之则为行走摆动期。
基于发明的实施例，一种紧急姿态控制***，用于执行上述方法，包括：采集模块，用于获取下肢运动参数，包括膝关节角度参数、膝关节角度变化参数、踝关节压力参数和踝关节压力变化参数；处理模块，用于根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期，所述运动周期包括行走支撑期和行走摆动期；控制模块，用于基于所述运动周期、所述膝关节角度变化参数和/或所述踝关节压力变化参数输出对应的控制指令以控制所述液压动力装置。
当运动周期为行走支撑期，判断所述踝关节压力变化参数是否超过压力阈值，是则增大所述液压动力装置的阻尼；当运动周期为行走摆动期，如果所述膝关节角度参数在预设时间内保持不变则锁死所述液压动力装置。
根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期的步骤包括：当膝关节角度参数大于角度阈值且所述膝关节角度变化参数小于变化阈值时，标记所述下肢辅助装置处于行走支撑期，反之则为行走摆动期。
人在行动的时候，基于人体力学原理，可以大致分为行走支撑阶段(脚底接触实地至离开实地，即后述支撑期)和行走摆动阶段(脚底离开实地至接触实地，即后述摆动期)，由于行走支撑阶段实际上腿部是很少向前移动的，因此基本不会发生磕绊的情况；反之行走摆动阶段则由于脚已经抬空，基本不会发生脚滑的事情。
作为下肢姿态(运动特征)的数值化处理，主要通过踝关节的压力和膝关节角度来体现上述的行走支撑期和行走摆动期。
下肢辅助装置作为电路驱动机械结构的装置，需要设置一个用于控制装置运动的控制程序或配置文件；同时针对下肢辅助装置，发生脚滑和磕绊这两种在人体力学内运动特征区别较大的情况，针对具体情况进行具体的分析并输出对应的指令。
通过各种压力传感器，例如角度测量器，加速度传感器等器材能够测量膝关节角度和角度变化参数，踝关节压力和压力变化参数；根据人体力学原理，实际开展的若干运动实验以记录人体运动过程中(本例子中，所述运动主要为行走)，对应的下肢运动参数的变化情况，根据这些变化情况(例如压力处于什么区间、压力变化参数处于什么区间、膝关节角度处于什么区间，膝关节角度变化参数处于什么区间，例如人在支撑期，膝关节一直是伸展的，其角度大于一定值,其角度变化的角度数、变化率都不会大，反之，在摆动期，膝关节变化较大)来读取对应的控制指令以控制控制所述液压动力装置。
磕绊危急情况：当在摆动期发生磕绊情况时，存在对膝关节的阻碍情形发生，此时存在的情况就是小腿部被阻碍，膝关节发生快速屈曲的情况发生。对于以上情况的发生，极易导致双膝跪地，更严重的会导致身体前倾倒地。此时采取的保护措施就是：当进入防磕绊保护模式时，首先就是增大液压动力装置的阻尼，使身体重心变化速度放缓，当发现身体失去平衡时，立即锁死液压动力装置阻尼阀门，使得膝关节保持此时的屈曲角度α，保持身体的平衡状态。
脚滑危急情况：当在支撑期发生脚滑情况时，存在腿部在支撑期的时刻向前或向后打滑情形发生，此时存在的情况就是在支撑期身体的重心失稳，身体向前趴或者身体后仰。对于以上情况的发生，极易导致前趴，更严重的会导致身体后仰倒地。此时采取的保护措施就是：当进入脚滑保护模式时，膝关节处于在支撑期时，在正常情况下，膝关节处于锁死状态；当发生脚滑紧急情况时，首先就是增大液压动力装置的阻尼，使身体重心变化速度放缓。无论是前趴还是后仰，膝关节会存在一个屈曲角度来维持身体的平衡，当膝关节保持屈曲角度β的时间T＞阈值T0，此时阻尼阀门呈锁死状态，使身体处于该状态的平衡状态。
如图2所示的磕绊状态信号采集过程：
踝关节压力传感器主要是检测由身体重心的变化引起的踝关节处受力的变化，在摆动期时，小腿处于悬空摆动状态，踝关节处的受力从理论分析上是不变的。当发生磕绊紧急危险的情况时，由于脚部障碍物的阻挡，踝关节处会发生瞬时的转动，导致踝关节处的受力发生变化。同时，由于脚部障碍物的阻挡，膝关节角度发生不变。踝关节压力传感器采集到瞬时形变信号，以及膝关节角度传感器采集到角度不变信号，经过信号处理电路，将压力信号及膝关节角度信号转变为电信号。
如图3所示的脚滑状态信号采集过程：
采集过程：踝关节压力传感器主要是检测由身体重心的变化引起的踝关节处受力的变化，在支撑期时，小腿处于支撑于地面的状态，踝关节处的受力从理论分析上是连续变化的过程。当发生脚滑紧急危险的情况时，由于身体重心严重发生失稳，无论是前倾还是后仰，都存在踝关节压力发生瞬时冲击剧变。踝关节角度传感器采集到瞬时剧变信号，经过信号处理电路，将压力信号转变为电信号。
如图4所示的***进入防磕绊保护模式的流程图：
***初始化，膝关节角度传感器需要检测膝关节所处的角度是否已进入行走摆动期，当踝关节角度传感器检测到人体重心受力与人为设置的行走支撑期受力相等(即脚接触实地)，检测***(即预处理模块)会进入对摆动期的判断。当检测到的膝关节转动方向与人为设置的摆动期膝关节转动方向不一致时，膝关节角度传感器会继续对膝关节角度的变化方向检测。
检测***是否进入对摆动期，存在两个判断条件：1、踝关节处的受力F是否已经达到人为设定的受力状态，即力信号F＝K1(符合人体力学原理，K1位预设值)；2、膝关节是否将屈曲与是否伸直(即根据角度变化参数)，此时主要是利用膝关节的转动方向来判断，膝关节伸直时所处的方向为正flag＝＝1，屈曲时所处的方向为负flag＝＝0。以上两个条件同时满足的前提下，***正式进入防磕绊保护模式。
其中，K1为支撑期与摆动期支撑力临界值，此值为设定值；正反转标志位区分屈曲(flag＝＝0)和伸展(flag＝＝1)。
如图5所示的***进入防脚滑倒保护模式的流程图：
***初始化，膝关节角度传感器需要检测膝关节所处的角度是否已进入行走支撑期，当膝关节角度传感器检测到膝关节角度α与预设的行走支撑期的角度K2一致，检测***会进入对支撑期的判断；当检测到的膝关节角度与人为设置的行走支撑期的角度不等时，膝关节角度传感器会继续对膝关节角度的检测。
检测***是否进入对支撑期，存在两个判断条件：1、膝关节是否将屈曲与是否伸直，此时主要是利用膝关节的转动方向来判断，膝关节伸直时所处的方向为正，屈曲时所处的方向为负(符合人体力学原理)；2、延时判断膝关节角度的不变性(KT＝＝0)与变性(KT＝＝1)，依靠延时检测的方法判断膝关节角度是否存在变化。以上两个条件同时满足的前提下，***正式进入防脚滑倒保护模式。
其中，K2为处于支撑期膝关节所处的角度值，此值为设定值。
以上所述，只是本发明的较佳实施例而已，本发明并不局限于上述实施方式，只要其以相同的手段达到本发明的技术效果，都应属于本发明的保护范围。在本发明的保护范围内其技术方案和/或实施方式可以有各种不同的修改和变化。

Claims (6)

1.一种紧急姿态控制方法，适用于采用液压动力装置的下肢辅助装置，其特征在于，包括步骤：
获取下肢运动参数，包括膝关节角度参数、膝关节角度变化参数、踝关节压力参数和踝关节压力变化参数；
根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期，所述运动周期包括行走支撑期和行走摆动期；
基于所述运动周期、所述膝关节角度变化参数和/或所述踝关节压力变化参数输出对应的控制指令以控制所述液压动力装置。
2.根据权利要求1所述的紧急姿态控制方法，其特征在于，当运动周期为行走支撑期，判断所述踝关节压力变化参数是否超过压力阈值，是则增大所述液压动力装置的阻尼；
当运动周期为行走摆动期，如果所述膝关节角度参数在预设时间内保持不变则锁死所述液压动力装置。
3.根据权利要求1所述的紧急姿态控制方法，其特征在于，根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期的步骤包括：
当膝关节角度参数大于角度阈值且所述膝关节角度变化参数小于变化阈值时，标记所述下肢辅助装置处于行走支撑期，反之则为行走摆动期。
4.一种紧急姿态控制***，用于执行权利要求1所述方法，其特征在于，包括：
采集模块，用于获取下肢运动参数，包括膝关节角度参数、膝关节角度变化参数、踝关节压力参数和踝关节压力变化参数；
处理模块，用于根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期，所述运动周期包括行走支撑期和行走摆动期；
控制模块，用于基于所述运动周期、所述膝关节角度变化参数和/或所述踝关节压力变化参数输出对应的控制指令以控制所述液压动力装置。
5.根据权利要求4所述的一种紧急姿态控制***，其特征在于，当运动周期为行走支撑期，判断所述踝关节压力变化参数是否超过压力阈值，是则增大所述液压动力装置的阻尼；
当运动周期为行走摆动期，如果所述膝关节角度参数在预设时间内保持不变则锁死所述液压动力装置。
6.根据权利要求4所述的一种紧急姿态控制***，其特征在于，根据所述下肢运动参数标记所述下肢辅助装置处于的运动周期的步骤包括：
当膝关节角度参数大于角度阈值且所述膝关节角度变化参数小于变化阈值时，标记所述下肢辅助装置处于行走支撑期，反之则为行走摆动期。
CN201711317621.2A 2017-12-12 2017-12-12 一种紧急姿态控制方法和*** Active CN108247605B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711317621.2A CN108247605B (zh) 2017-12-12 2017-12-12 一种紧急姿态控制方法和***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711317621.2A CN108247605B (zh) 2017-12-12 2017-12-12 一种紧急姿态控制方法和***

Publications (2)

Publication Number Publication Date
CN108247605A true CN108247605A (zh) 2018-07-06
CN108247605B CN108247605B (zh) 2020-03-20

Family

ID=62722485

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711317621.2A Active CN108247605B (zh) 2017-12-12 2017-12-12 一种紧急姿态控制方法和***

Country Status (1)

Country Link
CN (1) CN108247605B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111358667A (zh) * 2018-12-26 2020-07-03 沈阳新松机器人自动化股份有限公司 基于关节应力的下肢外骨骼人机交互运动控制的方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103042526A (zh) * 2013-01-22 2013-04-17 北京理工大学 仿人机器人控制单脚支撑期支撑脚板的方法和装置
CN103976739A (zh) * 2014-05-04 2014-08-13 宁波麦思电子科技有限公司 穿戴式摔倒动态实时检测方法和装置
CN105213155A (zh) * 2015-10-29 2016-01-06 刘珩先 一种人工智能运动辅助设备
CN106625604A (zh) * 2016-12-30 2017-05-10 深圳先进技术研究院 基于助力外骨骼机器人的运动状态判别方法及***
JP2017196681A (ja) * 2016-04-26 2017-11-02 川崎重工業株式会社 産業用ロボット

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103042526A (zh) * 2013-01-22 2013-04-17 北京理工大学 仿人机器人控制单脚支撑期支撑脚板的方法和装置
CN103976739A (zh) * 2014-05-04 2014-08-13 宁波麦思电子科技有限公司 穿戴式摔倒动态实时检测方法和装置
CN105213155A (zh) * 2015-10-29 2016-01-06 刘珩先 一种人工智能运动辅助设备
JP2017196681A (ja) * 2016-04-26 2017-11-02 川崎重工業株式会社 産業用ロボット
CN106625604A (zh) * 2016-12-30 2017-05-10 深圳先进技术研究院 基于助力外骨骼机器人的运动状态判别方法及***

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111358667A (zh) * 2018-12-26 2020-07-03 沈阳新松机器人自动化股份有限公司 基于关节应力的下肢外骨骼人机交互运动控制的方法
CN111358667B (zh) * 2018-12-26 2022-02-11 沈阳新松机器人自动化股份有限公司 基于关节应力的下肢外骨骼人机交互运动控制的方法

Also Published As

Publication number Publication date
CN108247605B (zh) 2020-03-20

Similar Documents

Publication Publication Date Title
Li et al. Gait mode recognition and control for a portable-powered ankle-foot orthosis
US9826806B2 (en) Assistive support systems and devices for automatic feedback
Rueterbories et al. Methods for gait event detection and analysis in ambulatory systems
Gouwanda et al. A robust real-time gait event detection using wireless gyroscope and its application on normal and altered gaits
AU2011311954B2 (en) Human machine interfaces for lower extremity orthotics
CN108379038B (zh) 一种下肢康复外骨骼***及其步行控制方法
US9750620B2 (en) Systems and control methodologies for improving stability in powered lower limb devices
EP3256045A1 (en) System and method for assistive gait intervention and fall prevention
CN107174253A (zh) 一种下肢运动姿态的判断方法、装置和***
CN108577854A (zh) 步态识别方法和步态辅助设备
Yang et al. Machine learning based adaptive gait phase estimation using inertial measurement sensors
Bishop et al. Walking speed estimation using shank-mounted accelerometers
CN109938892A (zh) 一种智能膝上假肢穿戴者骑行状态识别***
Zakria et al. Heuristic based gait event detection for human lower limb movement
Srivises et al. Design of a smart shoe for reliable gait analysis using state transition theory
CN108247605A (zh) 一种紧急姿态控制方法和***
Alahakone et al. Smart wearable device for real time gait event detection during running
Patterson et al. A novel approach for assessing gait using foot mounted accelerometers
Arrofiqi et al. Design of wearable system for closed-loop control of gait restoration system by Functional Electrical Stimulation
JP2006087735A (ja) 歩行解析装置
Lee et al. Monitoring sprinting gait temporal kinematics of an athlete aiming for the 2012 London Paralympics
Bai et al. Walking activity detection with lower limbs rehabilitative training robot by wearable wireless sensors
Park et al. Developing a portable gait cycle detection system using an inertial sensor and evaluating the accuracy of the gait cycle detection
Tan et al. Human fall detection improvement based on artificial neural network and optimized zero moment point algorithms
Li et al. Neural network-based gait assessment using measurements of a wearable sensor system

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for 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: 20191014

Address after: 518000 1001-A, G2 Building, TCL International E City, 1001 Zhongshan Garden Road, Xili Street, Nanshan District, Shenzhen City, Guangdong Province

Applicant after: SHENZHEN ROBO MEDICAL TECHNOLOGY CO., LTD.

Address before: 2, C building, building 1, building 3, the Great Wall computer tower, No. 518000, FA FA Road, Shenzhen, Guangdong, Nanshan District

Applicant before: Shenzhen rob Medical Robot Research Institute

GR01 Patent grant
GR01 Patent grant