上肢康复训练轨迹定制优化及柔顺跟踪控制_李辽远.pdf

智能交叉科学与工程DOI:10.15961/j.jsuese.202201013上肢康复训练轨迹定制优化及柔顺跟踪控制李辽远1,2，韩建海1,2,3*，李向攀1,2，郭冰菁1,2，杜敢琴4(1.河南科技大学 机电工程学院，洛阳 河南 471003；2.机器人及智能系统河南省重点实验室，洛阳 河南 471003；3.机械装备先进制造河南省协同创新中心，洛阳 河南 471003；4.河南科技大学 第一附属医院神经内科，洛阳 河南 471003)摘要：卒中后早期的被动康复训练可以促进患者脑神经重塑甚至重获肢体运动能力。多数上肢康复机器人中，只将参数化规则曲线作为被动训练的轨迹，没能融合康复医师的经验及患者的个体特征，缺乏3维个性轨迹的光滑优化；此外，训练过程中的安全柔顺交互的问题未得到解决。针对以上问题，本文基于新型末端牵引式3自由度上肢康复机器人开展轨迹个性化定制优化以及跟踪控制研究。首先，在笛卡尔空间应用导纳算法及力补偿策略实现理疗师对轨迹的定制。然后，用道格拉斯普克法压缩原始轨迹数据得到型值点，保留初始轨迹的拓扑形状。接下来，用非均匀有理B样条曲线（non-uniform rational bspline，NURBS）进行插值，并融合动态切换概率和t变异改进蝴蝶优化算法（butterfly optimization algorithm，BOA）优化拟合的轨迹。最后，设计基于径向基（radial basisfunction，RBF）神经网络的滑模自适应以及速度前馈加比例积分微分（proportionalintegralderivative，PID）的控制策略实现末端轨迹跟踪，并增加导纳阻抗控制形成基于力阈值的多模式柔顺跟踪控制，保证人机交互力较大时患者的安全。结果表明：定制机器人末端轨迹的拖动力在5 N以内；改进的BOA算法具有更高的收敛速度和精度，优化的轨迹曲率和更小；轨迹跟踪控制策略可以将跟踪误差控制在6 mm内；模式切换在0.3 s内响应，能顺应较大交互力，从而提高训练的安全性。关键词：上肢康复；蝴蝶优化算法；轨迹定制；轨迹优化；轨迹跟踪控制中图分类号：TP242文献标志码：A文章编号：2096-3246（2023）02-0194-10Customization and Optimization of the Upper Limb Rehabilitation Trajectory andCompliance Tracking ControlLI Liaoyuan1,2，HAN Jianhai1,2,3*，LI Xiangpan1,2，GUO Bingjing1,2，DU Ganqin4(1.School of Mechatronics Eng.,Henan Univ.of Sci.and Technol.,Luoyang 471003;2.Henan Provincial Key Lab.of Robotics and Intelligent Systems,Luoyang 471003;3.Collaborative Innovation Center of Machinery Equipment Advanced Manufacturing of Henan Province,Luoyang 471003;4.The First Affiliated Hospital of Henan Univ.of Sci.and Technol.,Luoyang 471003)Abstract:Early passive rehabilitation training after stroke can promote brain nerve remodeling and even regain motor ability.Most upper limb re-habilitation robots use parameterized regular curves as passive training trajectories,which fail to integrate the experience of rehabilitation doctorsand the individual characteristics of patients,or lack smooth optimization of three-dimensional customized trajectories and safe interaction duringtraining.Therefore,this research studied the trajectory customization,optimization and tracking control strategy based on the novel end-effector 3degrees of freedom(DOFs)upper limb rehabilitation robot.Firstly,the admittance algorithm and force compensation strategy were applied inCartesian space to realize the customization of the trajectory by the physiotherapist.Then,the original trajectory data were compressed byDouglas-Peucher method to obtain a few via points.The non-uniform rational B-spline curve(NURBS)was used for interpolation,and an im-收稿日期:2022 09 18基金项目:河南省科技攻关项目（212102310890）；河南省科技攻关项目（212102310249）作者简介:李辽远（1989），男，博士生.研究方向：先进康复机器人技术及应用.E-mail：lly_*通信作者:韩建海，教授，E-mail：网络出版时间:2023 03 06 16:08:38 网络出版地址:https:/ http:/http:/ 第 55 卷 第 2 期工 程 科 学 与 技 术Vol.55 No.22023 年 3 月ADVANCED ENGINEERING SCIENCESMar.2023proved butterfly optimization algorithm(BOA)based on dynamic switching probability and t mutation was used to minimize the trajectorycurvature.Finally,the sliding mode adaptive control based on the radial basis function(RBF)network and the speed feedforward plus PID con-trol strategy were designed to control the trajectory tracking.In addition,the admittance-impedance control was added,forming a multi-modetracking controller,to make the training safe with the large human-robot interaction force.The results showed that the dragging force of trajectorycustomization is within 5N.The improved BOA algorithm has higher convergence speed and accuracy,and the curvature of the optimized traject-ory is smaller.The control strategy can resist the interference within the threshold and keep the tracking error within 6mm.The mode can switchin 0.3s,to compliant to large interaction force and improve the safety of training.Key words:rehabilitation of upper limbs;butterfly optimization algorithm;trajectory customization;trajectory optimization;trajectory trackingcontrol 随着全球老龄化及神经损伤造成的肢体运动功能障碍患者人数的逐步上升，如何满足庞大的康复需求、提高患者生活质量是亟需解决的关键问题。临床结果表明，在卒中后早期，被动康复训练能够促进神经重塑，帮助患肢肌肉重获自主收缩的能力1。相较于传统的手动康复方式，机器人辅助康复技术具有的重复精度高、定量化评估准确等优点，已经促使其成为世界范围内的研究热点2。传统康复理疗师拖拽病人的患肢进行康复训练的方式结合了理疗师的实践经验并可以实时交互，可以给患者更好的训练效果。而目前大多数康复机器人的训练轨迹是一些提前定义好的规则曲线，在训练范围上有一定的限制。另外，由于不能适应较大的突发人机交互力，在跟踪轨迹康复训练过程中存在危险或者训练直接中断过程的情况。日常上肢的活动通常是在参数多变的非结构环境中，所以有必要研究能自由定制被动康复训练轨迹且可以柔顺交互的上肢康复机器人。目前，Morita等3使用基于位置的阻抗控制策略实现机器人末端轨迹定制，使用最小二乘法拟合原始的噪声数据来近似康复医师的意图，并用拟合后的轨迹作为被动训练的期望轨迹。游有鹏等4基于自行研制的直流电动机设计力矩控制及机器人连杆重量和关节摩擦力自测量补偿算法，实现无力传感器的轻松拖动。杨浩等5先在笛卡尔空间应用导纳算法，求得笛卡尔空间期望位置后再用逆解求关节位置来拖动下肢康复机器人，并未对个性化轨迹进行优化和跟踪控制。但是，康复轨迹的构建过程中，医生和病人的手同时与机器人的末端耦合，会因为病人、医生抖动或者环境噪声等原因，构建出不平滑的轨迹。Zeestraten等6基于统计模型进行轨迹学习和规划，但是计算效率较低，且生成的轨迹不连续。对轨迹进行光滑优化可以采用具有规范性和连续可微性等重要性质的B样条曲线7。Wan等8利用改进B样条曲线规划机器人的避障轨迹。董甲甲等9没有直接对笛卡尔空间的3维轨迹的优化，而是改进B样条的求解过程，用于6R机器人的关节轨迹拟合优化。天津大学的Mei等10将关节最小急动度和B样条曲线相结合，对6自由度高速并联机器人的末端轨迹进行了优化，重点是降低关节的急动度，拟合轨迹相对于原始轨迹有较大的变形。Ijspeert等11利用动态运动基元的方法来拟合期望轨迹，当目标点改变后能够快速的拟合出新的轨迹，泛化能力强。但是轨迹逼近的算法复杂，理解困难且需要确定的参数较多。另外，以上研究并没有对插值拟合的轨迹进一步光滑优化。轨迹跟踪控制的方法研究也较多。吴青聪等12结合外骨骼上肢康复机器人设计模糊滑模控制器实现被动训练的位置跟踪，理疗师可以根据患者状况手动调整外环导纳参数，使得人机交互力参与到机器人末端位置的控制中。Mushage等13设计模糊神经网络和基于状态观测的误差自适应非线性控制器对5自由度上肢外骨骼的轨迹跟踪进行控制。罗定吉等14采用模糊比例积分微分（proportionalintegralde-rivative，PID）控制算法对下肢外骨骼进行轨迹跟踪控制。Shi等15将径向基（radial basis function，RBF）神经网络和PID结合起来进行下肢外骨骼机器人运动的轨迹跟踪控制。现有多数研究都以提高轨迹跟踪精度为目标，而康复训练中应以保证安全为前提，再提高轨迹跟踪精度。Zhang等16设计变刚度执行器和力矩限制机构用于上肢康复外骨骼来保证训练中的安全性。Wu等17设计基于RBF神经网络的干扰观测器来补偿外界干扰和误差来提高轨迹跟踪精度，同时用自适应变导纳控制策略使机器人具有柔顺性来适应不同状态的患者。Trigili等18利用串联弹性关节元件来实现康复机器人的柔顺性。Miao等19在双边末端牵引式上肢康复机器人上设计位置控制用于被动训练，并基于个性化工作空间设计自适应变参数控制实现柔顺性。Guo等20利用强化学习算法设计变导纳控制算法实现匹配患者下肢刚度特性的康复训练，也具有一定的柔顺性。李超等21基于患者病情设计模糊自适应的粒子群位置阻抗控制算法用于下肢的康复训练；粒子群算法优化导纳参数提高位置跟踪精度，模糊自适应算法实现一定的柔顺性。以上研究中，特殊柔性元件结构及建模较复杂而且动力学特性会存在误差。其他的柔顺控制算法虽然可以在第 2 期李辽远，等：上肢康复训练轨迹定制优化及柔顺跟踪控制195线修改参数，但是算法略显复杂。卒中病人在早期运动能力是比较弱的甚至没有，经过一段时间的训练恢复后会进入主动训练阶段才需要参数的在线实时修改。针对以上问题，作者基于自行研制的3自由度末端牵引式上肢康复机器人，在3维空间内个性化定制训练轨迹，并对其进行光滑优化。设计多模式控制器使机器人末端既能跟踪个性化训练轨迹，又能顺应较大干扰，且参数设置简单。当干扰降低后能够继续跟踪期望轨迹，保证训练的安全性和连续性，匹配应用需求。1 平台及方法 1.1 上肢康复机器人系统本研究中使用的上肢康复机器人是自行研制的末端牵引式空间3自由度上肢康复机器人，主要是针对上肢肩关节和肘关节的康复训练，包括两个水平转动关节和1个垂直移动关节，结构简图如图1所示。其中Z1、Z2、Z3代表3个关节的轴线，q1、q2、q3为3个关节的位置变量。两个转动关节由两个配置绝对编码器的交流伺服电机驱动，垂直移动关节由双作用气缸驱动。在气缸末端安装拉线式位移传感器，在气缸和小臂的连接处安装3维力传感器。康复机器人的试验平台如图2所示。本系统的控制系统包括上位机（基于MATLAB软件进行系统程序的设计和编译）和下位机（执行编译后的控制程序）。将电机的驱动方式设置为力矩模式，通过控制输入电压设定电机输出力矩，通过脉冲闭环反馈控制其转动位置。而气缸通过比例调压阀控制气缸输出力，利用末端位移反馈控制其位置。因为机器人整体高度的限制，气缸的总行程为150 mm，可实现上肢关节在矢状面内一定范围的训练。1.2 轨迹定制FpFf理疗师慢速拖动机器人时，忽略机器人的惯性力，需要克服患者加在末端的力以及机器人的关节静摩擦力，如式（1）所示：Ft Fp+Ff（1）FtFp=0式中，代表理疗师施加在末端的力。对于几乎完全丧失上肢运动能力的软瘫期病人，假设。Finth检测并补偿转动关节的静摩擦力后，利用机器人静力学原理将交互力转换为关节空间的力矩，如式（2）所示：h=JTFint（2）式中，J J为机器人的雅克比矩阵。然后，在关节空间中应用导纳算法产生期望关节位置输入，如式（3）所示：q=kh（3）q式中，k k表示导纳系数矩阵，表示关节位置增量向量。由位置增量和实际的关节位置变量q q可以得到所期望的关节位置变量q qd，将其输入到电机驱动系统后由内部算法得到关节的驱动力矩，从而实现转动关节拖动。FpzFpzP对于气缸驱动的移动关节，末端初始的垂直负载和理疗师施加的垂直力（大小为）可由末端的力传感器检测。根据理疗师施加的力大小，由式（4）计算得到气缸无杆腔的压力改变量。气缸位移随无杆腔气体压力的改变而改变，实现移动关节的轻松拖动。由3个关节的位置传感器记录的位置点得到初始的定制轨迹。Fpz=PA1（4）A1式中，为气缸无杆腔的有效面积。1.3 NURBS插值曲线优化对初始轨迹点应用数据压缩算法22得到有限个型值点，其坐标用P Pi表示，i=1,2,n。选择可以如实 第 2 关节电机谐波减速器带轮第 1 关节电机同步带小臂3 维力传感器气缸大臂Z1q1Z2q2q3Z3图 1机器人结构简图Fig.1Structure diagram of the robot 伺服电机位移传感器下位机比例调压阀图 2康复机器人试验平台Fig.2Platform of the rehabilitation robot system 196工程科学与技术第 55 卷U U=u0,u1,un+k+1反映型值点按弦长分布情况且拟合精度高的积累弦长参数化法23对型值点进行参数化处理得到节点矢量，。积累弦长参数化法表示如式（5）所示：|u0=u1=u2=u3=0,ui+3=ui+2+|Pi Pi1|/ni=1|Pi Pi1|,un+3=un+4=un+5=un+6=1（5）kNi,k(u)再按 De Boor算法24计算 次规范B样条基函数，如式（6）所示：|Ni,0(u)=1，ui u ui+1;0，其他Ni,k(u)=uuiui+kuiNi,k1(u)+ui+k+1uui+k+1ui+1Ni+1,k1(u);（6）00=0kp(u)式中，定义。将式（6）得到的基函数带入 次NURBS曲线公式中得到插值后的曲线，如式（7）所示：p(u)=ni=0idiNi,k(u)ni=0iNi,k(u)（7）widi式中，为权因子，为控制顶点的值。Pip(u)数据压缩过程设定的阈值不同，得到的关键型值点也不同，曲线的形状和光顺性也不同。采用智能优化算法，以曲线光顺性为目标，以压缩阈值为变量优化插值曲线，生成连续光顺的插值曲线作为训练轨迹。目标函数为：Obj=lj=0c(j)（8）c(j)式中，l为插值曲线离散点的总个数，为曲线在点j处的曲率，其公式为：c=|p(u)p(u)|p(u)|3（9）插值曲线点要限制在机器人末端的安全工作空间内。根据机器人的逆运动学模型，由笛卡尔空间的坐标点可以得到3个关节的位置变量q q。则优化约束条件表示为：qmin q qmax（10）qminqmax式中，和分别表示机器人3个关节的最小限位和最大限位。气缸的行程比较小，在拖动的时候很容易就会到达的极限位置且不会产生任何危险，所以将第3关节超出极限位置的数据点修改为极限位置点。所用的蝴蝶优化算法25为一种新型的元启发式群智能优化算法，该算法在工程实践的初步应用中取得了良好的效果。该算法的搜索行为依据为香味大小f，如式（11）所示。f=cI（11）Icf式中：为刺激强度，与蝴蝶的适应度有关；为感官因子，通常取值为0.01；为依赖于 的幂指数，通常取值为0.1。标准蝴蝶算法的位置更新公式如下：xt+1s=xts+fs(r21gxts)，r3 Pstatic;xts+fs(r22xtjxtk),r3 Pstatic（12）xtsxtjxtkr1r2r3fsPstaticr3式中：为第s只蝴蝶在第t次迭代中的位置坐标；、为从解空间中随机选择的第k只和第j只蝴蝶的位置坐标；，和 为0,1内的随机数；是由式（11）得到的第s只蝴蝶的香味大小；g*表示第t次迭代后的全局最优解；表示静态切换概率。算法处于局部搜索，还是全局搜索阶段依据随机数 是否小于Pstatic的条件（Pstatic=0.8）。Pd有许多对BOA算法的改进方法2627，其设计的主要思想是：迭代前期种群个体应该侧重全局寻优，在解空间内进行大范围搜索；后期侧重局部寻优，使算法快速收敛。本文中融合了矢量数据压缩算法和BOA算法，将高维的插值点优化问题转化为1维的压缩阈值优化问题，简化了优化算法的求解过程。所以，仅对标准BOA算法做部分改进而不融合其他优化算法，其中，动态切换概率表达式为：Pd=(Tmaxn1Tmax)3（13）Tmax式中，表示最大迭代次数，n1表示当前的迭代次数。ri2，i=1,2采用t变异是为了防止陷入局部最优，提高优化收敛速度。具体是指在每一代的迭代过程中用t分布的概率密度函数代替随机数。将标准t分布的概率密度函数与优化算法的迭代次数进行关联，概率密度函数f(t)表示为：f(t)=2.5(n2+12)n(n2)(1+(2t/Tmax)2n)n2+12（14）()式中，n2表示t分布的自由度；是Gamma函数，其定义表示为：(x)=0ettx1dt（15）第 2 期李辽远，等：上肢康复训练轨迹定制优化及柔顺跟踪控制197改进后的BOA算法中个体的位置更新公式为：xt+1s=xts+fs(f(t)gxts)，r3 Pd;xts+fs(f(t)xtjxtk),r3 Pd（16）1.4 轨迹跟踪控制算法根据Brunstorm的卒中后康复6阶段理论28，在卒中后早期的软瘫期，病人需要接受被动康复训练。其作用是通过患者的活动引起患者大脑的某些区域的兴奋，从而对当前的患肢活动产生意识。为了实现康复医师规划的训练动作，被动康复训练在保证安全性的前提下以良好的伺服跟踪性能为主要目标。得到优化的插值曲线之后，将曲线点作为被动康复训练的期望位置，设计轨迹跟踪控制器来保证机器人良好的轨迹跟踪能力。1.4.1 跟踪控制器设计m个关节机器人的动力学方程为：M(q)q+C(q,q)q+G(q)+F(q)+d=（17）q q qM(q)C(q,q)G(q)F(q)dd Dqd qd qd式中，、分别表示机器人关节的实际位置、速度和加速度；为mm阶正定惯性矩阵；为mm阶科氏矩阵；为m1阶重力项向量；为摩擦力矩阵；为未知外加干扰，且满足，其中D D表示未知干扰的上界；为控制输入。用、分别表示期望的关节位置、速度和加速度。定义关节位置跟踪误差e e为：e=qdq（18）定义滑模面为r r，表示为：r=e+e（19）=T 0式中，为对角矩阵，则 q=r+qd+e（20）由式（17）到（20）计算得到：M(q)r=C(q,q)r+N(x)+d（21）N(x)式中，为需要逼近的模型不确定项。采用RBF神经网络逼近未知的N N(x x)，网络算法为：N(x)WT(x)+（22）(x)NN式中，x x为网络的输入，为网络的高斯基函数输出，WW*为网络的理想权值且有界，为网络的逼近误差，是逼近误差的上界。取神经网络的输入x x为：x=eT eTqTd qTd qTd（23）设计控制输入 为：=N(x)+Kvrv（24）N(x)N(x)N(x)=WT(x)WKvKv Rnn式中：为RBF网络对动力学模型中不确定项的估计值，其中为网络连接权值的估计值；为对角正定矩阵，；v v为鲁棒项。令?W=WW，并定义权值矩阵的自适应律为：W=(x)rT（25）式中，是一个正常数。将式（24）带入到式（21）中，得：M(q)r=(Kv+C(q,q)r+1（26）1=?WT(x)+(+d)+v式中，。1.4.2 稳定性及收敛性分析为了证明所设计的控制策略的动态稳定性，定义Lyapunov函数V为：V=12rTM(q)r+12tr(?WT?W)（27）tr(?WT?W)?WT?WV式中，表示求矩阵的迹。计算V对时间的微分 可得：V=rTM(q)r+12rTM(q)r+1tr(?WT?W)（28）M(q)2C(q,q)=0v=(N+d)sgn(r)已知，将式（25）、（26）带入式（28）后，取鲁棒项v v为，得：V=rTKvr+tr(?WT)(x)rT1W)+rT(+d)rT(N+d)=rTKvr+rT(+d)rT(N+d)0根据LaSalle不变性原理，闭环系统渐进稳定。1.4.3 多模式控制策略设计FintFintFthFintFthetheth为保证安全，在上面控制器的基础上增加导纳阻抗控制形成多模式切换控制策略。控制模式切换逻辑如图3所示，其中，代表人机交互力，E E代表位置误差。在训练过程中，若超过设定阈值，切换为导纳控制使机器人跟随交互力顺应移动。当小于且E E大于设定阈值时，启用阻抗控制将末端拉回到期望轨迹上，当E E也小于时重新切换为基于RBF网络的滑模控制。开始RBF 控制否否否导纳控制回到期望轨迹是是是阻抗控制FintFthFintFthFintFth&Eeth图 3轨迹跟踪过程模式切换逻辑Fig.3Mode switching logic of trajectory tracking 198工程科学与技术第 55 卷q q q本文提出的多模式柔顺跟踪控制策略的原理图如图4所示。轨迹定制部分用绿色框表示，由此得到的初始轨迹数据（，）经过数据处理和插值优化qd qd qd（图4中橙色框表示部分）得到期望的轨迹数据（，），然后输入到所设计的控制策略（图4中蓝色框表示部分）中进行轨迹跟踪康复训练。图4中，k kp为阻抗系数。2 仿真与试验 2.1 轨迹定制拖动力试验根据第1.4节提出的轨迹定制算法进行机器人末端拖动力试验。X和Y方向的最大拖动力的结果如图5所示。图5中的力仅表示力的大小，可以看出改变水平面内位置的力在4 N以内。Z方向的初始负载补偿和拖动力试验结果如图6所示。由两条点画线划分成的3个区域（、）表示不同初始负载（分别约为3、5、8 N）的情况。可以看出3种情况下气缸都能保持在行程中的任意某个位置，且改变气缸位置的拖动力在5 N以内，即Z方向也可以轻松拖动。2.2 改进BOA算法试验标准BOA和本文改进的BOA迭代优化过程如图7所示。由图7可知，改进的BOA算法具有更快的优化速度和更高的收敛精度，经过100次的迭代得到最小曲率和为13.377 4，对应的最优矢量数据压缩阈值为14.817 3。选取压缩阈值为20生成的插值曲线作为和优化插值曲线的对比，如图8所示。其中，小方框标记为7个未优化压缩阈值得到的型值点，小圆圈为9个优化压缩阈值得到的型值点。两条曲线产生的曲率的对比数据汇总于表1中，可以看出，优化曲线的曲率 N(x)Fintq,q去噪RBF 网络N(x)=WT(x)qd,qd,qd滑模面r=e+e.权值更新W=(x)rT?Kv鲁棒项v=(N+d)sgn(r)Fint注：当 FintFth 且 Eeth 时选择1，否则切换为 2示教轨迹跟踪训练NURBS插值拟合矢量数据压缩BOA 优化算法导纳算法q=kFintJT阻抗算法=kpqq+PID驱动器hJT+速度前馈气缸21Switchkq+qd+Ff控制输入.q,q,q.=N(x)+Kvrvq,图 4多模式控制原理图Fig.4Schematic diagram of multi-mode control strategy 051015202530354045t/s1000100200300400500X,Y 方向位移/mm012345拖动力 F/NX 方向位移Y 方向位移拖动力 F图 5X和Y方向上的拖动力Fig.5Dragging force of X and Y direction 01020304050607080t/s020406080100120140160Z 方向位移/mmFz/N202468101214Z 方向位移Z 方向力图 6垂直负载补偿和拖动力Fig.6Load compensation and dragging force of Z direc-tion 第 2 期李辽远，等：上肢康复训练轨迹定制优化及柔顺跟踪控制199和更小为13.377 4，曲率的变化范围更小，标准差为0.224 2。2.3 自由状态跟踪实验机器人的第3关节垂直于前两个转动关节，存在结构解耦关系，可以分开对其进行控制。对气缸的位置控制采用PID加速度前馈控制。自由状态轨迹跟踪实验中，1位健康志愿者模拟卒中初期患者，训练过程中不主动施加力。空间轨迹和水平面内的轨迹的跟踪结果如图9、10所示。由图9、10可以看出，实际轨迹可以较好的跟踪末端期望轨迹。在X、Y、Z 3个方向上的具体的跟踪误差如图11所示，由图11可以看出3个方向的误差都在6 mm内，由此可知，机器人的末端具有较好的轨迹跟踪能力。2.4 控制模式切换实验因为移动关节由气缸驱动，总行程并不大且气压驱动具有柔顺性。为了简化控制程序而仅考虑X和Y方向上有较大交互力的时候的顺应性。Fth为10 N本实验中，由1位健康的志愿者来模拟被动训练过程中突发较大人机交互力的情景。设置模式切换的交互力阈值，水平面内往返1个周期的柔顺跟踪结果如图12所示。X和Y方向的位置跟踪情况分别如图13、14所示。表 1插值曲线的曲率数据对比Tab.1 Comparison of The Curvature Data for Interpola-tion Curves 曲线类型最小曲率最大曲率标准差曲率总和对比曲线1.487 910517.855 60.588 233.658 5优化曲线2.398 51056.802 80.224 213.377 4 020406080100迭代次数13.213.413.613.814.014.214.4最小曲率和标准 BOA 算法优化 BOA 算法图 7BOA算法的迭代优化过程Fig.7Iterative optimization process of the BOA algorithm 4004003002002002000050100150100Y 方向位移/mmX 方向位移/mmZ 方向位移/mm原始曲线对比型值点对比曲线优化型值点优化曲线图 8任意空间轨迹的NURBS插值曲线对比Fig.8Comparison of NURBS interpolation curves for ar-bitrary spatial trajectory 4004003002002002000050100150100X 方向位移/mmY 方向位移/mmZ 方向位移/mm期望轨迹实际轨迹图 9末端自由状态下轨迹跟踪Fig.9Trajectory tracking under the free state of the end 2001000100200300400Y 方向位移/mm100150200250300350400X 方向位移/mm期望轨迹实际轨迹图 10末端水平面轨迹跟踪Fig.10Trajectory tracking in the horizontal plane 0246810t/s6420246误差 e/mmX 方向误差Y 方向误差Z 方向误差图 11末端自由状态轨迹跟踪误差Fig.11Trajectory tracking error under the free state of the end 200工程科学与技术第 55 卷以图13中标注的位置点为例：在 X方向上，当t1=30.77 s时，FX超过了阈值，机器人快速顺应交互力而偏离期望轨迹；t2=31.47 s时，FX小于阈值，机器人也能在0.20 s（t2t3=0.16 s）内响应条件的改变而开始回归到期望轨迹上。图14中，在Y方向上，t2=20.53 s时，切换为导纳控制顺应交互力，交互力小于阈值时能在0.30 s（t3 t2=0.28 s）内响应条件的改变。最终机器人末端的实际位置都能回到期望轨迹上，继续完成被动康复训练。3 结论本文基于自行研制的末端牵引式3自由度上肢康复机器人进行末端拖动轨迹插值优化和轨迹柔顺跟踪控制研究，主要工作如下：1）利用机器人末端安装的3维力传感器和关节伺服电机对初始负载和关节的静摩擦力补偿，基于静力学原理将末端力转换到关节空间，再采用导纳算法实现机器人拖动的方法避免了建立机器人的逆解模型。实现康复训练轨迹的轻松拖动定制。2）采用矢量数据压缩算法保留了原始轨迹的最远点并保持轨迹的拓扑形状，不会降低上肢关节的运动范围。利用NURBS曲线插值和改进BOA算法优化插值曲线的曲率和，提升训练轨迹的平滑和光顺性。3）结合RBF网络的滑模控制算法和导纳算法形成模式切换的柔顺轨迹跟踪控制策略。保证小干扰下的良好轨迹跟踪训练和人机交互力较大时患者的安全。跟踪精度可满足康复训练的需求。模式切换的响应快速，切换的阈值可根据康复医师的经验或者其他评定手段提前确定，控制器的设计简单，便于实施应用。未来将研究人机交互力的识别和分离技术，实时补偿患者产生的作用力，减少康复医生的拖拽力，改善应用体验。此外，还将研究训练轨迹的能量最优规划及对于恢复了一定肌力的患者的按需辅助主动康复策略。参考文献：Gassert R,Dietz V.Rehabilitation robots for the treatment ofsensorimotor deficits:A neurophysiological perspectiveJ.Journal of Neuroengineering and Rehabilitation,2018,15(1):115.1 Lin D J,Finklestein S P,Cramer S C.New directions in treat-ments targeting stroke recoveryJ.Stroke,2018,49(12):31073114.2 Morita Y,Nagasaki M,Ukai H,et al.Development of rehabil-itation training support system of upper limb motor func-tion for personalized rehabilitationC/Proceedings of the2008 IEEE International Conference on Robotics and Bio-mimetics.Bangkok:IEEE,2009:300305.3 300 200 1000100200300400Y 方向位移/mm100150200250300350400X 方向位移/mm期望轨迹实际轨迹图 12切换模式下的水平面内轨迹跟踪对随机干扰的响应Fig.12Response of the trajectory tracking to the randominterference in the horizontal plane with switch-ing mode 0510152025303540t/s20151050510152025150200250300350400X 方向位移/mmFX,FY/NX 方向实际轨迹X 方向期望轨迹t1=30.77FX=10.12t3=31.31FX=9.89t2=31.47X=218.6t1=30.77X=343.3FXFY图 13切换模式下的X方向位置对随机干扰的响应Fig.13Response of the Xdirection position under switchmode to random interference 0510152025303540t/s201510505101520251002003000100200300400Y 方向位移/mmFX,FY/NY 方向实际轨迹Y 方向期望轨迹t1=21.53Y=108.6t3=22.33Y=264.8FXFYt1=21.53FY=10.2t2=22.05FY=9.453图 14切换模式下的Y方向位置对随机干扰的响应Fig.14Response of the Ydirection position under switchmode to random interference 第 2 期李辽远，等：上肢康复训练轨迹定制优化及柔顺跟踪控制201 You Youpeng,Zhang Yu,Li Chenggang.Force-free controlfor the direct teaching of robotsJ.Journal of MechanicalEngineering,2014,50(3):1017.游有鹏,张宇,李成刚.面向直接示教的机器人零力控制J.机械工程学报,2014,50(