2011计算机仿真大赛一等奖作品解析

编号：

重庆邮电大学

第五届计算机仿真大赛

一等奖作品

题号: C

组别：高年级组

2011年 4 月 6 日

单级移动式倒立摆动态控制仿真

摘要

单级移动式倒立摆系统是一个典型的单输入双输出的自然不稳定系统，具有非线性、强耦合、多变量、高阶次等特性，作为控制系统的被控对象，它是一个理想的教学实验设备，许多抽象的控制概念都可以通过倒立摆直观地表现出来。应用上，倒立摆广泛应用于控制理论研究、航空航天控制、机器人、杂技项杆表演等领域，在自动化领域中具有重要的价值。

研究倒立摆的精确控制对工业生产中复杂对象的控制有着重要的应用价值，因此倒立摆仿真或实物控制实验是控制领域中用来检验某种控制理论或方法的典型方案。许多抽象的控制概念如控制系统的稳定性、可控性、可观性、系统收敛速度和系统抗干扰能力等，都可以通过倒立摆系统直观的表现出来。在控制过程中，它能有效地反映诸如可镇定性、鲁棒性、随动性以及跟踪等许多控制中的关键问题，是检验各种控制理论的理想模型。因而其研究具有重大的理论和实践意义。

本文以单级移动式倒立摆为被控对象，参考古典控制理论设计控制器（如PID控制器）的设计方法和现代控制理论设计控制器（最优控制）的设计方法。针对单级移动式倒立摆系统的单输入双输出、非线性、强耦合的不稳定性，我们采用线性二次最优LQR控制和PID控制，通过MATLAB软件进行实时控制（摆杆的角度和小车的位移）和系统仿真实验实现对小车位置和摆杆偏角的同时闭环控制，达到了预期效果（动态仿真）。

关键词：非线性倒立摆实时控制系统仿真动态

1.问题重述

单级移动式倒立摆原理如下图1-1 所示，

图1-1

其中小车质量M = 3KG;摆杆质量m = 0.1KG;摆杆为均匀的，质心l=0.5米;重力加速度g=9.81;设x1为摆杆角度，x2为摆杆角速度，x3为小车位移，x4为小车速度，其中小车水平受力为输入量，建立其状态方程：

采用状态反馈进行控制，其控制原理如下图1-2 所示：

图1-2

计算得k1=-446.7287,k2= -91.0448,k3= -244.6376 ,k4=-110.0896 时系统稳定。建立倒立摆控制仿真系统，当输入信号为阶跃信号和随机信号时，实时演示倒立摆的工作情况。

2.单级倒立摆模型的建立

2.1 倒立摆概述单级倒立摆是一个自然不稳定系统，是处于倒置不稳定状态，人为控

制使其处于

动态平衡的一种摆，一般是由一个可以在水平轨道上自由移动的小车和倒置摆铰链而成，用一种强有力的控制方法对小车的速度作适当的控制，从而使全部摆杆倒置稳定于正上方，这个系统也叫自动平衡车。悬挂式倒立摆系统开始工作时，首先使小车按摆杆的自由振荡频率摆动，摆杆随之大幅度摆动，当摆杆接近于倒立摆垂直位置时，自动转换控制方法，使其稳定于倒置状态。随着倒立摆系统的控制研究的不断深入，倒立摆系统的种类也由简单的单线倒立摆发展为多种形式的倒立摆。常见的倒立摆系统一般由小车和摆杆两部分构成(另有旋转式倒立摆等形式)，其中摆杆可能是一级、两级甚至多级(级数越多，控制难度越大)，其长度也可能是可变化的。控制的目标一般都是通过给小车施加一个水平方向的力，使小车在期望位置上稳定，而摆杆达到竖直向上的动态平衡状态。

2.2 数学准备对系统建立数学模型是系统分析、设计的前提，而一个准确又简练的数

学模型将

大大简化后期的工作。为了简化系统分析，在实际的模型建立过程中，要忽略空气流动阻力，以及各种次要的摩擦阻力。这样，可将倒立摆系统抽象成小车和匀质刚性杆组成的系统，如下图所示。

本系统内部各相关参数定义如下：

M 小车质量

m 摆杆质量

b 小车摩擦系数

l 摆杆转动轴心到杆质心的长度

2

2

I 摆杆惯量

f

加在小车上的力

x

小车位置

φ

摆杆与垂直向上方向的夹角

θ 摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下） 下图是系统中小车和摆杆的受力分析图。其中， N 和 P 为小车与摆杆相互作用力 的水平和垂直方向的分量。

注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量 方向定义如图，图示方向为矢量正方向。

应用 Newton 方法来建立系统的动力学方程过程如下： 分析小车水平方向所受的合力，可以得到以下方程：

M x

= f - bx - N

由摆杆水平方向的受力进行分析可以得到下面等式：

N = m d

( x + l sin θ )

dt 2

即： N = m x

+ ml θ cos θ - ml θ 2 sin θ

把这个等式代入上式中，就得到系统的第一个运动方程：

(M + m ) x

+ bx + ml θ cos θ - ml θ 2 sin θ = F

（2-1）

为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以 得到下面方程：

P - mg = -m d

(l cos θ )

dt 2

即： P - mg = ml θ sin θ + ml θ 2 cos θ

力矩平衡方程如下：

- Pl sin θ - Nl cos θ = I θ

注意：此方程中力矩的方向，由于θ = π + φ , cos φ = - cos θ , s in φ = - s in θ ，故等式

前面有负号。

合并这两个方程，约去 P 和 N ，得到第二个运动方程：

(I + ml 2 )θ + mgl sin θ = -ml x

cos θ （2-2）