上肢康复训练轨迹定制优化及柔顺跟踪控制

卒中后早期的被动康复训练可以促进患者脑神经重塑甚至重获肢体运动能力。针对多数上肢康复机器人将参数化规则曲线作为被动训练的轨迹,没能融合康复医师的经验及患者的个体特征,或者缺乏三维个性轨迹的光滑优化以及训练过程中的安全柔顺交互的问题。本文基于新型末端牵引式3自由度上肢康复机器人开展轨迹个性化定制优化以及跟踪控制研究。首先,在笛卡尔空间应用导纳算法及力补偿策略实现理疗师对轨迹的定制。然后,用道格拉斯-普克法压缩原始轨迹数据得到型值点,保留初始轨迹的拓扑形状。用非均匀有理B样条曲线(NURBS)进行插值,并融合动态切换概率和t变异改进蝴蝶优化算法(BOA)优化拟合的轨迹。最后,设计基于RBF网络的滑模自适应以及速度前馈加PID的控制策略实现末端轨迹跟踪,并增加导纳-阻抗控制形成基于力阈值的多模式柔顺跟踪控制,保证较大人机交互力时的安全。结果表明定制机器人末端轨迹的拖动力在5N以内;改进的BOA算法具有更高的收敛速度和精度,优化的轨迹曲率和更小;轨迹跟踪控制策略可以将跟踪误差控制在6mm内;模式切换在0.3s内响应并顺应较大交互力而提高训练的安全性。