控制系统课程设计---直线一级倒立摆控制器设计

控制系统课程设计---直线一级倒立摆控制器设计

H a r b i n I n s t i t u t e o f T e c h n o l o g y

课程设计说明书（论文）

课程名称：控制系统设计课程设计

设计题目：直线一级倒立摆控制器设计

院系：

班级：

设计者：

学号：

指导教师：罗晶周乃馨

设计时间：2013.9.2——2013.9.13

哈尔滨工业大学课程设计任务书

姓名：院（系）：英才学院

专业：班号：

任务起至日期：2013 年9 月 2 日至2013 年9 月13 日

课程设计题目：直线一级倒立摆控制器设计

已知技术参数和设计要求：

本课程设计的被控对象采用固高公司的直线一级倒立摆系统GIP-100-L。

系统内部各相关参数为：

M小车质量0.5 Kg ；m摆杆质量0.2 Kg ；b小车摩擦系数0.1 N/m/sec ；l摆杆转动轴心到杆质心的长度0.3 m ；I摆杆惯量0.006 kg*m*m ；T采样时间0.005

秒。

设计要求：

1．推导出系统的传递函数和状态空间方程。用Matlab 进行阶跃输入仿真，验证系统的稳定性。

2．设计PID控制器，使得当在小车上施加0.1N的脉冲信号时，闭环系统的响应指标为：

（1）稳定时间小于5秒；

（2）稳态时摆杆与垂直方向的夹角变化小于0.1 弧度。

3．设计状态空间极点配置控制器，使得当在小车上施加0.2m的阶跃信号时，闭环系统的响应指标为：（1）摆杆角度θ和小车位移x的稳定时间小于3秒

（2）x的上升时间小于1秒

（3）θ的超调量小于20度（0.35弧度）

（4）稳态误差小于2%。

工作量：

1. 建立直线一级倒立摆的线性化数学模型；

2. 倒立摆系统的PID控制器设计、MATLAB仿真及

实物调试；

3. 倒立摆系统的极点配置控制器设计、MATLAB仿

真及实物调试。

工作计划安排：

第3周（1）建立直线一级倒立摆的线性化数学模型；

（2）倒立摆系统的PID控制器设计、MATLAB 仿真；

（3）倒立摆系统的极点配置控制器设计、MATLAB仿真。

第4周（1）实物调试；

（2）撰写课程设计论文。

同组设计者及分工：

各项工作独立完成。

指导教师签字___________________

年月日

教研室主任意见：

教研室主任签字___________________

年月日

*注：此任务书由课程设计指导教师填写。

第一章直线一级倒立摆数学模型的推导及建立

1.1直线一阶倒立摆数学模型的推导

系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入－输出关系。这里面包括输入信号的设计选取，输出信号的精确检测，数学算法的研究等等内容。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入－状态关系。

对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用其中的牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型。

在忽略了空气阻力，各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统. 下图是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆水平和垂直方向的分量。

x

b

p

图1-1（a）小车隔离受力图（b）摆杆隔离

受力图

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

M : 小车质量 m：摆杆质量

b：小车摩擦系数 l：摆杆转动轴心到杆质心的长度

I：摆杆惯量 F：加在小车上的力

x：小车位置φ：摆杆与垂直向上方向的夹角

θ：摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）

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

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

=--

Mx F bx N

（1-1）

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

()2

2sin d N m x l dt θ=+ （1-2）

2cos sin N mx ml ml θθθθ=+- （1-3）

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

()2cos sin M m x bx ml ml F θθθθ+++-= （1-4）

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

()2

2cos d P mg m l dt θ-=- （1-5）

2sin cos P mg ml ml θθθθ-=+ （1-6）

力矩平衡方程如下：

sin cos Pl Nl I θθθ--= （1-7）

注意：此方程中力矩的方向，由于,cos cos ,sin sin θπφφθφθ=+=-=-，故等式前面有负号。

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

()22sin cos I ml mgl mlx θθθ++=- （1-8）

1.1.1微分方程模型

设=+θπφ（φ是摆杆与垂直向上方向之间的夹角），假设与1（单位是弧度）相比很小,即1φ

，则可以进行近似处理：2cos 1,sin ,()0d dt θθθφ=-=-=。用u 来代表被控对象的

输入力F ，线性化后两个运动方程如下：

()()2M m x bx ml u

I ml mgl mlx φφφ⎧++-=⎪⎨+-=⎪⎩ （1-9）

1.1.2传递函数

对以上微分方程组进行拉普拉斯变换，得到

()()22222()()()()()()()M m X s s bX s ml s s U s I ml s s mgl s mlX s s ⎧++-Φ=⎪⎨+Φ-Φ=⎪⎩

（1-10）