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