直线一级倒立摆的仿真分析 下载本文

直线一级倒立摆的仿真分析

作者 黄俊杰

摘 要:应用牛顿力学定律建立了直线一级倒立摆传递函数、状态空间表达式等数学模型,并分析其稳定性、可控性和可观测性。【1】在此基础上,分别研究经典控制方法和现代控制方法在一级倒立摆系统中的应用,包括跟PID控制算法、系统轨迹/频率响应分析与校正、线性二次最优控制算法等,并在MATLAB/SIMULINK仿真平台上对这些控制算法的效果进行仿真,可以取得不同的控制效果。

关键词:直线一级倒立摆 数学模型 经典控制方法 现代控制方法 MATLAB/SIMULINK

引言:倒立摆系统是研究控制理论的一种典型的实验装置,具有成本低廉,结构简单,参数和结构易于调整的优点。然而倒立摆系统具有高阶次、不稳定、多变量、非线性和强耦合特性,是一个绝对不稳定系统。倒立摆实物仿真实验是控制领域中用来检验某 种控制理论或方法的典型方案,它对一类不稳定系统的控制以及对深入理解反馈控制理论具有重要的意义。倒立摆系统在研究双足机器人直立行走、火箭发射过程的姿态调整和直升机飞行控制领域中有重要的现实意义,相关的科研成果已经应用到航天科技和机器人学等诸多领域。【2】伴随着控制理论的不断发展,对倒立摆的控制也出现了采用经典控制理论、现代控制理论和人工智能控制理论等多种控制理论的方案和控制方法。本文首先建立了直

线一级倒立摆的数学模型, PID控制算法、系统轨迹/频率响应分析与校正、线性二次最优控制算法对模型进行仿真分析。

一、牛顿-欧拉方法建模

在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和 匀质杆组成的系统,如图1-1所示。

表1直线一级倒立摆系统的物理参数表 M m b l I F x 小车质量 摆杆质量 小车摩擦系数 摆杆转动轴心到杆质心的长度 摆杆惯量 加在小车上的力 小车位置 摆杆与垂直向上方向的夹角 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下) ? ?

图1 直线一级倒立摆模型

图1-2是系统中小车和摆杆的受力分析图。其中,N 和P 为小车与摆杆相

互作用力的水平和垂直方向的分量。

图2 小车及摆杆受力分析图

分析小车水平方向所受的合力,可以得到以下方程:

??x M???N (1) F?bxd(x?lsin?) (2) 2dt 由摆杆水平方向的受力进行分析可以得到下面等式: N?m即: N??cos??ml??2sin? (3) ??ml??m?x2 把这个等式代入(1)式中,就得到系统的第一个运动方程:

??cos??ml??sin??F (4) ??bx??ml?x (M?m)? 为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析, 可以得到下面方程:

P?mg?md(lcos?) (5) 2dt2??sin??ml??cos? (6) ? P?mg??ml 力矩平衡方程如下:

?? (7) ?Plsin??Nlcos??I? 注意:此方程中力矩的方向,由于?????,cos???cos?,sin???sin?,故等式前面有负号。合并这两个方程,约去 P 和N,得到第二个运动方程:

???mglsin???ml??cos? (8) x (I?ml)?2设?????,(?是摆杆与垂直向上方向之间的夹角),假设?与1(单位是弧