直线二级倒立摆的建模和控制

1西南科技大学自动化专业方向设计报告设计名称：直线二级倒立摆的建模和镇定控制姓名：学号:班级：指导教师：起止日期：2方向设计任务书学生班级：学生姓名：学号：设计名称：起止日期：指导教师：设计要求：（1）建立直线二级倒立摆系统的数学模型，并在垂直向上方向上（工作点附近）得到线性化模型；（2）理解lqr（线性二次调节器）的基本原理，会利用matlab提供的lqr函数获得直线二级倒立摆线性化模型的lqr控制器；（3）利用matlab的simulink仿真环境，搭建倒立摆的控制系统，得到并分析仿真结果；（4）撰写设计报告，完成答辩。方向设计学生日志时间设计内容3直线二级倒立摆的建模与镇定控制摘要（150-250字）倒立摆是一个典型的多变量、非线性、强耦合、欠驱动的自然不稳定系统，对倒立摆系统的控制研究，能反映控制过程中的镇定、非线性和随动等问题，因此常用于各种控制算法的研究。而且对倒立摆系统的研究还有重要的工程背景，对机器人行走、火箭的姿态调整等都有重要的现实意义。本文以直线二级倒立摆系统为模型，阐释了直线二级倒立摆的建模方法和镇定控制算法。其次介绍了直线二级倒立摆系统的结构和参数，应用拉格朗日方程建模方法详细推导了二级倒立摆的数学模型，并对系统的性能进行分析。接下来，本文重点研究了最优控制算法在直线二级倒立摆镇定控制中的应用；在介绍倒立摆系统的最优控制算法的基础上，设计了系统的最优控制器，分析得出控制参数的选择规律；并且在Simulink上完成仿真实验,观察控制系统性能。关键词：倒立摆；建模；LQR；镇定控制4ModelingandBalanceControloftheLinearDoubleInvertedPendulumAbstract：Invertedpendulumisatypicalmultivariable,nonliner,closedcoupledandquickmovementnaturalinstablesystem.Theprocessofcontrolresearchcanreflectmanykeyproblemsincontroltheory,suchastheproblemoftranquilization,nonlinearity,followingandsoon.Sotheinvertedpendulumiscommonlyusedforthestudyofmanykindsofcontroltheory.Theresearchofinvertedpendulumalsohasimportantbackgroundofengineering,andhaspracticalsignificancefortheRobotwalkandRocket-profileadjustment.Inthispaper,takingthelineardoubleinvertedpendulumsystemasthecontrolmodel,reachingofthecontrolsystembasedonlagrangeequationandoptimalcontrolalgorithm.Firstofall,givingouttheresearchsignificanceandsituationoftheinvertedpendulumsystem,andintroducingthelineardoubleinvertedpendulummodelingmethodsandstabilizationcontroltheory.Secondly,introducingthestructureandparametersoftheinvertedpendulumsystem.Researchingoftheinvertedpendulummathematicalmodelbasedonlagrangeequation,andgivingadetailedderivation,thenhavingstabilityanalysisofthesystem.Next,thispaperstudiedtheinvertedpendulumsystem’soptimalcontrolalgorithm,anddesignedtheLQRcontrollerbasedonit,thencomingtothelawofselectionofcontrolparameters.FinishingthesimulationintheSimulinksoftware,observingtheperformanceofthecontrolsystem.Keywords:invertedpendulum,modeling,LQR,balancecontrol5一、设计目的和意义二、控制要求对直线二级倒立摆模型的物理特性做分析，然后利用拉格朗日方程建模方法建立倒立摆的数学模型。利用线性二次最优控制理论设计倒立摆的LQR镇定控制器，在Matlab和Simulink中完成倒立摆的镇定控制仿真，得出倒立摆LQR控制器设计规律。三、设计方案论证牛顿力学建模方法：根据传统的牛顿力学分析，建立二级摆动力学方程，最后经过求解方程建立系统的数学模型。特点：分析通俗易懂，但需要求解大量微分方程，计算复杂；对于二级以上倒立摆建模很少使用。拉格朗日建模方法：基于广义力和广义坐标的系统能量法，需要求出系统的动能和势能，建立Lagrange方程。特点：理论较难，但建模简单，可以编程求解方程。四、系统设计倒立摆系统是由导轨、小车和各级摆杆组成，本文研究的直线二级倒立摆的物理结构如图1-1所示。小车依靠直流电机施加的控制力，可以在导轨上左右移动，其位移和摆杆角度信息由传感器测得，目标是使倒立摆在有限长的导轨上竖立稳定，达到动态平衡。小车电机滑动轴皮带摆杆1摆杆2质量块112图1-1直线二级倒立摆的物理结构其中，双摆系统由摆杆1、摆杆2、质量块1、小车和基座组成。摆杆1与摆杆2由质量块1连接，摆杆1与基座都由带滚动轴承的旋转轴自由相连。小车装在滑动轴上，通过电机带动皮带使小车移动。为了测量摆杆的转角，转轴上安装有增量式角度编码器，内杆与小车连接处的角度编码器的质量可直接考虑为小车质量的一部分，故图中只表注了内外杆连接处的编码器质量块1。两个摆杆不带动力源，两摆杆的运动控制只能通过小车的移动来实现。计算机从运动控制卡中读取实时数据，确定控制决策，并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持摆杆的平衡。当把摆杆提起到平衡位置附近后放开，6若小车不动，摆杆会由于重力倒下来。当小车在水平方向上移动时，摆杆受到一个转动力矩，这个力矩使摆杆朝与小车运动方向相反的方向运行，通过规律性的改变小车的受力方向使得摆杆在竖直方向上左右摆动，从而实现摆杆在竖直方向上的动态平衡。直线二级倒立摆系统的物理参数如表2.1所示。表2.1直线二级倒立摆的物理参数符号描述参数符号描述参数m1摆杆1质量0.108kgl1摆杆1质心到转矩距离0.20mm2摆杆2质量0.108kgl2摆杆2质心到转矩距离0.20mm3质量块质量0.208kgL摆杆1、2的长度0.40mM小车质量1.32kgf0小车与导轨的摩擦系数22.915g重力加速度9.8000N/kgf1摆杆1与小车的摩擦系数0.7756J1摆杆1的转动惯量0.00144kg.m2f2摆杆1与摆杆2的摩擦系数0.7756J2摆杆2的转动惯量0.00144kg.m2θ1摆杆1转动角度x小车水平位移θ2摆杆2转动角度1.基于Lagrange方程方法建立二级摆的数学模型为了对二级摆的性能做具体的研究，需要建立倒立摆的数学模型。系统建模方法可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入－输出关系。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入、状态关系。对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内进行机理建模。对于小车系统的机理建模，一般有牛顿力学建模方法和分析力学中的拉格朗日方程建模方法两种途径。牛顿力学建模法分析复杂，且要计算大量的微分方程组，而拉格朗日建模方法分析简单，可以编程求解方程。因此本文采用拉格朗日方程建模方法建立倒立摆的数学模型，应用mathematica软件编程求解拉格朗日方程，简化对微分方程的求解。2.Lagrange方程建模的基本原理Lagrange方程属于分析力学的范畴，是基于广义坐标和广义能量的方法。Lagrange方程是由虚功原理推导出来的，指受理想约束的完整力学系中广义力做功为零。在分析力学中，质点系的虚功可以表示如下：1NQiiiWFq其中，QiF称为对应于第i个广义坐标iq的广义主动力，iq是广义坐标iq的广义虚位移。因为iq可以是虚线位移，也可以是虚角位移，因此QiF可以有力或力矩的量纲，这体现了广义力的广义性。广义力一般分为保守力和非保守力，保守力是做功与路径无关的力，非保守力是7做功与路径有关的力。虚功原理解决的是受理想约束的完整力学系统处于静平衡状态的问题，当系统在运动时，通过达朗伯定理引入惯性力，将系统运动时的问题转化为静力学问题。此时系统受主动力、约束力和惯性力处于静平衡状态，应用虚功原理，得到达朗伯-拉格朗日方程。应用达朗伯-拉格朗日方程可以推导出基于广义坐标和广义能量的Lagrange方程，本节中我们只对Lagrange方程进行应用，因此舍去其详细的推导过程。下面对Lagrange方程的三种基本形式做介绍。（1）基本的第二类拉格朗日方程为：（2）主动力是保守力的拉格朗日方程为：（3）主动力包括保守力和非保守力的拉格朗日方程为：其中为拉格朗日算子，q为系统的广义坐标，T为系统的动能，V为系统的势能，iQ为广义坐标iq对应的广义力。对一个系统进行Lagrange方程建模时的步骤为：首先明确对象，一般取整个系统为研究对象。对整个系统进行受力分析，分析主动力，当出现非理想约束力时，将其视为主动力；选择恰当形式的拉格朗日方程。然后对系统的运动性能进行分析，恰当系统中独立的广义坐标。进而求取系统的动能和势能，得到系统的拉格朗日函数，求偏导和全导，代入拉格朗日方程，获N个运动微分方程。最后对N个微分方程进行线性化，求出系统的数学模型。3.二级倒立摆系统建模应用Lagrange方程对二级摆系统进行建模时，对二级摆系统进行受力分析。由于二级摆系统受推力和摩擦力作用，其中推力属于保守力，摩擦力属于非保守力。因此选用主动力包括保守力和非保守力的拉格朗日方程。1,2,iiidLLQindtqq对二级摆系统的运动特性进行分析，确定广义坐标。在二级倒立摆系统中，系统有三个广义坐标，分别为12,,x。当iqx时，iQF；当12iq、时，对应的iQ为零。然后求出系8统的动能和势能，系统的动能由小车、摆杆1、摆杆2和质量块1的动能组成，系统的势能由摆杆1、摆杆2和质量块1的势能组成。由于系统在12,广义坐标下没有外力作用，可以列出系统在广义坐标中所受外力为零的方程。然后求解方程组，就可以得到倒立摆状态量的表达式，进而建立倒立摆的状态空间方程。由于倒立摆系统是一个非线性和不确定的系统，因此应用机理建模法对二次级倒立摆系统数学模型时作如下假设：1)每一级摆杆都是刚体。2)在实验过程中同步带长度保持不变。3)驱动力与放大器输入成正比并无延迟的直接施加于小车。4)实验过程中的库仑摩擦、动摩擦等所有摩擦力足够小，在建模过程中可忽略不计。使用Lagrange方程对直线二级倒立摆系统的建模过程为：(1)求出倒立摆的动能和势能12xXYFMg0fx1mg2mg3mg11(,)g