倒立摆实验报告.doc

倒立摆实验报告 机自82 组员：李宗泽 李航 刘凯 付荣 倒立摆与自动控制原理实验 一． 实验目的: 1.运用经典控制理论控制直线一级倒立摆,包括实际系统模型的建立、根轨迹分析和控制器设计、频率响应分析、PID 控制分析等内容. 2.运用现代控制理论中的线性最优控制LQR 方法实验控制倒立摆 3.学习运用模糊控制理论控制倒立摆系统 4.学习MATLAB工具软件在控制工程中的应用 5.掌握对实际系统进行建模的方法，熟悉利用MATLAB 对系统模型进行仿真，利用学习的控制理论对系统进行控制器的设计，并对系统进行实际控制实验，对实验结果进行观察和分析，非常直观的感受控制器的控制作用。 二. 实验设备 计算机及MATLAB.VC等相关软件 固高倒立摆系统的软件 固高一级直线倒立摆系统,包括运动卡和倒立摆实物 倒立摆相关安装工具 倒立摆系统介绍 倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合，其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，可以作为一个典型的控制对象对其进行研究。倒立摆系统作为控制理论研究中的一种比较理想的实验手段，为自动控制理论的教学、实验和科研构建一个良好的实验平台，以用来检验某种控制理论或方法的典型方案，促进了控制系统新理论、新思想的发展。由于控制理论的广泛应用，由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。 倒立摆已经由原来的直线一级倒立摆扩展出很多种类，典型的有直线倒立摆环形倒立摆，平面倒立摆和复合倒立摆等，本次实验采用的是直线一级倒立摆。 倒立摆的形式和结构各异，但所有的倒立摆都具有以下的特性: 1) 非线性2) 不确定性3) 耦合性4) 开环不稳定性5) 约束限制 倒立摆控制器的设计是倒立摆系统的核心内容，因为倒立摆是一个绝对不稳定的系统，为使其保持稳定并且可以承受一定的干扰，需要给系统设计控制器，本小组采用的控制方法有：PID 控制、双PID控制、LQR控制、模糊PID控制、纯模糊控制 四．直线一级倒立摆的物理模型： 系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入－输出关系。。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入－状态关系。，由于倒立摆本身是自不稳定的系统，实验建模存在一定的困难。但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。 下面我们采用牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型： 在忽略了空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图所示： 我们不妨做以下假设： M 小车质量 m 摆杆质量 b 小车摩擦系数 l 摆杆转动轴心到杆质心的长度 I 摆杆惯量 F 加在小车上的力 x 小车位置 φ 摆杆与垂直向上方向的夹角 θ 摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下） 图是系统中小车和摆杆的受力分析图。其中，N 和P 为小车与摆杆相互作用 力的水平和垂直方向的分量。 注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而 矢量方向定义如图所示，图示方向为矢量正方向。 分析小车水平方向所受的合力，可以得到以下方程： （3-1） 由摆杆水平方向的受力进行分析可以得到下面等式： (3-2) 即： (3-3) 把这个等式代入式(3-1)中，就得到系统的第一个运动方程： (3-4) 为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析， 可以得到下面方程： (3-5) (3-6) 力矩平衡方程如下： (3-7) 注意：此方程中力矩的方向，由l，故等式前面有负号。 合并这两个方程，约去P 和N，得到第二个运动方程：