单级倒立摆经典控制系统
单级倒立摆经典控制系统摘要：倒立摆控制系统虽然作为热门研究课题之一，但见于资料上的大多采用现代控制方法，本课题的目的就是要用经典的方法对单级倒立摆设计控制器进行探索。
本文以经典控制理论为基础，建立小车倒立摆系统的数学模型，使用PID控制法设计出确定参数(摆长和摆杆质量)下的控制器使系统稳定，并利用MATLAB软件进行仿真。
关键词：单级倒立摆；经典控制；数学模型；PID控制器；MATLAB 1绪论自动控制理论是研究自动控制共同规律的技术科学。
它的发展初期，是以反馈理论为基础的自动调节原理，并主要用于工业控制。
控制理论在几十年中，迅速经历了从经典理论到现代理论再到智能控制理论的阶段，并有众多的分支和研究发展方向。
1.1经典控制理论控制理论的发展，起于“经典控制理论”。
早期最有代表性的自动控制系统是18世纪的蒸汽机调速器。
20世纪前，主要集中在温度、压力、液位、转速等控制。
20世纪起，应用范围扩大到电压、电流的反馈控制，频率调节，锅炉控制，电机转速控制等。
二战期间，为设计和制造飞机及船用自动驾驶仪、火炮定位系统、雷达跟踪系统及其他基于反馈原理的军用装备，促进了自动控制理论的发展。
至二战结束时，经典控制理论形成以传递函数为基础的理论体系，主要研究单输入-单输出、线性定常系统的分析问题。
经典控制理论的研究对象是线性单输入单输出系统，用常系数微分方程来描述。
它包含利用各种曲线图的频率响应法和利用拉普拉斯变换求解微分方程的时域分析法。
这些方法现在仍是人们学习控制理论的入门之道。
1.2倒立摆1.2.1倒立摆的概念图1 一级倒立摆装置倒立摆是处于倒置不稳定状态，人为控制使其处于动态平衡的一种摆。
如杂技演员顶杆的物理机制可简化为一级倒立摆系统，是一个复杂、多变量、存在严重非线性、非自治不稳定系统。
常见的倒立摆系统一般由小车和摆杆两部分构成，其中摆杆可能是一级、两级甚至多级。
在复杂的倒立摆系统中，摆杆长度和质量均可变化。
据研究的目的和方法不同，又有悬挂式倒立摆、球平衡系统和平行式倒立摆等。
1.2.2研究倒立摆稳定性的意义倒立摆的研究具有重要的工程背景。
机器人行走就类似倒立摆系统。
从日常生活中所见到的任何重心在上、也是支点在下的控制问题，到空间飞行器和各类伺服云台的稳定，都和倒立摆系统的稳定控制有很大相似性，故对其稳定控制在实际中有很多用场，如海上钻井平台的稳定控制、卫星发射架的稳定控制、火箭姿态控制、飞机安全着陆、化工过程控制等。
2单级倒立摆的数学模型2.1模型的推导原理建立控制系统的数学模型有两种基本方法。
其一，对系统各部分的运动机理进行分析，根据它们所依据的物理规律或化学规律分别列写相应的运动方程，合在一起便成为描述整个系统的方程。
其二，人为地给系统施加某种测试信号，记录其输出响应，并用适当的数学模型去逼近。
主要用于系统运动机理复杂因而不便分析或不可能分析的情况。
系统的建模原则：1、建模之前，要全面了解系统的自然特征和运动机理，明确研究目的和准确性要求，选择合适的分析方法。
2、按照所选分析法，确定相应的数学模型的形式；3、根据允许的误差范围，进行准确性考虑，然后建立尽量简化的合理的数学模型。
倒立摆的形状较为规则，而且是一个绝对不稳定系统，无法通过测量频率特性方法获取其数学模型。
故适合用数学工具进行理论推倒。
2.2单级倒立摆系统描述小车—倒立摆系统是各种控制理论的研究对象。
只要一提小车—倒立摆系统，一般均认为其数学模型也已经定型。
事实上，小车—倒立摆的数学模型与驱动系统有关，常见到的模型只是对应于直流电机的情况，如果执行机构是交流伺服电机，就不是这个模型了。
本文主要分析由直流电机驱动的小车—倒立摆系统。
小车倒立摆系统是检验控制方式好坏的一个典型对象，其特点是高阶次、不稳定、非线性、强耦合，只有采取有效的控制方式才能稳定控制。
图2 单级倒立摆系统的原理图图中u是施加于小车的水平方向的作用力，x是小车的位移，θ是摆的倾斜角。
若不给小车施加控制力，倒摆会向左或向右倾斜，控制的目的是当倒摆出现偏角时，在水平方向上给小车以作用力，通过小车的水平运动，使倒摆保持在垂直的位置。
即控制系统的状态参数，以保持摆的倒立稳定。
2.3单级倒立摆系统数学建模为了建立倒立摆系统的数学模型，先作如下假设:①倒立摆与摆杆均为匀质刚体。
②可忽略摆与载体，载体与外界的摩擦，即忽略摆轴、轮轴、轮与接触面之间的摩擦力等。
2.3.1结构参数倒立摆是不稳定的，如果没有适当的控制力作用在它的上面，它将随时可能向任何方向倾倒。
这里只考虑二维问题，即认为倒立摆只在图2所示平面内运动。
控制力u作用于小车上。
摆杆长度为2L，质量为m，小车的质量为M，小车瞬时位移为x，摆杆瞬时位置为（x+2L*sinθ），在外力的作用下，系统产生运动。
假设摆杆的重心位于其几何中心。
设输入为作用力u，输出为摆角θ。
2.3.2系统的运动方程图3 小车沿x轴的受力分析图4 摆的受力分析小车沿x轴方向的受力分析如图4所示，根据牛顿第二定律得方程⑴⑵⑶⑷为车载倒立摆系统运动方程组。
因为含有项，所以为非线性微分方程组。
中间变量不易相消。
2.4单级倒立摆系统模型的线性化处理及传递函数3单级倒立摆控制系统原理3.1线性系经统的校正方法所谓校正，就是在系统中加入一些其参数可以根据需要而改变的机构或装置，使系统整个特性发生变化，从而满足给定的各项性能指标。
按照校正装置在系统中的连接方式，控制系统校正方式可分为串联校正、反馈校正和复合校正四种。
根据被控对象及技术指标要求这里采用串联校正。
3.2基本控制定律确定校正装置的具体形式时，应先了解校正装置所提供的控制规律，以便选择相应的元件。
包含校正装置在内的控制器，常常采用比例、微分、积分等基本控制规律，或者采用这些基本控制规律的某种组合，如比例－微分、比例－积分、比例－积分－微分等组合控制规律，以实现对被控对象的有效控制。
比例--微分—微分（P ID）控制定律具有比例—积分—微分控制规律的控制器，称PID控制器。
这种组合具有三种基本控制规律各自的特点，其运动方程为当利用PID控制器进行串联校正时，除可使系统的型别提高一级外，还将提供两个负实零点。
与PI控制器相比，除了同样具有提高系统的稳态性能的优点外，还多提供了一个负实零点，从而在提高系统动态性能方面，具有更大的优越性。
因此，在工业过程控制系统中，广泛使用PID控制器。
PID控制器各部分参数的选择，在系统现场调试中最后确定。
通常，应使I部分发生在系统频率特性的低频段，以提高系统的稳态性能；而使D部分发生在系统频率特性的中频段，以改善系统的动态性能。
本系统采用即为PID控制器。
3.3PID控制3.3.1.1PID控制器的结构所有的PID控制器都有可以分解成给定值控制单元，PID作用单元及手动/自动转换单元等三个主要单元，如图6所示。
图中，给定值单元①接收工业控制过程的测量量c，以及控制装置的给定值。
PID作用单元②接受给定值控制单元产生的误差信号e，并按给定控制律算出闭环控制信号。
手动/自动单元③在“自动A位置时，将PID单元的输出信号送入工业过程，此时工业过程在闭环中受到控制；而在“手动M位置时，把用户直接在控制器上调整手动输出信号送至工业过程，于是系统采用开环控制方式。
图5 PID控制器原理性结构3.3.1.2PID控制器的使用实用PID控制器的传递函数可以表示为PID单元的原理电路如图7所示。
图6 PID单元原理电路4单级倒立摆的系统控制器设计4.1系统的控制校正设计控制系统的目的是使系统动态稳定，即保持倒立摆在垂直的位置，使小车在外力作用下其位移以较小的误差跟随输入的变化。
由于系统的动态响应主要是由它的极点位置决定的，而假如系统是状态完全能控的，即可使系统得到良好的动态性能。
我们在第2.4节中对单级倒立摆系统模型的进行了线性化并推导出了其传递函数。
本课题将采用PID控制法为系统设计控制器。
设原系统小车的质量M＝2.00kg，摆的质量m＝0.20kg，摆长2L=0.80m，重力加速度4.2利用MATLAB的系统仿真进入MATLAB的工作环境之后，通过键盘输入MATLAB命令，便可以执行相应的操作了，这与DOS的操作十分接近。
如，通过下面的MATLAB程序即可获得G (s)的单位阶跃响应及极零点分布。
（见图7）图7 G (s)的单位阶跃响应及极零点分布>> s=tf('s') Transfer function:s>> sys=tf(-1，[1 0 29.6964])Transfer function:-1----------s^2 + 29.7>>step(sys)>>pzmap(sys)4.3仿真结果的修正与分析本实验采用MATLAB软件进行仿真实验，进一步验证了PID控制器中各个参数对系统的稳定性和动态性能的影响，在大量的仿真结果中进行比较和挑选，同时根据调节时间<3s的设计要求，最后确定PID 控制器的各参数分别为：微分时间系数=1，积分时间系数T =1，比例系数K =20。
则系统的闭环传递函数为（系统的闭环传递函数的单位阶跃响应为图8）：20 s^2 + 20 s + 20------------------------s^3 + 23 s^2 + 25 s + 20图8 的单位阶跃响应结论倒立摆系统的控制研究长期以来被认为是控制理论极其应用领域里引起人们极大兴趣的问题。
它是检验各种控制理论和方法的有效性的著名实验装置，作为一个高阶、非线性、不稳定系统，倒立摆的稳定控制相当困难，对该领域的学者来说是一个极具挑战性的难题。
本文以经典控制理论为基础，建立了小车倒立摆系统的数学模型，使用PID控制法设计出确定参数下的控制器使系统稳定。
本实验采用MATLAB软件进行仿真实验，进一步验证了PID控制器中各个参数对系统的稳定性和动态性能的影响，在大量的仿真结果中进行比较和挑选，同时根据调节时间<3s的设计要求，最后确定PID控制器的各参数值，通过MATLAB软件的仿真可知，单级倒立摆的经典控制可以实现。
一级倒立摆的模糊控制
一级倒立摆的模糊控制4.1倒立摆控制方法的研究倒立摆一般有两种起始状态的控制。
一种是在摆杆自然下垂，竖直向下为起始状态，通过不断的摆动,最终使其稳定在竖直向上的不稳定点,这种控制叫做起摆稳定控制,也即DOWN-UP控制；另一种是用手提起摆杆,在不稳定平衡点处开始实行控制,称作稳定控制,也即UP-UP控制。
同时倒立摆系统也是一个复杂的、非线性的、不稳定的高阶系统。
倒立摆的控制一直是控制理论及应用的典型课题。
在研究倒立摆这类多变量非线性系统的模糊控制时，一个难题就是规则爆炸(RuleEPxofsino)，比如一级倒立摆的控制涉及的状态变量共有4个，每个变量的论域作7个模糊集的模糊划分，这样，完备的推理规则库会包含74=2401个推理规则;而对于二级倒立摆有6个状态变量，推理规则会达到76=117649，显然如此多的规则是不可能实现的。
为了解决这个问题，张乃尧等提出双闭环的倒立摆模糊控制方案，内环控制倒立摆的角度，外环控制倒立摆的位移。
范醒哲等人将这一方法推广到三级倒立摆控制系统中，并提出两种模糊串级控制方案，用来解决倒立摆这类多变量系统模糊控制时的规则爆炸问题。
shulinagLei和RezaLnagari应用分级思想，将θθ,,,xx4个状态变量分成两个子系统，分别用两个模糊控制器控制，然后来协调子系统之间的相互作用。
本文模仿人类简化问题的思路，将单一的复杂控制策略转化为多级简单控制策略嵌套，通过分离变量的方法设计末控制器。
4.2倒立摆仿真的研究在第二章建立了一级倒立摆的数学模型，推导出倒立摆近似线性状态方程并分析了倒立摆系统的能控性、能观性。
在此基础上，第三章详细讨论了模糊控制倒立摆的方法，模糊控制器的设计方法，证明了利用模糊策略控制倒立摆系统是可行的。
本章是将在上面几章的基础上，用Matlab和Simulink工具进行一级倒立摆模糊控制系统的仿真研究。
Simulink是Matlab最重要的组件之一，它提供一个动态系统建模、仿真和综合分析的集成环境。
电气系统综合设计实验报告直线一级倒立摆控制系统设计
电气控制系统设计——直线一级倒立摆控制系统设计学院轮机工程学院班级电气1111姓名李杰学号 36姓名韩学建学号 35成绩指导老师肖龙海2014 年 12 月 25 日小组成员与分工：韩学建主要任务：二阶系统建模与性能分析,二阶控制器的设计,二阶系统的数字仿真与调试,二阶系统的实物仿真与调试;二阶状态观测器的数字仿真与调试,二阶状态观测器的实物仿真与调试;李杰主要任务：四阶系统建模与性能分析,四阶控制器的设计,四阶系统的数字仿真与调试,四阶系统的实物仿真与调试;四阶状态观测器的数字仿真与调试,四阶状态观测器的实物仿真与调试;前言倒立摆系统是非线性、强耦合、多变量和自然不稳定的系统,倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究;倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展;本报告通过设计二阶、四阶两种倒立摆控制器来加深对实际系统进行建模方法的了解和掌握随动控制系统设计的一般步骤及方法;熟悉倒立摆系统的组成及基本结构并利用MATLAB对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,研究调节器参数对系统动态性能的影响,非常直观的了解控制器的控制作用;目录第一章设计的目的、任务及要求倒立摆系统的基本结构 (4)设计的目的 (4)设计的基本任务 (4)设计的要求 (4)设计的步骤 (5)第二章一级倒立摆建模及性能分析微分方程的推导 (5)系统的稳定性和能控能观性分析 (11)二阶的能观性、能控性分析 (13)四阶的能观性、能控性分析 (18)第三章倒立摆系统二阶控制器、状态观测器的设计与调试设计的要求 (22)极点配置 (22)控制器仿真设计与调试 (23)状态观测器仿真设计与调试 (28)第四章倒立摆系统四阶控制器、状态观测器的设计与调试设计的要求 (26)极点配置 (26)控制器仿真设计与调试 (27)状态观测器仿真设计与调试 (28)心得体会 (31)参考文献 (31)第一章设计的目的、任务及要求倒立摆系统的基本结构与工作原理图倒立摆系统硬件框图图倒立摆系统工作原理框图倒立摆系统通过计算机、I/O卡、伺服系统、倒立摆本体和光电码盘反馈测量元件组成一个闭环系统;以直线一级倒立摆为例,其工作原理框图如图所示;图中光电码盘1由伺服电机自带,小车的位移可以根据该码盘的反馈通过换算获得,速度信号可以通过对位移的差分得到;各个摆杆的角度由光电码盘2测量并直接反馈到I/O卡,而角速度信号可以通过对角度的差分得到;计算机从I/O卡实时读取数据,确定控制决策电机的输出力矩,并发给I/O卡;I/O卡经过电控箱内部电路产生相应的控制量,驱动电机转动,使小车按控制要求进行运动,以达到控制目的;实验过程中需要了解倒立摆装置基本结构;了解编码盘、行程开关等的基本工作原理;进行行程开关、编码盘和电机基本测试;设计的目的本设计要求我们针对设计要求,利用课堂所学知识及实验室实测来的系统数据采用工程设计法进行一级直线倒立摆控制系统设计;绘制原理图,同时在实验室进行实验检验设计结果,分析数据,编写设计报告;目的是使学生掌握随动控制系统设计的一般步骤及方法;设计的基本任务本课程设计的被控对象采用固高科技生产的GLIP2001一级直线倒立摆;通过设计与调试使学生能够：1熟悉倒立摆系统的组成及其基本结构；2掌握通过解析法建立系统数学模型及进行工作点附近线性化的方法；3掌握系统性能的计算机辅助分析；4掌握系统控制器的设计与仿真；5研究调节器参数对系统动态性能的影响;设计的要求1.熟悉倒立摆系统结构,熟悉倒立摆装置的基本使用方法；2.建立系统的数学模型,并在工作点附近线性化；3.分析系统的稳定性、频域性能、能控性与能观性；4.采用状态空间的极点配置法设计控制器,要求系统调节时间ts<=3s,阻尼比ξ>= and ξ<=1;实验步骤1.倒立摆系统基本结构分析2.对象的建模3..系统性能分析4.控制器设计与调试5.设计报告的撰写第二章一级倒立摆建模及性能分析系统建模可以分为两种：机理建模和实验建模;实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出, 应用数学手段建立起系统的输入－输出关系;这里面包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容;机理建模就是在了解研究对象的运动规律基础上,通过物理、化学的知识和数学手段建立起系统内部的输入－状态关系;对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难;但是忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程;下面采用牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型;微分方程的推导在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图所示;我们不妨做以下假设：M 小车质量m 摆杆质量b 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量 F 加在小车上的力x 小车位置φ摆杆与垂直向上方向的夹角θ摆杆与垂直向下方向的夹角考虑到摆杆初始位置为竖直向下图是系统中小车和摆杆的受力分析图;其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量;注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向;分析小车水平方向所受的合力,可以得到以下方程：①由摆杆水平方向的受力进行分析可以得到下面等式：②即：③把这个等式代入①式中,就得到系统的第一个运动方程④为了推出系统的第二个运动方程,对摆杆垂直方向上的合力进行分析,可以得到下面方程：⑤⑥力矩平衡方程如下：⑦注意：此方程中力矩的方向,由于θ= π+φ,cosφ= -cosθ,sinφ= -sinθ,故等式前面有负号; 合并这两个方程,约去P 和N ,得到第二个运动方程：⑧设θ=π+φφ是摆杆与垂直向上方向之间的夹角,假设φ与1单位是弧度相比很小,即φ<<1,则可以进行近似处理：用u 来代表被控对象的输入力F ,线性化后两个运动方程如下：⑨对式3-9进行拉普拉斯变换,得到⑩注意：推导传递函数时假设初始条件为0;由于输出为角度φ,求解方程组的第一个方程,可以得到：⑾⑿如果令则有⒀把上式代入方程组的第二个方程,得到：⒁整理后得到传递函数：⒂其中,该系统状态空间方程为：⒃方程组对解代数方程,得到解如下：⒄整理后得到系统状态空间方程：⒅由9的第一个方程为对于质量均匀分布的摆杆有：于是可以得到：化简得到：⒆⒇以小车加速度为输入的系统状态空间方程：稳定性分析P=polyA;r=rootsP;ii=findrealr>0;n=lengthii;ifn>0disp'不稳定';elsedisp'稳定';end不稳定由此得到系统在未加控制器之前是发散的,不稳定的能控能观性分析A= 0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B= 0 1 0 3';C= 1 0 0 0;0 0 1 0;D= 0 0 ';>> n=4;Uc=ctrbA,B;Vo=obsvA,C;>> ifrankUc==nifrankVo==ndisp'系统状态即能控又能观'else disp'系统状态即能控,但不能观'endelse ifrankVo==ndisp'系统状态能观,但不能控'else disp'系统状态不能控,但也不能观' endend系统状态即能控又能观二阶的能观性、能控性分析>> A=0 1; 0;>> B=0 3';>> C=0 0 ;1 0;>> D=0;二阶能控性分析：>> M=ctrbA,BM =0 33 0>> rankMans =2说明系统是能控的二阶能观性分析：>> N=obsvA,CN =0 11 0>> rankNans =2说明系统是能观的四阶的能观性、能控性>> A=0 1 0 0; 0 0 0 0;0 0 0 1;0 0 0;;>> B=0 1 0 3';>> C= 1 0 0 0;0 0 1 0;>> D=0 0';四阶能控性分析:>> M=ctrbA,BM =0 0 00 0 00 00 0>> rankMans =4说明系统是能控的四阶能观性分析：>> N=obsvA,CN =0 0 00 0 00 0 00 0 00 0 0 00 0 00 0 0 00 0 0>> rankNans =4说明系统是能观的第三章倒立摆系统二阶控制器的设计设计的要求建立以X’’为输入,Φ与Φ’为状态变量,y为输出的模型分析系统的稳定性,能控能观性设计状态反馈控制器进行极点配置,是系统ξ>= ts<=3s极点配置取ξ=,Ts=；则Wn=,极点为±利用MATLAB进行计算:clear;T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1; 0;B=0;3;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=S1,S2;K=placeA,B,P则：K0=,K1=;控制器的仿真测试与调试图二阶系统结构图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,K值为反馈矩阵,输出为角度的波形图仿真波形图：取 &= 极点为：Wn=则 K0= K1= 图仿真结果波形图有次图可得加入控制器之后系统可以稳定,可见控制器的设计是合理的硬件调试硬件调试结构图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,加入Л模块纠正反馈角度符号通过调试K值,当K取的时候,可使仿真结果较稳定;从摆杆的角度可以看出,角度可以稳定下来,施加一干扰后,摆杆可以很快恢复稳定;状态观测器的仿真测试与调试图二阶状态观测器数字仿真图以小车加速度为输入,摆杆偏移角度和角速度为状态变量的模型,K值为反馈矩阵,输出为角度的波形图仿真波形图：取 &= 极点为：Wn=则 K0= K1= 图仿真结果波形图反馈矩阵G的求法T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1; 0;B=0;3;C=1 0;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=S1,S2;OP=5P;G=placeA',C',OPG=实物调试由图可知,施加扰动后摆杆能很快恢复,符合系统要求;第四章倒立摆系统四阶控制器的设计设计要求根据设计要求,确定系统闭环极点,设计状态反馈控制器,并进行仿真、调试验证;极点配置取 &= T= Wn= 极点为：±；-20±利用MATLAB进行计算:T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B=0;1;0;3;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=,-20+,S1,S2;K=placeA,B,Pk0=,k1=,k2= ,k3=;则K=控制器的仿真测试与调试图四阶系统仿真结构图以小车加速度为输入,摆杆角度、角速度、小车位移、加速度为状态变量,上半部分为位移输出,下半部分为角度输出仿真结果：位移：角度：实物调试：图硬件调试结构图将K1、K2、K3、K4合并后反馈作用系统,系统为单输入双输出四阶一级倒立摆状态空间极点配置实时控制结果平衡时上为位移,下位角度直线一级倒立摆状态空间极点配置实时控制结果施加干扰上为位移,下位角度状态观测器仿真设计与调试图四阶状态观测器数字仿真图四阶系统仿真结构图以小车加速度为输入,摆杆角度、角速度、小车位移、加速度为状态变量,上半部分为位移输出,下半部分为角度输出反馈矩阵G的求法T=input'T=';zeta=input'zeta=';Wn=4/Tzeta;A=0 1 0 0;0 0 0 0;0 0 0 1;0 0 0;B=0;1;0;3;C=1 0 0 0;0 0 1 0;S1=-zetaWn-Wnsqrtzeta^2-1;S2=-zetaWn+Wnsqrtzeta^2-1;P=,-10+,S1,S2;OP=3P;G=placeA',C',OP'G =实物调试反馈矩阵G和增益矩阵K分别调用matlab程序即可实物仿真与结果心得体会通过此次课程设计,使我更加扎实的掌握了有关MATLAB方面的知识,在设计过程中虽然遇到了一些问题,但经过一次又一次的思考,一遍又一遍的检查终于找出了原因所在,也暴露出了前期我在这方面的知识欠缺和经验不足;实践出真知,通过亲自动手制作,使我们掌握的知识不再是纸上谈兵;课程设计诚然是一门专业课,给我很多专业知识以及专业技能上的提升,同时又是一门讲道课,一门辩思课,给了我许多道,给了我很多思,给了我莫大的空间;同时,设计让我感触很深;使我对抽象的理论有了具体的认识;通过这次课程设计,我掌握了倒立摆装置的识别和测试；熟悉了控制系统的设计原理；了解了现代控制理论的设计方法；以及如何提高倒立摆系统的性能等等,掌握了MATLAB、simulink的使用方法和技术,通过查询资料,对所学知识有了很多新的认识;自己写主要参考文献：1.夏德玲、翁贻方,自动控制理论．北京,北京工业大学出版社,2006年1月2.刘豹、唐万生,现代控制理论．北京,机械工业出版社,2006年6月3.李国勇、谢克明,计算机仿真技术与CAD．北京,电子工业出版社,2009年1月4.Googol Technology直线倒立摆系统GLIP系列安装与使用手册固高科技。
倒立摆系统的主要控制方法
倒立摆系统的主要控制方法控制理论自诞生之日起至今主要经历了经典控制理论、现代控制理论和人工智能控制理论等几个阶段。
伴随着控制理论的不断发展，对倒立摆的控制也出现了采用经典控制理论、现代控制理论和人工智能控制理论等多种控制理论的方案和控制方法，并均实现了实物实验的成功。
经典控制理论提供了解决单输入单输出系统的控制方法。
利用牛顿第二运动定律对倒立摆系统进行力学分析，建立小车在水平运动和摆杆在垂直位置上的动力学方程，并进行合理的线性化，拉氏变换，得出系统的传递函数，从而得到零极点分布情况。
根据使闭环系统能稳定工作的思想设计控制器，需引入适当的反馈，使闭环系统特征方程的根都位于左半平面上。
用经典控制理论的频域法设计非最小相位系统的控制器并不需要十分精确的被控对象的数学模型，因为只要控制器使系统具有充分大的相位裕量就能获得系统参数在很宽范围内的稳定性。
文献介绍了黄永宜选用经典控制理论的频域法实现了单级倒立摆的稳定控制。
现代控制理论采用状态空间法，把经典控制理论中的高阶定常微分方程转换为一阶微分方程组，用来描述系统的动态过程。
这种方法可以解决多输入多输出问题，系统可以是线性的、定常的，也可以是非线性的、时变的。
与经典控制理论相比，现代控制理论具有较强的系统性，从分析、设计、到综合都有比较完整的理论和方法。
利用H∞状态反馈方法、极点配置法和最优状态调节器方法都可以实现对二级倒立摆的控制。
基于H∞状态反馈方法的二级倒立摆控制方案：针对倒立摆系统具体的有参数摄动及干扰，构造状态反馈控制u Kx=使不确定闭环系统是具有干扰衰减度γ的H∞鲁棒最优系统，且性能指标()()()T TJ x t Qx t u Ru t dt∞⎡⎤=+⎣⎦⎰具有最小的上界。
利用极点配置法和最优线性二次状态调节器LQR和线性二次输出调节器LQR控制倒立摆的方法。
使用极点配置法首先需要建立系统的线性模型，然后确定系统的闭环极点，再通过Ackerman公式算出对应的反馈增益矩阵Kf。
一级倒立摆【控制专区】系统设计
基于双闭环PID控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控制方法的典型例子。
设计一个倒立摆的控制系统，使倒立摆这样一个不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足各种性能指标的稳定系统。
二、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡和过大的角度和速度。
当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。
实验参数自己选定，但要合理符合实际情况，控制方式为双PID控制，并利用MATLAB进行仿真，并用simulink对相应的模块进行仿真。
三、设计原理倒立摆控制系统的工作原理是：由轴角编码器测得小车的位置和摆杆相对垂直方向的角度，作为系统的两个输出量被反馈至控制计算机。
计算机根据一定的控制算法，计算出空置量，并转化为相应的电压信号提供给驱动电路，以驱动直流力矩电机的运动，从而通过牵引机构带动小车的移动来控制摆杆和保持平衡。
四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示：分析工作原理，可以得出一阶倒立摆系统原理方框图：一阶倒立摆控制系统动态结构图下面的工作是根据结构框图，分析和解决各个环节的传递函数！1.一阶倒立摆建模在忽略了空气流动阻力，以及各种摩擦之后，可将倒立摆系统抽象成小车和匀质杆组成的系统，如下图所示，其中： M ：小车质量 m ：为摆杆质量 J ：为摆杆惯量 F ：加在小车上的力 x ：小车位置θ：摆杆与垂直向上方向的夹角 l ：摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律，可知： （1） 摆杆绕其重心的转动方程为（2） 摆杆重心的运动方程为得sin cos ..........(1)y x J F l F l θθθ=-2222(sin ) (2)(cos ) (3)x y d F m x l d td F mg m l d t θθ=+=-（3）小车水平方向上的运动为22..........(4)x d xF F M d t-=联列上述4个方程，可以得出一阶倒立精确气模型：()()()()()()()2222222222222222sin .sin cos cos cos .sin cos .lg sin cos J ml F ml J ml m l g x J ml M m m l ml F m l M m m m l M m J ml θθθθθθθθθθθθ⎧+++-⎪=++-⎪⎨+-+⎪=⎪-++⎩式中J 为摆杆的转动惯量：32ml J =若只考虑θ在其工作点附近θ0=0附近（︒︒≤≤-1010θ）的细微变化，则可以近似认为：⎪⎩⎪⎨⎧≈≈≈1cos sin 02θθθθ ⎪⎪⎩⎪⎪⎨⎧++-+=++-+=2..2222..)(lg )()()(Mml m M J mlF m m M Mml m M J g l m F ml J x θθθ 若取小车质量M=2kg,摆杆质量m=1kg,摆杆长度2 l =1m,重力加速度取g=2/10s m ,则可以得 一阶倒立摆简化模型：....0.44 3.330.412x F F θθθ⎧=-⎪⎨⎪=-+⎩即 G 1(s)= ; G 2(s)=一阶倒立摆环节问题解决！2.电动机驱动器选用日本松下电工MSMA021型小惯量交流伺服电动机，其有关参数如下：222()0.4()12() 1.110()s F s s x s s s s θθ-⎧=⎪-⎪⎨-+⎪=⎪⎩驱动电压：U=0~100V 额定功率：PN=200W 额定转速：n=3000r/min 转动惯量：J=3×10-6kg.m2 额定转矩：TN=0.64Nm 最大转矩：TM=1.91Nm 电磁时间常数：Tl=0.001s 电机时间常数：TM=0.003s经传动机构变速后输出的拖动力为：F=0~16N ；与其配套的驱动器为：MSDA021A1A ，控制电压：UDA=0~±10V 。
单级倒立摆控制系统的稳定性算法设计
单级倒立摆控制系统的稳定性算法设计
倒立摆是日常生活中许多重心在上、支点在下的控制问题的抽象模型，本身是一种自然不稳定体，它在控制过程中能有效地反映控制中许多抽象而关键的问题，如系统的非线性、可控性、鲁棒性等问题。
对倒立摆系统的控制就是使小车以及摆杆尽快地达到预期的平衡位置，而且还要使它们不会有太强的振荡幅度、速度以及角速度，当倒立摆系统达到期望位置后，系统能克服一定范围的扰动而保持平衡。
作为一种控制装置，它具有形象直观、结构简单、便于模拟实现多种不同控制方法的特点，作为一个被控对象它是一个高阶次、非线性、多变量、强耦合、不稳定的快速系统，只有采取行之有效的方法才能使它的稳定效果明了，因此对倒立摆的研究也成为控制理论中经久不衰的研究课题。
1 一级倒立摆系统的数学模型
对于倒立摆系统来说，如果忽略了空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成沿着光滑导轨运动的小车和通过轴承连接的匀质摆杆组成，如
倒立摆控制系统数学模型的建立方法一般有利用牛顿力学的分析方法和分析力学中的拉格朗日方程建模两种。
本文采用的是拉格朗日方程建模。
一级倒立摆系统的拉格朗日方程应为：
式中：L 是拉格朗日算子;V 是系统动能;G 是系统势能。
式中：D 是系统耗散能;fi 为系统在第i 个广义坐标上的外力。
一级倒立摆系统的总动能为：。
基于stm32的单级旋转倒立摆控制系统的设计与实
基于stm32的单级旋转倒立摆控制系统的设计与实现摘要本文对单级旋转倒立摆的控制系统进行了研究，提出了以STM32F103为核心的控制器设计，在控制策略上采用经典控制理论PID 的控制算法，实现对单级旋转倒立摆旋转臂及摆杆的同时闭环控制，通过传感器采集摆杆的状态数据，实时调整直流电机的转向和转速，以调整摆臂的角度，使摆杆恢复到动态平衡状态。
在非平衡状态下，通过传感器的实时检测，能够通过功能键设计，使摆杆能稳定到一定的角度。
最终测试结果表明系统控制策略有效。
关键词：STM32F103；直流减速电机；增量式PID1引 言倒立摆控制系统是自动控制理论的重要研究平台，可对应于火箭垂直发射控制技术，因此对它的研究具有重大的实践意义和价值。
目前对倒立摆的研究主要分为系统力学分析及建模，控制算法及仿真，而对实现手段少有研究。
文章讨论了以STM32为核心的倒立摆控制器的设计与实现，它实现了经典双回路PID 控制算法对旋转单级倒立摆的控制策略。
2 方案设计与论证2.1总体方案描述整个系统分为系统模块、编码器模块、电机驱动模块、电机模块、电源模块、键盘模块、显示模块。
各模块的系统框图如图1.1所示。
图 1.1 系统框图编码器模块键盘模块电机模块电机驱动模块显示模块控制模块2.2方案比较与选择2.2.1芯片控制模块方案一：采用传统的51系列单片机。
传统的51单片机为8位机，价格便宜，控制简单，但是运算速度慢，片内资源少，存储容量小，难以存储大体积的程序和实现快速精准的反应控制。
并且受时钟限制，计时精度不高，外围电路也增加了系统的不可靠性。
方案二: 采用stm32f103单片机stm32f103单片机，具有功能强大、效率高的指令系统，以及高性能模拟技术及丰富的外围模块。
方便高效的开发环境使操作更加简便，低功耗是其它类单片机难以比拟的，集成度较高，编程相对简单。
综上，选择了性能跟好的stm32f103单片机。
2.2.2电机选择方案一：普通直流伺服电机普通直流伺服电机有价格低使用简单等优点，但其扭矩较小，可控性差，此系统要求控制精度高速度快，直流电机则不能满足要求。
单级倒立摆系统建模与控制器设计
得：
状态空间表达式
单级倒立摆系统的模型分析 根据小车质量，摆杆质量，摆杆转动轴心到杆质心的长度和 摆杆质量的具体数值，用Matlab 求出系统的状态空间方程 各矩阵。
程序1.M = 0.5; m = 0.2; I= 0.006; g = 9.8; l = 0.3; A=[0 1 0 0 0 0 3*M*g/(4*M+m) 0 00 0 1 0 0 3*(M+m)*g/((4*M+m)*l) 0]; C=[1 0 0 0 B=[0 0 0 1 0]; 4/(4*M+m) D=[0 0 0]; 3/((4*M+m)*l)];
摆杆不受外力干扰但是摆杆有一个小的初始偏角 程序2
系统开环初值响应曲线
由系统的开环初值响应曲线可知，系统是不稳定 的，这与我们的经验是相符合的。
摆杆初始位置在竖直状态，但是小车收到一个脉 冲干扰的情况。MATLAB程序如下：
系统开环脉冲响应曲线
由系统的开环脉冲干扰响应曲线可知， 系统是不稳定的，这与我们的经验也 是相符合的。
显然，因为系统有一个特征值为正实数5.5841， 故系统是不稳定的。
单级倒立摆系统的极点配置控制器设计
单级倒立摆系统控制器设计的目标 单级倒立摆系统控制器设计的目标是：通过对小 车的左右移动使得摆杆保持在竖直的位置。且对 于小车所给的阶跃输入信号，满足如下设计指标：
1、小车位置x和摆杆角度θ的稳定时间小于5秒； 2、位置x的上升时间小于0.5秒； 3、摆杆角度的超调量小于20度（0.35弧度）。
总结与收获
通过对单级倒立摆的建模与仿真学到了一 下知识
1、首先要将现实中系统转化相应的物理结构 2、充分掌握建立状态空间方程的过程 3、了解配置极点控制器以及PID控制器的方法 4、对MATLAB软件有了一个初步功能的了解
单级移动倒立摆建模及控制器设计matlab
单级移动倒立摆建模及控制器设计matlab 单级移动倒立摆是一种常见的控制系统模型，它在机器人控制、自动驾驶等领域有着广泛的应用。
本文将介绍如何使用MATLAB进行单级移动倒立摆的建模和控制器设计。
首先，我们需要了解单级移动倒立摆的基本原理。
单级移动倒立摆由一个垂直的杆和一个可以在水平方向上移动的小车组成。
小车上有一个可以旋转的杆，杆的一端连接着小车，另一端有一个质量块。
通过控制小车的位置和杆的角度，我们可以实现倒立摆的平衡。
接下来，我们开始建立单级移动倒立摆的数学模型。
首先，我们需要定义系统的状态变量。
在这个模型中，我们可以选择小车的位置x、小车的速度v、杆的角度θ和杆的角速度ω作为状态变量。
然后，我们可以根据物理原理建立系统的动力学方程。
根据牛顿第二定律和角动量守恒定律，我们可以得到如下的动力学方程：m*x'' = F - m*g*sin(θ) - m*l*θ'^2*cos(θ)m*l^2*θ'' = -m*g*l*sin(θ) + m*l*x''*cos(θ) - b*θ'其中，m是小车和质量块的总质量，l是杆的长度，F是施加在小车上的外力，g是重力加速度，b是杆的阻尼系数。
接下来，我们可以使用MATLAB进行模型的建立和仿真。
首先，我们需要定义系统的参数和初始条件。
然后，我们可以使用ode45函数来求解系统的动力学方程。
ode45函数是MATLAB中用于求解常微分方程的函数，它可以根据给定的初始条件和参数，计算出系统在一段时间内的状态变化。
在求解动力学方程之后，我们可以得到系统的状态变量随时间的变化。
通过绘制状态变量随时间的曲线，我们可以观察到系统的动态行为。
例如，我们可以绘制小车位置随时间的变化曲线，以及杆角度随时间的变化曲线。
最后，我们需要设计一个控制器来实现单级移动倒立摆的平衡。
常见的控制器设计方法包括PID控制器和模糊控制器。
一阶倒立摆控制设计与实现
一阶倒立摆控制设计与实现以一阶倒立摆控制设计与实现为题，本文将介绍倒立摆控制系统的设计原理和实现过程。
倒立摆是一种经典的控制系统问题，它涉及到动力学建模、控制算法设计和实时控制等多个方面。
本文将从这些方面逐步展开，为读者介绍一阶倒立摆控制的基本知识。
1. 动力学建模倒立摆是一个复杂的动力学系统，它由一个可以旋转的杆和一个连接在杆末端的质点组成。
杆的旋转可以由一个电机控制，质点则受到重力和杆的作用力。
为了建立倒立摆的动力学模型，我们需要考虑杆的旋转角度和质点的位置。
2. 控制算法设计一阶倒立摆的控制目标是使杆保持竖直位置，即旋转角度为零，并且使质点保持在某个给定的位置上。
为了实现这个目标，我们可以设计一个控制器来控制杆的旋转角度和质点的位置。
常用的控制算法有PID控制算法、模糊控制算法和神经网络控制算法等。
PID控制算法是一种经典的控制算法，它通过调节比例、积分和微分三个参数来实现控制效果。
模糊控制算法则利用模糊逻辑的思想，将输入和输出之间的关系用模糊集合表示。
神经网络控制算法则利用神经网络的学习能力，通过训练网络来实现控制效果。
3. 实时控制倒立摆的控制需要实时采集传感器数据，并根据这些数据计算控制信号。
在实际应用中，我们可以使用编码器来测量杆的旋转角度，使用加速度计来测量质点的加速度，然后通过控制器来计算电机的控制信号。
为了实现实时控制，我们可以使用嵌入式系统来实现。
嵌入式系统是一种专门设计用于控制和处理实时数据的计算机系统，它通常由微处理器、存储器和输入输出设备组成。
通过将控制算法和传感器接口集成到嵌入式系统中，我们可以实现倒立摆的实时控制。
总结本文介绍了一阶倒立摆控制的基本原理和实现方法。
倒立摆是一个复杂的动力学系统，控制它需要建立动力学模型，并设计合适的控制算法。
通过实时采集传感器数据并计算控制信号，我们可以实现倒立摆的控制。
希望本文对读者理解一阶倒立摆控制有所帮助，同时也希望读者能够进一步探索和研究这个有趣的控制问题。
浅谈单级倒立摆的先进PID控制
浅谈单级倒立摆的先进PID控制摘要：倒立摆系统是非线性、强耦合、多变量和自然不稳定的系统。
本文以控制方法中最常用的PID控制算法进行研究，研究模糊PID控制的控制规律，并对其作出仿真。
关键词:倒立摆、数学模型、PIDAbstract: inverted pendulum system is nonlinear, strong coupling, many variables and natural not stable system. This paper to control method is the most commonly used in PID control algorithm is studied, the fuzzy PID control the control law, and to make the simulation.Keywords: inverted pendulum, mathematical model and PID1、倒立摆系统简介倒立摆是典型的高阶非线性不稳定系统。
小车可以自由地在限定的轨道上左右移动，小车上的倒立摆一端被绞链在小车顶部，另一端可以在小车轨道所在的垂直平面上自由转动，控制目的是通过电机推动小车运动，使倒立摆平衡并保持小车不和轨道两端相撞（图1为单级倒立摆的模型本论文的研究对象）。
在此基础上，在摆杆的另一端再绞连摆杆，可以组成二级、三级倒立摆系统。
该系统是一个多用途的综合性实验装置，它和火箭的飞行及机器人关节运动有许多相似之处，其原理可用于控制火箭稳定发射，且对揭示定性定量转换规律和策略具普遍意义。
图1单级倒立摆原理结构图2、控制方法中的典范—PIDPID控制是众多控制方法中应用最为广泛也是最为容易被人们所掌握的一种控制方法。
随着科学技术的不断发展，控制技术的不断成熟，传统的PID 控制已被人们注入了先进的控制思想。
使得PID控制方法不断丰富，控制性能不断加强。