挖掘机轨迹跟踪的滑模变结构控制
黄茹楠，顾波
（燕山大学工业计算机控制工程河北省重点实验室，河北秦皇岛066004）
摘 要：对液压挖掘机工作装置的轨迹跟踪进行了研究。在分析了液压挖掘机工作装置的动力学方程的基础上，针对其复杂的非线性，提出了一种新的液压挖掘机工作装置轨迹跟踪方法，即应用机器人学理论，建立了三自由度液压挖掘机工作装置的拉格朗日动力学模型，设计了带低通滤波器的滑模控制器，利用低通滤波器的滤除高频信号的功能，消除控制信号的抖动，给出沿规划轨迹工作所需的控制量，并给出了控制系统的设计方法。对三自由度工作装置进行了仿真研究，其结果表明，所设计的控制器对设定轨迹的跟踪具有良好的动态特性，对系统的不确定性具有较强的鲁棒性，在存在模型误差和外部扰动的情况下，该方案既能达到高精度快速跟踪的目的，又能消除滑模控制的抖动问题：
关键词：液压挖掘机；动力学方程；滑模控制；轨迹跟踪
中图分类号：tp 24 文献标识码：a
1引 言
液压挖掘机是一种广泛应用于矿山、建筑等行业的重要装备。随着计算机技术的发展，挖掘机已逐步趋向于机器人化，对操纵系统的控制也提出了更高的要求。如何实现平稳和高精度的轨迹跟踪已成为挖掘机控制自动化的一个关键问题。对于挖掘机器人来说，由于外部干扰、未知参数及自身的强非线性等因素，很难得到精确模型，因此在研究挖掘机器人的轨迹跟踪时，滑模变结构控制是一种很有吸引力的方法。滑模变结构控制是一种非线性控制策略，可以以简单的控制规律实现动态和稳态性能之间矛盾的协调，尤其是它对扰动和参数变化的鲁棒性以及进入滑动模运动后的完全自适应性，使得滑模控制广泛应用于非线性系统的鲁棒控制中。但这种鲁棒性是通过各种控制模式之间的高频切换来实现的，存在控制信号的突变，这就是滑模变结构控制系统中的抖振现象，它轻则会引起执行部件的机械磨损，重则会激励未建模的高频动态响应，而使控制失效。
为解决滑模变结构控制中出现的抖振现象，国内外学者已经提出了一些解决方法。magdym．abdelhameed提出了一种模糊滑模控制方法，实现了对轨迹的快速精确跟踪并有效地消除了抖振现象。fang-ming yu,hung-yuan chung,shi-yuanchen等设计的模糊滑模控制器也很好地解决了非线性输入不确定时滞系统的抖振问题。basilm．hadithi等人用在滑动流形附近引入一边界层，采用饱和函数代替开关函数的方法解决了滑模控制中辩振的问题。其中，常用的是在滑动流形附近引入一边界层，采用饱和函数代替开关函数，称之为“边界层”法，但有时引入饱和函数后，系统变成连续系统而不是变结构系统。
因此，本文采用一种基于带低通滤波的滑模变结构控制来实现消除控制抖动，即在滑模控制器输出端加入低通滤波器，可将高频抖振控制信号进行有效的滤除。
2液压挖掘机三关节工作臂的拉格朗日动力学模型
挖掘机工作装置主要由动臂、头杆和铲斗组成三自由度机构。
按照标准d-h法建立起来的坐标系，如图l所示。
图中动臂、斗杆、铲斗的质量为m1，m2，m3，长度为l1，l2，l3，转角为θ1，θ2，θ3，r1，r2，r3是关节驱动力矩，g为重力加速度。令θ=[θ1，θ2，θ3]t，则工作臂的动力学模型为
3滑模变结构控制器的设计
方程式(1)是一个复杂的非线性系统，其中端点负戟m3是在一定范围内变化的不确定量。对于这样的复杂控制系统，要对其跟踪轨迹控制，本文采用一种基于带低通滤波的滑模变结构控制来实现消除抖动控制，即在滑模控制器输出端加入低通滤波器，可将高频抖振控制信号进行有效的滤除。基于低通滤波器的滑模控制系统结构，如图2所示。
|
