基于线性二次型调节器与比例积分微分控制的步态轨迹跟踪研究与优化
Research and Optimization of Gait Trajectory Tracking Based on Linear Quadratic Regulator and Proportional-Integral-Derivative Control
摘要: 老龄化或疾病导致下肢功能障碍的患者逐渐增多，传统的康复方式存在一定局限性，因此下肢康复机器人成为当前康复技术主流领域。为了在下肢康复设备轨迹追踪性能良好的同时保证患者使用时的安全性，本文设计了一种将线性二次型调节器(LQR)与比例积分微分(PID)控制相结合的控制算法。首先利用运动捕捉设备采集正常步态轨迹，然后在已搭建的足底驱动式踏板步态训练设备中，对步进伺服控制系统采用位置环–速度环–电流环三闭环的PID控制。求得系统数学模型后，使用LQR算法优化PID控制器各环反馈系数，然后将控制器部署至装置中，并进行了实验验证。实验验证了控制器的可行性与有效性，提升了康复设备追踪步态轨迹的性能。
Abstract: The number of patients with lower limb dysfunction caused by aging or disease is gradually in-creasing. Traditional rehabilitation methods have limitations. Therefore, lower limb rehabilitation robots have become the mainstream field of current rehabilitation technology. In order to ensure the safety of patients while ensuring the good trajectory tracking performance of lower limb reha-bilitation equipment, a control algorithm combining linear-quadratic-regulator (LQR) and propor-tional-integral-differential (PID) control is designed in this paper. Firstly, the normal gait trajectory is collected by using the motion capture device. Then, in the established foot-driven pedal gait training equipment, the step servo control system adopts the three closed-loop PID controls of posi-tion loop, speed loop and current loop. After obtaining the mathematical model of the system, the LQR algorithm is used to optimize the feedback coefficients of each loop of the PID controller, and then the controller is deployed to the device, and the experimental verification is carried out. The experiment verifies the feasibility and effectiveness of the controller and improves the performance of the rehabilitation equipment to track the gait trajectory.
文章引用：汪航, 邹任玲, 王佳庆, 张书扬, 关晨露, 胡秀枋, 李丹, 尹学志. 基于线性二次型调节器与比例积分微分控制的步态轨迹跟踪研究与优化[J]. 建模与仿真, 2023, 12(5): 4577-4587. https://doi.org/10.12677/MOS.2023.125417

参考文献

[1] 陈意, 高强. 脑卒中运动功能障碍康复的研究进展[J]. 华西医学, 2022, 37(5): 757-764.
[2] 牛英, 宋美. 下肢康复机器人联合康复护理在膝关节前交叉韧带损伤重建术后康复中的应用效果分析[J]. 贵州医药, 2022, 46(11): 1822-1823.
[3] 吴伟铭, 孟巧玲, 倪伟, 喻洪流. 康复机器人系统数据通信技术应用现状[J]. 上海理工大学学报, 2023, 45(1): 36-43.
[4] Zhang, X., Yue, Z. and Wang, J. (2017) Robotics in Lower-Limb Rehabilitation after Stroke. Behavioural Neurology, 2017, Article ID: 3731802. [Google Scholar] [CrossRef] [PubMed]
[5] 李勇, 冀涛, 尚会超, 付晓莉. 下肢康复训练机器人的控制系统设计[J]. 机械设计与制造, 2022(7): 250-255.
[6] 吴青鸿, 李健, 刘欢, 等. 基于模糊PID下肢外骨骼机器人的控制技术[J]. 广西科技大学学报, 2020, 31(4): 104-111.
[7] 陈磊, 黄文权, 杨长牛, 等. 基于遗传模糊算法的康复机器人康复训练控制[J]. 计算机测量与控制, 2013, 21(11): 3080-3082+3092.
[8] 李伟. 人体特征融合下的康复机器人控制器设计[D]: [硕士学位论文]. 郑州: 中原工学院, 2022.
[9] 李超. 外骨骼下肢康复机器人系统开发及其柔顺控制研究[D]: [硕士学位论文]. 杭州: 浙江理工大学, 2019.
[10] 冯钧, 孔建寿, 王刚. 基于模糊补偿的多关节机器人自适应神经滑模控制[J]. 模糊系统与数学, 2021, 35(5): 65-75.
[11] Shi, T., Tian, Y.T., Sun, Z.B., et al. (2020) A New Projected Active Set Conjugate Gradient Approach for Taylor-Type Model Predictive Control: Application to Lower Limb Rehabilitation Robots with Passive and Active Rehabilitation. Frontiers in Neu-rorobotics, 14, Article 559048. [Google Scholar] [CrossRef] [PubMed]
[12] 黄世涛, 冯之敬. 基于LQR指标的直线伺服系统最优PID控制器设计[J]. 制造技术与机床, 2006(10): 33-35.
[13] 李宗帅, 张革文, 刘艳敏, 王修岩. 基于LQR的直流电机伺服系统三闭环PID控制器设计[J]. 微电机, 2016, 49(5): 58-62.
[14] 王磊, 李珉星, 吴蓉蓉, 缪兆彬. 镜像疗法对脑卒中后下肢功能障碍的康复疗效分析[J]. 中国临床医学, 2021, 28(1): 121-124.
[15] 钱伟行, 周紫君, 谢非, 等. 基于机器学习与步态特征辅助的行人导航方法[J]. 中国惯性技术学报, 2019, 27(4): 433-439+447.
[16] Hussein, S., Schmidt, H., Hesse, S. and Kruger, J. (2009) Effect of Different Training Modes on Ground Reaction Forces During Robot Assisted Floor Walking and Stair Climbing. 2009 IEEE International Conference on Rehabilitation Robotics, Kyoto, 23-26 June 2009, 845-850. [Google Scholar] [CrossRef] 
[17] Lin, J., Hu, G., Ran, J., et al. (2020) Effects of Bodyweight Support and Guidance Force on Muscle Activation During Locomat Walking in People with Stroke: A Cross-Sectional Study. Journal of NeuroEn-gineering and Rehabilitation, 17, Article No. 5. [Google Scholar] [CrossRef] [PubMed]
[18] Colombo, G., Joerg, M., Schreier, R. and Dietz, V. (2000) Treadmill Training of Paraplegic Patients Using a Robotic Orthosis. Journal of Rehabilitation Re-search and Development, 37, 693-700.
[19] Riener, R., Lunenburger, L., Maier, I.C., Colombo, G. and Dietz, V. (2010) Locomotor Training in Subjects with Sensori-Motor Deficits: An Overview of the Robotic Gait Orthosis Lokomat. Journal of Healthcare Engi-neering, 1, 197-215. [Google Scholar] [CrossRef] 
[20] 郝新源. 两相混合式步进电机智能驱动器的研究与设计[D]: [硕士学位论文]. 济南: 山东师范大学, 2022.
[21] 汪全伍. 两相混合式步进电机高性能闭环驱动系统研究[D]: [硕士学位论文]. 杭州: 浙江理工大学, 2017.
[22] 茹珂, 郭希铮, 游小杰, 许中阳. 两相混合步进电机开环高速控制策略研究[J]. 微电机, 2018, 51(10): 36-41.
[23] 李军科, 戴明, 杨国华. 两相混合式步进电机高性能闭环驱动系统设计[J]. 无锡商业职业技术学院学报, 2023, 23(2): 100-107.
[24] 马丹晨. 两相混合式步进电机矢量控制[J]. 电子制作, 2022, 30(5): 65-67+41.
[25] Bellini, A., Concari, C., Franceschini, G. and Toscani, A. (2007) Mixed-Mode PWM for High-Performance Stepping Motors. IEEE Transac-tions on Industrial Electronics, 54, 3167-3177. [Google Scholar] [CrossRef] 
[26] 徐明泽, 刘清河. 基于LQR和PID的智能车轨迹跟踪控制算法设计与仿真[J]. 太原理工大学学报, 2022, 53(5): 877-885.
[27] 张孟霞, 郭春晓. 黎卡提方程的解法[J]. 教育教学论坛, 2017(45):164-165.
[28] 李雨辰, 邹任玲, 孙元良, 等. 胸腰椎骨内固定手术仿真模型优化研究[J]. 上海理工大学学报, 2022, 44(2): 172-176+212.
[29] 毛新涛, 包钢, 杨庆俊, 李军. 三自由度气动串联机械手空间路径规划及轨迹控制研究[J]. 机床与液压, 2008, 36(4): 61-63.

为你推荐