自动控制球杆系统实验指导书-2016

自动控制综合实验2 实验指导书

Part 1

球杆系统GBB1004

北京邮电大学自动化学院

林雪燕

2016.5.24

前言

自动控制是一门理论与实践并重的技术，在成功掌握了理论知识（经典控制、现代控制）的同时再配合做一些经典的自动控制实验，从而加深对自动控制的理解与掌握，为今后从事自动控制的设计和研究工作打下扎实的基础。

为了更好地配合理论教学，达到理论与实践完美的结合，将自动控制相关的实验独立设置成一门实验课：自动控制综合实验。自动控制理论实验主要目的是通过实验进一步理解自动控制理论的基本概念，熟悉和掌握控制系统的分析方法和设计方法，掌握常用工程软件使用，如MATLAB、LabVIEW 等。上学期开设的自动控制综合实验（1）主要内容为控制系统的Matlab/simulink 仿真和基于实验箱的硬件模拟，以电路系统为研究对象。本学期开始的自动控制综合实验（2）的内容是基于典型控制理论实验设备（球杆系统和倒立摆系统），熟悉和掌握控制系统的分析和设计方法。

球杆系统机械简单，结构紧凑，安全性高，采用智能伺服驱动模块和Windows 程序界面，可用于教学或科研。对于自动控制理论等课程来说，针对设备的非线性与不稳定性特点，设计有效的控制系统是项有意义的工作。球杆系统要完成的实验有：

实验一：小球位置的数据采集处理

实验二：球杆系统的PID法控制实验

三：球杆系统的根轨迹法控制实验

四：球杆系统的频率响应法控制

倒立摆是一个典型的不稳定系统，同时又具有多变量、非线性、强耦合的特性，是自动控制理论中的典型被控对象。运用控制手段可使之具有一定的稳定性和良好的性能。许多抽象的控制概念如控制系统的稳定性、可控性、系统收敛速度和系统抗干扰能力等，都可以通过倒立摆系统直观的表现出来。倒立摆系统要完成的实验有：

实验五：倒立摆的数学建模及稳定性分析

实验六：倒立摆的状态反馈控制实验七：

不同状态下状态反馈控制效果比较实验

八：倒立摆的LQR 控制

同学们完成实验后，要完成相应的实验报告，并及时提交。实验报告内容包含实验名称、实验目的、实验内容、实验要求、实验原理、实验设备及仪器、实验步骤、实验结果及分析、问题回答、心得体会、附上必要的实验原程序。

成绩评定：考勤10+实验过程表现40+实验报告50=100 分

图1 简介

球杆系统机械简单，结构紧凑，安全性高，采用智能伺服驱动模块和Windows 程序界面，可用于教学或科研。对于自动控制理论等课程来说，针对设备的非线性与不稳定性特点，设计有效的控制系统是项有意义的工作。

球杆系统主要由以下部分组成，如下图0-1所示：

机械部分(包含直流伺服电机和电源)：通过电机调整横杆的倾斜角，使小球稳定平衡在横杆的某一位置；

智能伺服驱动：控制箱内的IPM100模块通过RS-232接口与计算机通讯，完成控制任务；

计算机：在MatLab Simulink环境下设计控制算法，实现控制目标。

球杆系统采用电位计检测小球的位置，电位计安装在横杆上，小球位置对应的电压信号输送给IPM100智能驱动的AD转换器，如图0-2所示

图0-2 小球的位置信号采集原理

球杆系统的闭环控制系统结构图0-3如下：

图0-3 系统控制结构

直流马达通过一个减速皮带轮带动横杆运动，IPM100智能驱动器内部包一个PID 控制算法，用于控制电机的位置，PID控制器的参数已经调整，保证电机具有较快的响应并没有超调。

系统通过以下步骤来实现控制：

i. 通过RS232下载控制程序到智能伺服驱动器的板载内部寄存器中。

ii. 电机编码器的信号和小球的位置信号每隔一定时间反馈给系统，（伺服时间可设置，默认为5ms）

iii. 板载的DSP对下载的程序进行解码，然后计算根据反馈的位置信息和控制算法计算控制量。

iv. 计算得到的控制量被放大并通过IPM的电源驱动模块作用给电机。

v. 这样，通过控制电机的位置，使得小球在设定的位置保持平衡。

控制系统的流程图如图0-4所示：

图0-4 控制程序流程图

为了使小球稳定平衡在横杆的某一位置，首先应建立球杆系统的数学模型，然后对小球位置进行数据采集。控制量的设计方法有PID法、根轨迹法、和频率响应法。

2系统建模

1.1 球杆系统的数学模型

球杆系统机械结构原理图如图1-1：

图1-1 球杆系统机械结构

连线（连杆和同步带轮的连接点与齿轮中心的连线）和水平线的夹角为θ（θ的角度存在一定的限制，在最小和最大的范围之间），它作为连杆的输入，横杆的倾斜角α和θ之间的有如下的数学关系：

α=d

θ

L

（1）

角度θ和电机轴之间存在一个减速比n=4的同步带，控制器设计的任务是通过调整齿轮的角度θ，使得小球在某一位置平衡。

小球在横杆上滚动的加速度如下式：

J ..

++

⋅⋅

α- 2 =0 （2）

( m) r

R2

mg s i n m r(α)

其中：小球在横杆上的位置r为输出

已知小球的质量m = 0.11kg；小球的半径R = 0.015m；重力加速度g=9.8m/s2；横杆长L =0.4m；连杆和齿轮的连接点与齿轮中心的距离为d = 0.04m；小球的转动

惯量J =2mR

kg.m2。假设小球在横杆上的运动为滚动，且摩擦力可以忽略不计。5

因为期望角度α在0︒附近，因此可以在0附近对其进行线性化，得到近似的线性方程：

2=

.. mg

r =

J α=

( +m) R 2

mgd

θ

J

L( +m)

R 2

（3）

拉氏变换得：r (s)

=

mgd

⋅

1

0.7

2

(4)

θ(s) L(J +m) s s

R 2

球杆系统是一个典型的单输入单输出系统，其传递函数可以近似为一个两阶的

积分器。R(s)和θ（s)分别为系统输出（小球位置）和输入（齿轮角度）的拉氏变换。

开环系统的阶跃响应如图1-2 所示，可以看出，系统不稳定，需要对其实施闭环控制与添加校正器。

图1-2 球杆系统的开环响应

1.2 伺服系统的数学模型

图0-3中的直流伺服系统由电机、编码器和IPM100智能驱动组成，形成了内闭环，结构图如图1-3所示。

图1-3 闭环系统结构图设皮

带轮的减速比为n，因为La 很小，因此简化可以得到：