鲁棒控制作业方案.doc

车载液压机械臂轨迹的鲁棒跟踪控制 一、申明 本人郑重申明：所呈交的车载液压机械臂的鲁棒控制，是本人经查阅相关文献，结合自己研究课题，独立进行研究所取得的成果。 1、本研究选取了车载液压机械臂前两个连杆，比实际的少了一个伸缩的连杆（子系统）。 2、没有考虑负载情况下机械臂的变形以及振动，即只考虑机械臂为刚性机械臂情况。 3、只考虑车在静态搬运负载过程中的轨迹跟踪问题。 4、采用鲁棒控制和PD控制相结合控制方法，并设计框图。 5、新选取广义控制力矩、状态变量、并对模型进行线性化； 6、选取李雅普诺夫函数、控制量，并证明了稳定性。7、仿真并分析结果。 结果分析方面： 在相同输入情况下，PD控制器参数不变，改变鲁棒控制率 二、研究背景、控制要求以及控制策略 车载机械臂是一种装配在汽车上，用来实现对货物的抓取、回转、搬运的自动化装置。它具有严重的非线性、以及连杆与关节之间的强耦合作用，此外由于负载变化、外部扰动以及大量不确定量（参数不确定量和非线性模型不确定量）的存在，增大了控制器的设计难度，特别是外部扰动、不确定参数以及不确定模型都将对系统的动态特性和稳定性产生较大影响。 针对此问题本研究提出了鲁棒控制设计方法，控制力矩由两部分组成，前馈控制部分只与自身结构有关，本质上是一种PD控制，其作用是使系统沿标称轨迹运动所需要的控制力矩；反馈控制部分包含外界控制输入量u，本质上是鲁棒控制，作用是消除外界不确定性干扰。 总之本文是基于车载液压机械臂系统，针对系统的不确定量和外部干扰，设计了PD控制器和鲁棒控制器使机械臂达到轨迹跟踪控制。 三、车载液压机械臂模型 车载机械臂装载在车辆尾部，主要用于吊装大载荷物体，完成物体在该车和运输车之间的转载任务。本研究中车载机械臂是由一个回转关节、一个转动关节以及连杆组成，其简化模型如图1所示。 车 车载液压机械臂模型 图1 四、求动力学方程 1、此模型基于拉格朗日的动力学方程 （1） 其中，为惯性矩阵，为离心力及哥氏力项，为重力项,为驱动力矩 2、此动力学方程的性质 （1）正定性 对任意的，惯性矩阵是正定的 （2）有界性 矩阵函数和对于所有的和是一致有界的，即存在正数和正定函数，使得 （2） （3）斜对称性 矩阵函数对于任意和是斜对称的，即对于任意的向量，有： （3） （4）线性特征 机器人数学模型对于物理参数是线性的，即如果将矩阵函数,,中的定常系数表示为一个向量，那么可以定义适当的矩阵，使得： （4） 3、求总动能和总势能 （1）连杆1上的动能 （5） 其中，为连杆1的转动惯量，为关节2的转动惯量 连杆1上的势能 （6） 其中，为连杆1的长度，为连杆1的线密度，为关节2的质量。 （2）连杆2上的动能 由奇次变换阵 （7） 可得连杆2上任意一点在惯性坐标系中的表示 （8） 求导得连杆2上任意一点在惯性坐标系中的线速度 （9） 连杆2的动能 （10） 连杆2上的势能 （11） 其中，为连杆2的长度，为连杆2的线密度，为负载的质量。 总动能 （12） 总势能 (13) 4、拉格朗日函数为 (14) 拉格朗日动力学方程 (15) 即 (16) 则连杆1的控制力矩为 (17) 连杆2的控制力矩为 (18) 则 (19) (20) (21) 若令 (22) 则