关键词:
柔性机械臂
非线性系统动力学建模
轨迹规划
自适应位置控制
残余振动抑制
摘要:
聚变堆内部空间有限,同时存在高温、强辐射等危险因素,传统的人工维护方式受到限制,机械臂进行维护变得尤为重要。然而,机械臂通常采用长悬臂结构以适应聚变堆有限的窗口尺寸和腔内操作空间,导致在自重和负载的作用下,不可避免地会出现一定程度的柔性变形,进而影响系统的工作精度和维护效率。针对上述问题,本文以典型柔性机械臂为研究对象,开展了系统动力学建模和位置控制策略的研究,主要内容如下:(1)基于多体系统的传递矩阵和Lagrange方程,建立了柔性机械臂的高效动力学传递方程,并将其拓展应用于系统控制策略的研究。通过浮动坐标法和有限元模态综合技术,建立了系统运动学模型;并在此基础上利用“化整为零”的思想以及系统各组件状态矢量之间的线性关系,分别推导了柔性杆件、刚性杆件以及转动关节的动力学传递矩阵;然后结合系统的拓扑关系得出了整体动力学传递方程。最后通过与经典Lagrange方程进行对比,验证了所提的方法有效性。该方法具有程式化程度高、可扩展性强和计算效率高等优点,为后续聚变堆维护机械臂的动态性能分析和结构设计提供了理论依据。(2)利用系统动力学模型和径向基函数的优点,提出了一种用于控制柔性机械臂残余振动的关节插值离散轨迹规划方法。该方法将五次多项式函数作为系统的关节基本轨迹,利用具有无限平滑性的径向基函数对基本轨迹进行分段插值,以得到待优化的浮动插值点,从而将轨迹规划问题转化为优化问题。然后提出一种基于模拟退火策略的混合粒子群优化算法对上述优化问题进行求解,得到能够有效抑制残余振动的关节轨迹函数。最后通过多组数值模拟验证了该方法的有效性。所提出的方法无需对机械臂结构进行任何改变或添加外部装置,在聚变堆维护中具有重要的研究和应用价值。(3)针对分段离散插值轨迹不连续和系统不确定性等问题,提出了一种基于关节连续轨迹规划和扩展状态观测器的柔性机械臂无模型控制策略。由于柔性机械臂的振动相较于大范围刚体运动来说属于高频运动,因此首先将系统的位置控制问题拆解为抑制振动的轨迹规划和跟踪轨迹的运动控制。然后提出一种基于关节加速度约束和动力学模型的轨迹规划方法,并利用改进的粒子群优化算法求解振动抑制的最优轨迹,并将其作为轨迹跟踪控制的期望输入;此外,利用零空间法缩并系统动力学模型,用以建立系统状态空间方程。在此基础上,提出了一种基于扩张状态观测器的模糊自整定PD控制策略,在考虑系统不确定性或干扰的情况下实现轨迹跟踪。(4)提出了一种基于模糊逼近技术的自适应控制策略,旨在实现系统在外部干扰下的快速位置控制,以及进一步提高控制精度和鲁棒性。首先,将蚁群算法用于系统关节轨迹的优化,并将所得轨迹用作控制器的前馈期望输入。然后考虑系统受到不确定性或干扰的情况,提出了一种基于模糊逼近技术和反步控制的自适应轨迹跟踪控制策略;同时通过构造Lyapunov函数证明了控制系统的稳定性。所提出的控制策略避免了对模型准确性的依赖,且结构简单、抑振效果好,能够更快速地实现高精度位置控制。(5)为应对柔性机械臂在工作过程中受到未知有界干扰的情况,提出了一种基于非线性干扰观测器的柔性机械臂位置控制策略。首先,通过构造余弦优化轨迹作为控制器的前馈期望输入,然后建立滑模自适应率下的反步控制策略和非线性干扰观测器,以便实现对未知有界干扰的实时估计和补偿,提高系统的控制精度和鲁棒性。