一级倒立摆控制系统设计

自动控制原理课程设计

基于双闭环PID控制的一阶倒立摆控制系统设计

一、设计目的

倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统,使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。

二、设计要求

倒立摆的设计要求是使摆杆尽快地达到一个平衡位置,并且使之没有

大的振荡和过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。实验参数自己选定,但要合理符合实际情况,控制方式为双PID控制,并利用 MATLAB进行仿真,并用simulink对相应的模块进行仿真。

三、设计原理

倒立摆控制系统的工作原理是:由轴角编码器测得小车的位置和摆杆相对垂直方向的角度,作为系统的两个输出量被反馈至控制计算机。计算机根据一定的控制算法,计算出空置量,并转化为相应的电压信号提供给驱动电路,以驱动直流力矩电机的运动,从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。

四、设计步骤

首先画出一阶倒立摆控制系统的原理方框图 一阶倒立摆控制系统示意图如图所示:

1

自动控制原理课程设计

分析工作原理,可以得出一阶倒立摆系统原理方框图:

一阶倒立摆控制系统动态结构图

下面的工作是根据结构框图,分析和解决各个环节的传递函数!

1.一阶倒立摆建模

在忽略了空气流动阻力,以及各种摩擦之后,可将倒立摆系统抽象成小车和匀质杆组成的系统,如下图所示,其中: M:小车质量 m:为摆杆质量 J:为摆杆惯量 F:加在小车上的力 x:小车位置

2

自动控制原理课程设计

θ:摆杆与垂直向上方向的夹角 l :摆杆转动轴心到杆质心的长度

根据牛顿运动定律以及刚体运动规律,可知: (1) 摆杆绕其重心的转动方程为

J??Fylsin??Fxlcos?..........(1) (2) 摆杆重心的运动方程为

d2Fx?m2(x?lsin?)..........(2)dt

d2Fy?mg?m2(lcos?).........(3)dt得

(3)小车水平方向上的运动为

d2xF?Fx?M2..........(4)

dt联列上述4个方程,可以得出

一阶倒立精确气模型:

?J?ml2?F?ml?J?ml2?sin?.?2?m2l2gsin?cos???x???J?ml2??M?m??m2l2cos2??mlcos?.F?m2l2sin?cos?.?2??M?m?mlgsin? ????2222mlcos??M?mJ?ml?????ml2式中J为摆杆的转动惯量:J?

3若只考虑θ在其工作点附近θ0=0附近(?10????10?)的细微变化,则可以近似认为:

?..(J?ml2)F?m2l2g?2????0?x?J(M?m)?Mml2?? ?sin??? ?..???(M?m)mlg??mlF?cos??1??J(M?m)?Mml2?若取小车质量M=2kg,摆杆质量m=1kg,摆杆长度2 l =1m,重力加速度取

3

联系客服:779662525#qq.com(#替换为@) 苏ICP备20003344号-4