倒立摆系统的建模(拉格朗日方程)

系统的建模及性能分析

倒立摆系统的构成及其参数

1倒立摆系统的基本结构

本设计所用到的倒立摆模型直线一级倒立摆系统。整个系统是由6大部分所组成的一个闭环系统，包括计算机、数据采集卡、电源及功率放大器、直流伺服电机、倒立摆本体和两个光电编码器等模块。如图 2.1所示：

图2.1倒立摆系统的结构组成示意图

Fig 2.1 Structure of the lin ear sin gle in verted pen dulum system

2系统主要组成部分简介

直线一级倒立摆装置如图2.2所示[13]:

图2.2直线一级倒立摆装置

Fig 2.2 Straight lin ear 1-stage in verted pen dulum device

Qua nser 倒立摆系统包含倒立摆本体、数据采集电控模块以及控制平台等三 大部分，其中控制平

台是由装有 Qua nser 专用实时控制软件的通用PC 机组成。

1.直线倒立摆主体

倒立摆主体是由Quanser 直线运动控制伺服单元IP02与直线一级摆杆组成, 并配有专用的小车直线轨道。这里主要介绍下

Qua nser 直线运动控制伺服单元

Fig 2.3 Servo un it IP02 parts

编号 名称 英文

(01) IP02小车

IP02 Cart

(02) 不锈钢滑轨 Stai nl ess Steel Shaft (03) 齿轮导轨 Rack

(04) 小车位移齿轮 Cart Position Pinion (05) 小车电机传动齿轮 Cart Motor Pinion

(06) 小车电机传动齿轮轴 Cart Motor Pin io n Shaft (07) 摆杆传动轴

Pen dulum Axis (08) IP02小车位移编码器 IP02 Cart En coder

(09) IP02摆杆角度编码器 IP02 Pen dulum En coder

(10) IP02小车位移编码器接口 IP02 Cart En coder Co nn ector (11) IP02摆杆角度编码器接口

IP02 Pen dulum En coder Conn ector (12) 电机接口 Motor Conn ector (13) 直流伺服电机 DC Motor

(14)

变速器 Pla netary Gearbox (15)

直线滑轨支撑轴

Lin ear Beari ng (16) 摆杆连接套

Pen dulum Socket

IP02（即倒立摆运动小车）及导轨的组成：

图2.3伺服单元IP02的组成

图2.4系统导轨结构图

直线一级倒立摆系统的倒立摆的摆杆连接在IP02小车的摆杆连接套上，IP02 小车由电机通过齿轮传动机构在导轨上来回运动，保持摆杆平衡。系统的直流电

机采用的是Faulhaber 2338S006型号的无刷直流电机，这种电机不仅具有结构简单、运行可靠的优点，而且还比传统的直流电机具有更快的反应速度。电机还配

有Faulhaber的变速箱，可以提供3.71:1的减速比。

(2).数据采集模块

电控箱内安装了本系统用到的各种电气元件，其中包括了有5针数字I/0接

口的数据采集卡、开关电源、电源及功率放大器、指示灯和开关等。控制信号需要通过电源及功率放大器对控制信号进行处理，然后再输送至小车的直流伺服电

机。

(3).控制平台

控制平台主要由以下部分组成：⑴通用PC机；⑵实时控制软件QUARC

控制平台的是倒立摆伺服系统的核心，是实现系统闭环的关键环节。它通过PC机的USB接口接收数据采集卡传输过来的位移和角度数据，进一步处理得到小车速度和摆杆角速度，同时将输入量根据所设计的控制算法计算出控制量，控制小车的运动，维持倒立摆的平衡。而控制平台的实时控制软件QUARC可以和MATLAB/Simulink完美联动，操作起来非常的方便。

MATLAB 是美国MathWorks 公司出品的商业数学软件，用于算法开发、数据可视化、数据分析以及数值计算的高级技术计算语言和交互式环境。

而Simulink 是MATLAB 最重要的组件之一，它提供一个动态系统建模、仿真和综合分析的集成

环境。在该环境中，无需大量书写程序，而只需要通过简单直观的鼠标操作，就可构造出复杂的系统。Simulink 具有适应面广、结构和流程清晰及仿真精细、贴近实际、效率高、灵活等优点，并基于以上优点Simulink 已被广泛应用于控制理论和数字信号处理的复杂仿真和设计。同时有大量的第三方软件和硬件可应用于或被要求应用于Simulink 。

3 系统性能参数

小车及配重质量M=0.94kg；

摆杆质量m=0.230kg；

摆杆长L=0.6413m；

摆杆转动轴心到杆质心的长度l=0.3302m；

重力加速度g=9.81N/s2。

2.2 一级倒立摆系统的模型建立

2.2.1 Lagra nge方程建立模型

由于倒立摆的多变量、非线性的特点，同时也为了减少实验设计的盲目性，先建立系统的数学模型，然后才进行仿真实验和实时控制。使用牛顿运动定理来求解这样一个复杂的系统的数学模型，势必会产生大量的微分方程的计算。并且，在实际系统中，当质点存在约束情况的时候，计算量将会更大。所以，在本设计中，采用的是Lagrange 方程来推导倒立摆系统的系统模型。

Lagra nge方程是以能量观点建立起来的运动方程式，为了列出系统的运动方程式，只需要从两个方面去分析，一个是表征系统运动的动力学量——系统的动能和势能，另一个是表征主动力作用的动力学量——广义力。因此用Lagrange 方程来求解系统的动力学方程可以大大简化建模过程。

将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，并将倒立摆的物理模型分解为小车和摆杆的两部分分别进行受力分析。如图2.5 所示。