一种基于模糊控制和李雅普诺夫函数的平面欠驱动机械臂位置控制方法

摘要

本发明实施例公开了一种基于模糊控制和李雅普诺夫函数的平面欠驱动机械臂位置控制方法。包括：建立平面三自由度被动‑主动‑主动型(PAA型)欠驱动机械臂动力学模型，并分析其各关节角度、角速度之间的积分约束关系；分析其可达空间，利用粒子群算法计算各驱动关节的目标角度；设计基于模糊控制和李雅普诺夫函数的分段位置控制律，第一阶段设计模糊控制器使第二关节到达目标角度，设计李雅普诺夫函数使第三关节保持初始状态；第二阶段设计模糊控制器使第三关节到达目标角度，设计李雅普诺夫函数使第二关节保持角度不变，实现位置控制。根据本发明实例所提出的技术方案能够保证位置控制的稳定性，且超调量和稳态时间明显下降。