西南科技大学自动化专业方向设计报告设计名称：直线二级倒立摆的建模和镇定控制姓名：学号:班级：指导教师：起止日期：方向设计任务书学生班级：学生姓名：学号：设计名称：起止日期：指导教师：方向设计学生日志直线二级倒立摆的建模与镇定控制摘要（150-250字）倒立摆是一个典型的多变量、非线性、强耦合、欠驱动的自然不稳定系统，对倒立摆系统的控制研究，能反映控制过程中的镇定、非线性和随动等问题，因此常用于各种控制算法的研究。

而且对倒立摆系统的研究还有重要的工程背景，对机器人行走、火箭的姿态调整等都有重要的现实意义。

本文以直线二级倒立摆系统为模型，阐释了直线二级倒立摆的建模方法和镇定控制算法。

其次介绍了直线二级倒立摆系统的结构和参数，应用拉格朗日方程建模方法详细推导了二级倒立摆的数学模型，并对系统的性能进行分析。

接下来，本文重点研究了最优控制算法在直线二级倒立摆镇定控制中的应用；在介绍倒立摆系统的最优控制算法的基础上，设计了系统的最优控制器，分析得出控制参数的选择规律；并且在Simulink上完成仿真实验,观察控制系统性能。

关键词：倒立摆；建模；LQR；镇定控制Modeling and Balance Control of the Linear DoubleInverted PendulumAbstract：Inverted pendulum is a typical multivariable, nonliner, closed coupled and quick movement natural instable system.The process of control research can reflect many key problems in control theory, such as the problem of tranquilization, non linearity, following and so on. So the inverted pendulum is commonly used for the study of many kinds of control theory. The research of inverted pendulum also has important background of engineering, and has practical significance for the Robot walk and Rocket-profile adjustment.In this paper, taking the linear double inverted pendulum system as the control model, reaching of the control system based on lagrange equation and optimal control algorithm. First of all, giving out the research significance and situation of the inverted pendulum system,and introducing the linear double inverted pendulum modeling methods and stabilization control theory. Secondly, introducing the structure and parameters of the inverted pendulum system. Researching of the inverted pendulum mathematical model based on lagrange equation, and giving a detailed derivation, then having stability analysis of the system. Next, this paper studied the inverted pendulum system’s optimal control algorithm,and designed the LQR controller based on it,then coming to the law of selection of control parameters. Finishing the simulation in the Simulink software,observing the performance of the control system.Key words: inverted pendulum, modeling, LQR, balance control一、设计目的和意义二、控制要求对直线二级倒立摆模型的物理特性做分析，然后利用拉格朗日方程建模方法建立倒立摆的数学模型。

利用线性二次最优控制理论设计倒立摆的LQR镇定控制器，在Matlab和Simulink 中完成倒立摆的镇定控制仿真，得出倒立摆LQR控制器设计规律。

三、设计方案论证牛顿力学建模方法：根据传统的牛顿力学分析，建立二级摆动力学方程，最后经过求解方程建立系统的数学模型。

特点：分析通俗易懂，但需要求解大量微分方程，计算复杂；对于二级以上倒立摆建模很少使用。

拉格朗日建模方法：基于广义力和广义坐标的系统能量法，需要求出系统的动能和势能，建立Lagrange方程。

特点：理论较难，但建模简单，可以编程求解方程。

四、系统设计倒立摆系统是由导轨、小车和各级摆杆组成，本文研究的直线二级倒立摆的物理结构如图1-1所示。

小车依靠直流电机施加的控制力，可以在导轨上左右移动，其位移和摆杆角度信息由传感器测得，目标是使倒立摆在有限长的导轨上竖立稳定，达到动态平衡。

图1-1直线二级倒立摆的物理结构其中，双摆系统由摆杆1、摆杆2、质量块1、小车和基座组成。

摆杆1与摆杆2由质量块1连接，摆杆1与基座都由带滚动轴承的旋转轴自由相连。

小车装在滑动轴上，通过电机带动皮带使小车移动。

为了测量摆杆的转角，转轴上安装有增量式角度编码器，内杆与小车连接处的角度编码器的质量可直接考虑为小车质量的一部分，故图中只表注了内外杆连接处的编码器质量块1。

两个摆杆不带动力源，两摆杆的运动控制只能通过小车的移动来实现。

计算机从运动控制卡中读取实时数据，确定控制决策，并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持摆杆的平衡。

当把摆杆提起到平衡位置附近后放开，若小车不动，摆杆会由于重力倒下来。

当小车在水平方向上移动时，摆杆受到一个转动力矩，这个力矩使摆杆朝与小车运动方向相反的方向运行，通过规律性的改变小车的受力方向使得摆杆在竖直方向上左右摆动，从而实现摆杆在竖直方向上的动态平衡。

直线二级倒立摆系统的物理参数如表2.1所示。

表2.1直线二级倒立摆的物理参数1.基于Lagrange 方程方法建立二级摆的数学模型为了对二级摆的性能做具体的研究，需要建立倒立摆的数学模型。

系统建模方法可以分为两种：机理建模和实验建模。

实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入－输出关系。

机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入、状态关系。

对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。

但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内进行机理建模。

对于小车系统的机理建模，一般有牛顿力学建模方法和分析力学中的拉格朗日方程建模方法两种途径。

牛顿力学建模法分析复杂，且要计算大量的微分方程组，而拉格朗日建模方法分析简单，可以编程求解方程。

因此本文采用拉格朗日方程建模方法建立倒立摆的数学模型，应用mathematica 软件编程求解拉格朗日方程，简化对微分方程的求解。

grange 方程建模的基本原理Lagrange 方程属于分析力学的范畴，是基于广义坐标和广义能量的方法。

Lagrange 方程是由虚功原理推导出来的，指受理想约束的完整力学系中广义力做功为零。

在分析力学中，质点系的虚功可以表示如下：1NQi i i W F q δδ==⋅∑其中，Qi F 称为对应于第i 个广义坐标i q 的广义主动力，i q δ是广义坐标i q 的广义虚位移。

因为i q δ可以是虚线位移，也可以是虚角位移，因此Qi F 可以有力或力矩的量纲，这体现了广义力的广义性。

广义力一般分为保守力和非保守力，保守力是做功与路径无关的力，非保守力是做功与路径有关的力。

虚功原理解决的是受理想约束的完整力学系统处于静平衡状态的问题，当系统在运动时，通过达朗伯定理引入惯性力，将系统运动时的问题转化为静力学问题。

此时系统受主动力、约束力和惯性力处于静平衡状态，应用虚功原理，得到达朗伯-拉格朗日方程。

应用达朗伯-拉格朗日方程可以推导出基于广义坐标和广义能量的Lagrange 方程，本节中我们只对Lagrange 方程进行应用，因此舍去其详细的推导过程。

下面对Lagrange 方程的三种基本形式做介绍。

（1）基本的第二类拉格朗日方程为：（2）主动力是保守力的拉格朗日方程为：（3）主动力包括保守力和非保守力的拉格朗日方程为：其中为拉格朗日算子，q 为系统的广义坐标，T 为系统的动能，V 为系统的势能，i Q 为广义坐标i q 对应的广义力。

对一个系统进行Lagrange 方程建模时的步骤为：首先明确对象，一般取整个系统为研究对象。

对整个系统进行受力分析，分析主动力，当出现非理想约束力时，将其视为主动力；选择恰当形式的拉格朗日方程。

然后对系统的运动性能进行分析，恰当系统中独立的广义坐标。

进而求取系统的动能和势能，得到系统的拉格朗日函数，求偏导和全导，代入拉格朗日方程，获N 个运动微分方程。

最后对N 个微分方程进行线性化，求出系统的数学模型。

3.二级倒立摆系统建模应用Lagrange 方程对二级摆系统进行建模时，对二级摆系统进行受力分析。

由于二级摆系统受推力和摩擦力作用，其中推力属于保守力，摩擦力属于非保守力。

因此选用主动力包括保守力和非保守力的拉格朗日方程。

1,2,i i id L LQ i n dt q q ∂∂-==∂∂•••对二级摆系统的运动特性进行分析，确定广义坐标。

在二级倒立摆系统中，系统有三个广义坐标，分别为12,,x θθ。