西南科技大学自动化专业方向设计报告设计名称：_____姓名： __________________学号： ________________________班级： ________________________指导教师：________________________起止日期：__________________________________方向设计任务书学生班级：_________ 学生姓名： _________ 学号：_设计名称：_____________________________________起止日期：_____________________________________ 指导教师： ______________设计要求：（1）建立直线二级倒立摆系统的数学模型，并在垂直向上方向上（工作点附近）得到线性化模型（2）理解lqr （线性二次调节器）的基本原理，会利用 matlab提供的lqr函数获得直线二级倒立摆线性化模型的lqr控制器；（3）利用matlab的simulink仿真环境，搭建倒立摆的控制系统，得到并分析仿真结果；（4）撰写设计报告，完成答辩。
方向设计学生日志直线二级倒立摆的建模与镇定控制摘要（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所示。
1•基于Lagrange方程方法建立二级摆的数学模型为了对二级摆的性能做具体的研究，需要建立倒立摆的数学模型。
系统建模方法可以分为两种：机理建模和实验建模。
实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入 -输出关系。
机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入、状态关系。
对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。
但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内进行机理建模。
对于小车系统的机理建模，一般有牛顿力学建模方法和分析力学中的拉格朗日方程建模方法两种途径。
牛顿力学建模法分析复杂，且要计算大量的微分方程组，而拉格朗日建模方法分析简单，可以编程求解方程。
因此本文采用拉格朗日方程建模方法建立倒立摆的数学模型，应用mathematica软件编程求解拉格朗日方程，简化对微分方程的求解。
gra nge方程建模的基本原理Lagrange方程属于分析力学的范畴，是基于广义坐标和广义能量的方法。
Lagrange方程是由虚功原理推导出来的，指受理想约束的完整力学系中广义力做功为零。
在分析力学中，质点系的虚功可以表示如下：N"八 F Qi -q ii d其中，F Qi称为对应于第i个广义坐标q i的广义主动力，q i是广义坐标q i的广义虚位移。
因为q i可以是虚线位移，也可以是虚角位移，因此F Qi可以有力或力矩的量纲，这体现了广义力的广义性。
广义力一般分为保守力和非保守力，保守力是做功与路径无关的力，非保守力是做功与路径有关的力虚功原理解决的是受理想约束的完整力学系统处于静平衡状态的问题，当系统在运动时， 通过达朗伯定理引入惯性力，将系统运动时的问题转化为静力学问题。
此时系统受主动力、约 束力和惯性力处于静平衡状态，应用虚功原理，得到达朗伯-拉格朗日方程。
5⑷-瞬)砌=0i-1应用达朗伯-拉格朗日方程可以推导出基于广义坐标和广义能量的 我们只对Lagrange 方程进行应用，因此舍去其详细的推导过程。
下面对 基本形式做介绍(1) 基本的第二类拉格朗日方程为:d dT sr' ____________________ ___________________dt 如 dq i(2) 主动力是保守力的拉格朗日方程为： ----- —=U J = 1,2,,.^dt 两 两(3) 主动力包括保守力和非保守力的拉格朗日方程为:d 5L 9L系统的势能，Q i 为广义坐标q j 对应的广义力。