一种应用于运动辅助型外骨骼的合力场控制方法及装置与流程

本发明涉及外骨骼技术领域，尤其是一种应用于运动辅助型外骨骼的合力场控制方法及装置。

背景技术：

外骨骼机器人是一种可穿戴式的助力装备(提供力学辅助)。

目前，国内外的各类外骨骼机器人既有应用基于运动学/动力学传感信息的控制算法，例如广泛应用于机器人系统的pid控制、计算力矩控制、导纳控制和阻抗控制等方法，并根据系统具体特点做部分改进，融合例如神经网络控制、模糊控制等；还有一部分外骨骼机器人采用基于生物电信息的控制算法，但目前生物电信息更多地用于定性地应用于触发式控制，而生物电信息解码由于准确度不高，其用于过程控制并不可靠。因此，外骨骼主流做法还是基于运动学/动力学信号反馈的控制方法，核心的理念依然是实现基于人机友好交互地动力学控制策略。

从外骨骼的应用角度讲，外骨骼控制算法的设计不是着眼于高精度的轨迹运动控制而是强调人机动力交互性能，使外骨骼能够稳定地按需辅助肢体的运动。从这个角度来讲，常用的机器人控制方法用于运动辅助型外骨骼并不完全切合其控制目标。

技术实现要素：

鉴于上述的分析，本发明旨在提供一种应用于运动辅助型外骨骼的合力场控制方法及装置，对外骨骼的运动辅助力进行规划，使外骨骼辅助人实现运动，同时提高外骨骼控制算法的响应速度。

本发明的目的主要是通过以下技术方案实现的：

一种面向运动辅助型外骨骼的合力场控制方法，包括如下步骤：

根据获取的外骨骼给定位置运动轨迹和当前位置，计算当前位置和期望位置的位置误差；

建立可视化合力场模型，依据所述位置误差，利用合力场模型产生纠正位置误差的力分量和牵拉所述外骨骼末端运动的力分量；

进行合力场输出力控制，输出助力辅助外骨骼运动。

进一步地，所述当前位置和期望位置的位置误差di＝δpi＝|pi-p′i|，式中，当前位置p′i为外骨骼末端位置，期望位置pi为所述外骨骼给定位置运动轨迹上距离当前位置p′i最近点的位置。

进一步地，所述建立的可视化合力场模型为沿着所述给定位置运动轨迹的截面为圆形的管体空间。

进一步地，所述合力场模型输出力包括法向力fn和切向力ft；

所述法向力fn为纠正位置误差的力分量，方向沿轨迹线的法向方向用于纠正外骨骼的位置运动误差，控制外骨骼的位置运动不偏离期望轨迹；

所述切向力ft为牵拉所述外骨骼末端运动的力分量，方向沿轨迹线的切向方向用于牵拉所述外骨骼末端运动，使外骨骼沿期望位置轨迹而运动。

进一步地，所述法向力fn和切向力ft表示为

式中a1为法向力比例系数、a2为切向力比例系数；s为合力场模型圆形截面的半径；di为当前位置和期望位置的位置误差；为当前期望位置pi到末位置pn距离与初始位置p0到末位置pn距离的比值。

进一步地，所述进行合力场输出力控制包括：判断外骨骼末端当前位置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表示为：式中a1为法向力比例系数、a2为切向力比例系数；s为合力场模型圆形截面的半径；di为当前位置和期望位置的位置误差；为当前期望位置pi到末位置pn距离与初始位置p0到末位置pn距离的比值。

进一步地，所述助力输出模块，首先判断外骨骼末端当前位置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，

法向力fn——纠正位置误差的力分量，方向沿轨迹线的法向方向大小为位置误差di的函数，di越大，fn越大，其作用是让上肢位置运动不偏离期望轨迹；

切向力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表示为：

式中a1为法向力比例系数、a2为切向力比例系数；s为合力场模型圆形截面的半径；di为当前位置和期望位置的位置误差；为当前期望位置pi到末位置pn的距离与初始位置位移p0的比值。

本实施例建立的法向力fn和切向力ft的表达式，将位置误差di转化为纠正误差的力分量fn和牵拉末端运动的力分量ft，建立了直观的、可视化的合力场模型，便于根据位置误差对外骨骼的运动进行控制。

助力输出模块，分别与所述位置误差计算模块和合力场模块连接，用于控制合力场的输出力，辅助外骨骼运动。

助力输出模块首先判断外骨骼末端当前位置p′i与建立的合力场模型的位置关系；

当位置误差di＞s时，外骨骼末端当前位置在合力场外部，此时，助力的目的是将外骨骼末端拉回正确的运动轨迹；输出的助力f＝fn；

当位置误差di≤s时，外骨骼末端当前位置在合力场内部，此时，助力的目的是将外骨骼末端拉回正确的运动轨迹并牵拉末端沿着运动轨迹做运动；输出的助力f＝fn+ft。

综上所述，本发明实施例给出的面向运动辅助型外骨骼的合力场控制方法及装置，能够针对使用者的助力需求设置控制参数，当判断外骨骼末端位置在合力场外部，将外骨骼末端拉回正确的运动轨迹，当判断外骨骼末端位置在合力场内部，将外骨骼末端拉回正确的运动轨迹并牵拉末端沿着运动轨迹做运动，做到“按需辅助”。使用者对控制参数所含物理意义的理解度较高，控制方法直观易于参数调试，可应用于康复外骨骼、助力增强型外骨骼等系统，具有算法简单、安全性高等优点。

以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。