CN109262613B - 一种应用于运动辅助型外骨骼的合力场控制方法及装置 - Google Patents
一种应用于运动辅助型外骨骼的合力场控制方法及装置 Download PDFInfo
- Publication number
- CN109262613B CN109262613B CN201811191853.2A CN201811191853A CN109262613B CN 109262613 B CN109262613 B CN 109262613B CN 201811191853 A CN201811191853 A CN 201811191853A CN 109262613 B CN109262613 B CN 109262613B
- Authority
- CN
- China
- Prior art keywords
- exoskeleton
- force
- resultant force
- force field
- current
- 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
Links
Images
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/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
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)
- Manipulator (AREA)
Abstract
本发明涉及一种应用于运动辅助型外骨骼的合力场控制方法及装置,属于外骨骼技术领域,方法包括,根据获取的外骨骼给定位置运动轨迹和当前位置,计算当前位置和期望位置的位置误差;建立可视化合力场模型,依据所述位置误差,合力场产生纠正位置误差的力分量和牵拉外骨骼末端运动的力分量;进行合力场输出力控制,输出助力辅助外骨骼运动。本发明可应用于康复外骨骼、助力增强型外骨骼等***,具有算法简单、安全性高等优点。
Description
技术领域
本发明涉及外骨骼技术领域,尤其是一种应用于运动辅助型外骨骼的合力场控制方法及装置。
背景技术
外骨骼机器人是一种可穿戴式的助力装备(提供力学辅助)。
目前,国内外的各类外骨骼机器人既有应用基于运动学/动力学传感信息的控制算法,例如广泛应用于机器人***的PID控制、计算力矩控制、导纳控制和阻抗控制等方法,并根据***具体特点做部分改进,融合例如神经网络控制、模糊控制等;还有一部分外骨骼机器人采用基于生物电信息的控制算法,但目前生物电信息更多地用于定性地应用于触发式控制,而生物电信息解码由于准确度不高,其用于过程控制并不可靠。因此,外骨骼主流做法还是基于运动学/动力学信号反馈的控制方法,核心的理念依然是实现基于人机友好交互地动力学控制策略。
从外骨骼的应用角度讲,外骨骼控制算法的设计不是着眼于高精度的轨迹运动控制而是强调人机动力交互性能,使外骨骼能够稳定地按需辅助肢体的运动。从这个角度来讲,常用的机器人控制方法用于运动辅助型外骨骼并不完全切合其控制目标。
发明内容
鉴于上述的分析,本发明旨在提供一种应用于运动辅助型外骨骼的合力场控制方法及装置,对外骨骼的运动辅助力进行规划,使外骨骼辅助人实现运动,同时提高外骨骼控制算法的响应速度。
本发明的目的主要是通过以下技术方案实现的:
一种面向运动辅助型外骨骼的合力场控制方法,包括如下步骤:
根据获取的外骨骼给定位置运动轨迹和当前位置,计算当前位置和期望位置的位置误差;
建立可视化合力场模型,依据所述位置误差,利用合力场模型产生纠正位置误差的力分量和牵拉所述外骨骼末端运动的力分量;
进行合力场输出力控制,输出助力辅助外骨骼运动。
进一步地,所述当前位置和期望位置的位置误差di=Δpi=|pi-p′i|,式中,当前位置p′i为外骨骼末端位置,期望位置pi为所述外骨骼给定位置运动轨迹上距离当前位置p′i最近点的位置。
进一步地,所述建立的可视化合力场模型为沿着所述给定位置运动轨迹的截面为圆形的管体空间。
进一步地,所述合力场模型输出力包括法向力fn和切向力ft;
进一步地,所述法向力fn和切向力ft表示为
进一步地,所述进行合力场输出力控制包括:判断外骨骼末端当前位置p′i与建立的合力场模型的位置关系;当位置误差di>S时,输出助力F=fn;当位置误差di≤S,输出助力F=fn+ft。
一种面向运动辅助型外骨骼的合力场控制装置,包括位置误差计算模块、合力场模块和助力输出模块;
所述位置误差计算模块,用于计算外骨骼前位置和期望位置的位置误差;
合力场模块,与所述位置误差计算模块连接,用于建立可视化合力场模型,依据所述位置误差,产生纠正误差的力分量和牵拉所述外骨骼末端运动的力分量;
助力输出模块,分别与所述位置误差计算模块和合力场模块连接,用于控制合力场的输出力,辅助外骨骼运动。
进一步地,所述误差计算模块的输入为外骨骼给定位置运动轨迹和当前位置;输出为当前位置和期望位置的位置误差di=Δpi=|pi-p′i|,式中,p′i为外骨骼末端位置为当前位置,pi为所述外骨骼给定位置运动轨迹上距离当前位置p′i最近的点。
进一步地,所述合力场模块输出的产生纠正误差的力分量为法向力fn,牵拉所述外骨骼末端运动的力分量为切向力ft;所述法向力fn和切向力ft表示为:
进一步地,所述助力输出模块,首先判断外骨骼末端当前位置p′i与建立的合力场模型的位置关系;当位置误差di>S时,输出力F=fn;当位置误差di≤S,输出力F=fn+ft。
本发明有益效果如下:
本发明给出的面向运动辅助型外骨骼的合力场控制方法及装置,能够针对使用者的助力需求设置控制参数,做到“按需辅助”。使用者对控制参数所含物理意义的理解度较高,控制方法直观易于参数调试,可应用于康复外骨骼、助力增强型外骨骼等***,具有算法简单、安全性高等优点。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1为本发明实施例中合力场控制方法流程图;
图2为本发明实施例中空间位置误差表示图;
图3为本发明实施例中合力场模型示意图;
图4为本发明实施例中合力场控制装置组成连接示意图。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理。
本发明实施例公开了一种面向运动辅助型外骨骼的合力场控制方法,如图1所示,包括如下步骤:
步骤S1、根据获取的外骨骼给定位置运动轨迹和当前位置,计算当前位置和期望位置的位置误差;
如图2所示,对于运动辅助型外骨骼,给定的运动轨迹,即为期望轨迹,在给定的轨迹上的点为三维空间中一系列的期望位置簇;外骨骼末端位置为当前位置p'i(x'i,y'i,z'i),轨迹线的初始位置位移为p0,末位置为pn,距离当前位置最近的点为期望位置pi(xi,yi,zi);则,当前位置和期望位置的位置误差大小di=Δpi=|pi-p′i|。图中,轨迹线的法向和切向方向分别为和
步骤S2、建立可视化合力场模型,依据所述位置误差,合力场产生纠正位置误差的力分量和牵拉所述外骨骼末端运动的力分量;
如图3所示,建立的可视化的合力场模型为沿着位置轨迹的截面为圆形的管体空间;
圆形截面的半径为S;半径S根据在控制率设计时,可容忍的最大轨迹跟踪误差确定,即,半径S可取不大于设定的轨迹跟踪误差。
合力场辅助力输出包括两个力分量:法向力fn和切向力ft,
切向力ft——牵拉所述外骨骼末端运动的力分量,方向沿轨迹线的切向方向大小为位置误差d和当前位置相对运动轨迹的行程比率r的函数,di越小,r越大,ft越大,其作用是提供上肢沿期望位置轨迹而运动的推进力,其中,行程比率r定义为为当前期望位置到末位置的距离与初始位置到末位置的距离的比值:
进一步地,引入法向力比例系数a1和切向力比例系数a2,基于指数函数来建立包括法向力fn和切向力ft的辅助力函数:
在本实施例中,通过位置空间表示法及位置误差建立了直观的、可视化的合力场模型,设计合理的量化映射函数将位置误差转化为纠正误差的力分量和牵拉末端运动的力分量。
步骤S3、基于建立的合力场模型,进行合力场输出力控制,输出助力辅助外骨骼运动。
具体包括如下过程:
1)判断外骨骼末端当前位置p′i与建立的合力场模型的位置关系;当di>S时,进入2);当di≤S,进入3);
2)由于位置误差di>S,外骨骼末端当前位置在合力场外部,此时,助力的目的是将外骨骼末端拉回正确的运动轨迹;因此,输出的助力F=fn;
3)由于位置误差di≤S,外骨骼末端当前位置在合力场内部,此时,助力的目的是将外骨骼末端拉回正确的运动轨迹并牵拉末端沿着运动轨迹做运动;因此,输出的助力F=fn+ft。
本实施例还公开了一种面向运动辅助型外骨骼的合力场控制装置,如图4所示,包括位置误差计算模块、合力场模块和助力输出模块;
具体的,位置误差计算模块,用于计算外骨骼前位置和期望位置的位置误差;
误差计算模块的输入为外骨骼给定位置运动轨迹和当前位置;输出为当前位置和期望位置的位置误差di=Δpi=|pi-p′i|,式中,p′i为外骨骼末端位置为当前位置,pi为所述外骨骼给定位置运动轨迹上距离当前位置p′i最近的点。
合力场模块,与位置误差计算模块连接,用于建立可视化合力场模型,依据所述位置误差,产生纠正误差的力分量和牵拉所述外骨骼末端运动的力分量;
合力场模块输出的产生纠正误差的力分量为法向力fn,牵拉所述外骨骼末端运动的力分量为切向力ft;
本实施例采用的法向力fn和切向力ft表示为:
本实施例建立的法向力fn和切向力ft的表达式,将位置误差di转化为纠正误差的力分量fn和牵拉末端运动的力分量ft,建立了直观的、可视化的合力场模型,便于根据位置误差对外骨骼的运动进行控制。
助力输出模块,分别与所述位置误差计算模块和合力场模块连接,用于控制合力场的输出力,辅助外骨骼运动。
助力输出模块首先判断外骨骼末端当前位置p′i与建立的合力场模型的位置关系;
当位置误差di>S时,外骨骼末端当前位置在合力场外部,此时,助力的目的是将外骨骼末端拉回正确的运动轨迹;输出的助力F=fn;
当位置误差di≤S时,外骨骼末端当前位置在合力场内部,此时,助力的目的是将外骨骼末端拉回正确的运动轨迹并牵拉末端沿着运动轨迹做运动;输出的助力F=fn+ft。
综上所述,本发明实施例给出的面向运动辅助型外骨骼的合力场控制方法及装置,能够针对使用者的助力需求设置控制参数,当判断外骨骼末端位置在合力场外部,将外骨骼末端拉回正确的运动轨迹,当判断外骨骼末端位置在合力场内部,将外骨骼末端拉回正确的运动轨迹并牵拉末端沿着运动轨迹做运动,做到“按需辅助”。使用者对控制参数所含物理意义的理解度较高,控制方法直观易于参数调试,可应用于康复外骨骼、助力增强型外骨骼等***,具有算法简单、安全性高等优点。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
Claims (6)
1.一种面向运动辅助型外骨骼的合力场控制方法,其特征在于,包括如下步骤:
根据获取的外骨骼给定位置运动轨迹和当前位置,计算当前位置和期望位置的位置误差;
建立可视化合力场模型,依据所述位置误差,利用合力场模型产生纠正位置误差的力分量和牵拉所述外骨骼末端运动的力分量;
进行合力场输出力控制,输出助力辅助外骨骼运动;
所述可视化合力场模型为沿着所述给定位置运动轨迹的截面为圆形的管体空间;所述合力场模型输出力包括法向力fn和切向力ft;
2.根据权利要求1所述的合力场控制方法,其特征在于,所述当前位置和期望位置的位置误差di=Δpi=|pi-p′i|,式中,当前位置p′i为外骨骼末端位置,期望位置pi为所述外骨骼给定位置运动轨迹上距离当前位置p′i最近点的位置。
3.根据权利要求1所述的合力场控制方法,其特征在于,所述进行合力场输出力控制包括:判断外骨骼末端当前位置p′i与建立的合力场模型的位置关系;当位置误差di>S时,输出助力F=fn;当位置误差di≤S,输出助力F=fn+ft。
4.一种面向运动辅助型外骨骼的合力场控制装置,其特征在于,包括位置误差计算模块、合力场模块和助力输出模块;
所述位置误差计算模块,用于计算外骨骼当前位置和期望位置的位置误差;根据获取的外骨骼给定位置运动轨迹和当前位置,计算当前位置和期望位置的位置误差;
合力场模块,与所述位置误差计算模块连接,用于建立可视化合力场模型,依据所述位置误差,产生纠正误差的力分量和牵拉所述外骨骼末端运动的力分量;所述可视化合力场模型为沿着所述给定位置运动轨迹的截面为圆形的管体空间;
助力输出模块,分别与所述位置误差计算模块和合力场模块连接,用于控制合力场的输出力,辅助外骨骼运动;
5.根据权利要求4所述的合力场控制装置,其特征在于,
所述位置误差计算模块的输入为外骨骼给定位置运动轨迹和当前位置;输出为当前位置和期望位置的位置误差di=Δpi=|pi-p′i|,式中,p′i为外骨骼末端位置为当前位置,pi为所述外骨骼给定位置运动轨迹上距离当前位置p′i最近的点。
6.根据权利要求4所述的合力场控制装置,其特征在于,所述助力输出模块,首先判断外骨骼末端当前位置p′i与建立的合力场模型的位置关系;当位置误差di>S时,输出力F=fn;当位置误差di≤S,输出力F=fn+ft。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811191853.2A CN109262613B (zh) | 2018-10-12 | 2018-10-12 | 一种应用于运动辅助型外骨骼的合力场控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811191853.2A CN109262613B (zh) | 2018-10-12 | 2018-10-12 | 一种应用于运动辅助型外骨骼的合力场控制方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109262613A CN109262613A (zh) | 2019-01-25 |
CN109262613B true CN109262613B (zh) | 2021-02-09 |
Family
ID=65196595
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811191853.2A Active CN109262613B (zh) | 2018-10-12 | 2018-10-12 | 一种应用于运动辅助型外骨骼的合力场控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109262613B (zh) |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5624398A (en) * | 1996-02-08 | 1997-04-29 | Symbiosis Corporation | Endoscopic robotic surgical tools and methods |
JP2006192564A (ja) * | 2004-12-16 | 2006-07-27 | Toyota Motor Corp | 作業補助装置と作業補助方法 |
CN105108761B (zh) * | 2015-08-14 | 2017-05-24 | 浙江大学 | 降阶的单关节助力外骨骼自适应鲁棒级联力控制的方法 |
-
2018
- 2018-10-12 CN CN201811191853.2A patent/CN109262613B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109262613A (zh) | 2019-01-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10994416B2 (en) | Method for controlling a limb motion intention understanding and upper limb rehabilitation training robot based on force sense information and posture information | |
CN105963100B (zh) | 按患者运动所需辅助的下肢康复机器人自适应控制方法 | |
CN107053179B (zh) | 一种基于模糊强化学习的机械臂柔顺力控制方法 | |
CN111773027B (zh) | 一种柔性驱动的手功能康复机器人控制***及控制方法 | |
CN112263440B (zh) | 一种柔性下肢外骨骼与助行器共融康复助力方法及装置 | |
US20240017407A1 (en) | Control method, apparatus, and system of a composite robot | |
CN108897220B (zh) | 一种自适应稳定平衡控制方法和***以及双足仿人机器人 | |
Wang et al. | Development of the control system of a voice-operated wheelchair with multi-posture characteristics | |
CN111660307A (zh) | 一种机器人操作高辅精度的虚拟夹具控制方法及*** | |
CN110834329B (zh) | 外骨骼控制方法及装置 | |
CN111515938B (zh) | 一种继承型迭代学习控制的下肢外骨骼行走轨迹跟踪方法 | |
Memarian et al. | Control of soft pneumatic finger-like actuators for affective motion generation | |
CN109262613B (zh) | 一种应用于运动辅助型外骨骼的合力场控制方法及装置 | |
US9132545B2 (en) | Apparatus for controlling mobile robot | |
CN114700951A (zh) | 一种用于医护机器人的柔顺控制方法 | |
CN111965979B (zh) | 基于外骨骼机器人作动器的有限时间控制方法 | |
CN110587613B (zh) | 一种负压气动柔性膝关节外骨骼实时反馈与闭环控制方法 | |
CN108789374B (zh) | 一种非拟人上肢助力装置及其控制方法 | |
CN111310641A (zh) | 一种基于球面非线性插值的运动合成方法 | |
CN112077841B (zh) | 一种提升机器人手臂操纵精度的多关节联动方法及*** | |
CN108717267B (zh) | 一种六足机器人中枢模式逆向控制方法 | |
CN117654000B (zh) | 一种机器人主被动康复训练控制方法、***、设备及介质 | |
CN110647035B (zh) | 一种膝关节外骨骼角度的无模型自适应反演控制方法 | |
YANG et al. | Development of a Wheelchair-Based Upper-Limb Assistance Device Controlled by a Predictive Motion Recognition System | |
Liu et al. | An ANN based approach for gait prediction of a lower-limb exoskeleton with plantar pressure sensors |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |