文档库 最新最全的文档下载
当前位置:文档库 › 6CB_5_4型莲籽穿芯脱壳机控制系统的设计

6CB_5_4型莲籽穿芯脱壳机控制系统的设计

6CB_5_4型莲籽穿芯脱壳机控制系统的设计
6CB_5_4型莲籽穿芯脱壳机控制系统的设计

6C B- 5.4型莲籽穿芯脱壳机控制系统的设计

杨友平,刘守祥

(长江大学电子信息学院,湖北荆州 434020)

摘 要:根据6C B- 5.4型莲籽穿芯脱壳机的工作原理设计出了该机的控制系统,该控制系统是基于一台89C51单片机来实现的。为此介绍了系统硬件和软件的设计思想和实现过程,达到了莲籽自动穿芯脱壳的目的,收到了较好的效果。

关键词:莲籽穿芯脱壳;89C51;控制系统;硬件;软件

中图分类号:S226.4 文献标识码:A文章编号:1003-188X(2009)12-0083-03

0 引言

6CB-5.4型莲籽穿芯脱壳机改变了以往莲籽加工以半机械、半手工作业为主的加工方式,根据莲籽个体的大小,应用电、液、机相结合的控制方式,采用动态夹紧定心、电液控制切壳力和各部件运动关系的办法,实现先穿芯后脱壳,不仅有效地提高了莲籽加工的生产效率,彻底消除了生产中不安全隐患,而且极大地提升了莲籽加工后成品的品质。6CB-5.4型莲籽穿芯脱壳机最初控制系统的实现是以有触点控制为主,使得控制系统的可靠性较差,使用寿命不长,故障率高。为解决这些弊端,以一台89C51单片机为控制核心,实现该机的系统控制,不仅提高了系统工作的可靠性,而且使生产效率大为提高。

1 工作原理

1.1 主要结构

6CB-5.4型莲籽穿芯脱壳机主要由送退料机构、自动夹紧机构、穿芯机构、切壳机构和控制系统等6部分组成,其结构示意图如图1所示[1]。

1.2 莲籽穿芯脱壳机的工作原理

待加工的莲籽由喂料斗通过水平输送搅龙使莲籽由自然状态向呈长轴方向放置,由送料位置口(1)进入分度圆盘,实现定位间断喂入。莲籽进入分度圆盘后,由自动夹紧机构实现莲籽夹紧和准确定位。莲籽在穿芯位置,由穿芯机构实现莲籽穿芯;莲籽在切壳位置,在切壳机构和分度圆盘的共同作用下,完成莲

收稿日期:2009-02-12

基金项目:湖北省教育厅技术创新资金资助项目(2002D00004)

作者简介:杨友平(1965-),男,湖北仙桃人,高级工程师,硕士,(E-mail)yyp65828@https://www.wendangku.net/doc/9912706125.html,。籽的切壳和卸料[2]

1.送料位置

2.穿芯位置

3.切壳位置

4.分度圆盘

5.定位支撑板

6.退料机构

7.穿芯机构

8.自动夹紧圆盘

9.滑动齿条 10.定位输入输出板 11.送料机构 12.穿芯机构

13.切壳机构 14.夹爪

图1 结构示意图

Fig.1 The schematic diagra m

2 电气控制部分设计

2.1 电气控制原理

整个机构运动的控制采用电磁液控换向阀和行程控制阀来实现。当驱动油缸将莲籽送到穿芯位置时,定位夹紧油缸快速动作,将莲籽迅速夹紧并定位。此时,穿芯控制油缸和送退料控制油缸同步运动,分别进行穿芯和将莲籽退出的同时送入切壳机构,随后切壳控制油缸带动切壳刀具运动。在实施切壳的同时,驱动油缸开始带动分度圆盘转动,进入下一循环。2.2 控制系统的主回路

该控制系统的主回路如图2所示。图2中M1为液压驱动电机,它为整个机构的运动提供动力源;M2为穿芯电机,它带动穿芯刀具实现莲籽的穿芯。Y1, Y2,Y5,Y6,Y9和Y10为DC24V的直流换向阀,分别控制穿芯机构、切壳机构、分度盘等的夹紧和松开; Y3,Y4,Y5和Y6为DC24V的直流行程控制阀,分别

控制穿芯机构、切壳机构的进或退的工作过程。控制执行机构K M1~K M12由可靠性较高的固态继电器来

实现

图2 控制系统的主回路

Fig .2 The contr ol syste m f or main circuit

2.3 控制系统的控制部分

本控制系统是基于一台89C51单片机来实现的,其控制系统的硬件组成电路图如图3所示。在该控制系统中,主要通过检测液压系统的压力量和行程控制阀的位移量来实现相应的控制动作,以完成相应的加工工序。压力量的检测采用0~0.5MPa 的压力传感器,位移量检测采用电子式的接近开关。控制系统主要由89C51、接口芯片8279、光电隔离器T CP250、驱动器74LS06以及A /D 转换芯片ADC0816等组成

[3]

图3 控制系统的硬件组成电路图

Fig .3 The contr ol syste m hardware component sche matics

3 软件部分

3.1 主程序部分

基于89C51单片机实现该控制系统的软件部分,主要包括压力量的检测程序、穿芯子程序、脱壳子程序、延时程序以及键盘/显示等程序

[4]

。其主程序的

流程框图如图4所示。设定好初始值,按下启动键,进行系统初始化。启动液压驱动电机M1,液压系统工作,检测液压压力是否达到设定值,如果未达到设

定值,等待系统加压;如果达到设定值。则系统保压,然后调用莲籽穿芯子程序。穿芯完成后,再调用莲籽脱壳子程序。脱壳完成后,判断是否有停止命令,如果没有,进行下一个循环;如果有停止命令,

结束莲籽的加工。

图4 主程序的流程框图

Fig .4 The fl ow diagra m of main p r ogram

3.2 子程序部分3.2.1 穿芯子程序

其流程框图如图5所示。工作过程为:启动穿芯电机M2,电机M2运行,为穿芯作准备,此时液压换向阀进,判断压力是否达到设定值。如果未达到设定值,换向阀继续进;如果达到设定值,换向阀停止进保压。行程控制阀进,实现莲籽的穿芯,由电子接近开关判断是否完成莲籽的穿芯工序。如果未达到设定位移量,行程控制阀继续进;如果达到设定位移量,行程控制阀退,完成莲籽的穿芯工序。同时,穿芯电机M2停止运行,返回主程序,等待下一次循环。

图5 穿芯子程序流程框图

Fig.5 The l otus seed’s drilling p r ocess fl ow diagra m

3.2.2 脱壳子程序

其工作过程与穿芯子程序工作过程相似,切壳执行机构是由呈星型分布的切壳刀具、电磁液控换向阀和压力控制油缸等机构组成。工作过程为:液控换向阀进,判断压力是否达到设定值。如果未达到设定值,换向阀继续进;如果达到设定值,则系统保压。行程控制阀进,实现莲籽的切壳,由电子接近开关判断是否完成莲籽的切壳工序。如果未达到设定位移量,行程控制阀继续进;如果达到设定位移量,行程控制阀退。与此同时,延时0.1s左右,由切壳控制油缸带动切壳刀具运动实现切壳的同时,驱动油缸开始带动分度盘转动,完成切壳和卸料,返回主程序,等待下一次循环。

4 结论

1)6CB-5.4型莲籽穿芯脱壳机采用电液相结合,以89C51单片机作为控制核心,来控制整机的运行,实现了莲籽穿芯脱壳机械化流水作业。

2)莲籽穿芯脱壳机生产率:脱壳可达 5.6~612kg/h;穿芯可达 5.0~5.1kg/h。莲芯的穿净率为98%,破碎率小于5%。

3)与以往的加工方式相比,其特点:一是消除了生产中不安全隐患;二是提升成品莲的品质,增加了产品的附加值;三是综合生产率提高了 2.2~2.5倍;四是设备的使用寿命延长,降低了故障率。

参考文献:

[1] 刘守祥,杨友平.6C B-5.4型莲籽穿芯脱壳机的研究

[J].食品与机械,2003(4):23-25.

[2] 邓钟星.机电传动控制[M].武汉:华中科技大学出版

社,2001.

[3] 蔡美琴,张为民.MCS-51系列单片机系统及其应用

[M].北京:高等教育出版社,2004.

[4] 马忠梅,籍顺心.单片机的C语言应用程序设计[M].北

京:北京航空航天大学出版社,2005.

Desi gn of Controlli n g Syste m for the Auto mati c Machi n e of

6CB-5.4Lotus Seed’s Dr illi n g and Peeli n g

Yang Youp ing,L iu Shouxiang

(University of Yangrze Telecommunicati ons College,J ingzhou434020,China)

Abstract:According t o p rinci p le of work for the aut omatic machine of6CB-5.4l otus seed’s drilling and peeling.De2 signed this machine contr ol syste m,this contr ol syste m was realizes based on a89C51single machine.I ntr oduced the syste m hard ware and s oft w are’s design concep t and realizes p r ocess,achieved the l otus seed’s drilling and peeling aut o2 matically,has received better resul.

Key words:the l otus seed’s drilling and peeling;89C51;contr ol syste m;hardware;s oft w are

自动控制原理课程设计——倒立摆系统控制器设计

一、引言 支点在下,重心在上,恒不稳定的系统或装置的叫倒立摆。倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想实验平台。 问题的提出 倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自有连接(即无电动机或其他驱动设备)。对倒立摆系统的研究能有效的反映控制中的许多典型问题:如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。 倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。 倒立摆的控制方法 倒立摆系统的输入来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。 本次设计中我们采用其中的牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型,然后通过开环响应分析对该模型进行分析,并利用学习的古典控制理论和Matlab /Simulink仿真软件对系统进行控制器的设计,主要采用根轨迹法,频域法以及PID(比例-积分-微分)控制器进行模拟控制矫正。

单级倒立摆系统的分析与设计

单级倒立摆系统的分析与设计 小组成员:武锦张东瀛杨姣 李邦志胡友辉 一.倒立摆系统简介 倒立摆系统是一个典型的高阶次、多变量、不稳定和强耦合的非线性系统。由于它的行为与火箭飞行以及两足机器人行走有很大的相似性,因而对其研究具有重大的理论和实践意义。由于倒立摆系统本身所具有的上述特点,使它成为人们深入学习、研究和证实各种控制理论有效性的实验系统。 单级倒立摆系统(Simple Inverted Pendulum System)是一种广泛应用的物理模型,其结构和飞机着陆、火箭飞行及机器人的关节运动等有很多相似之处,因而对倒立摆系统平衡的控制方法在航空及机器人等领域有着广泛的用途,倒立摆控制理论产生的方法和技术将在半导体及精密仪器加工、机器入技术、导弹拦截控制系统、航空器对接控制技术等方面具有广阔的开发利用前景。 倒立摆仿真或实物控制实验是控制领域中用来检验某种控制理论或方法的典型方案。最初研究开始于二十世纪50年代,单级倒立摆可以看作是一个火箭模型,相比之下二阶倒立摆就复杂得多。1972年,Sturgen等采用线性模拟电路实现了对二级倒立摆的控制。目前,一级倒立摆控制的仿真或实物系统已广泛用于教学。 二.系统建模 1.单级倒立摆系统的物理模型 图1:单级倒立摆系统的物理模型

单级倒立摆系统是如下的物理模型:在惯性参考系下的光滑水平平面上,放置一个可以在平行于纸面方向左右自由移动的小车(cart ),一根刚性的摆杆(pendulum leg )通过其末端的一个不计摩擦的固定连接点(flex Joint )与小车相连构成一个倒立摆。倒立摆和小车共同构成了单级倒立摆系统。倒立摆可以在平行于纸面180°的范围内自由摆动。倒立摆控制系统的目的是使倒立摆在外力的摄动下摆杆仍然保持竖直向上状态。在小车静止的状态下,由于受到重力的作用,倒立摆的稳定性在摆杆受到微小的摄动时就会发生不可逆转的破坏而使倒立摆无法复位,这时必须使小车在平行于纸面的方向通过位移产生相应的加速度。依照惯性参考系下的牛顿力学原理,作用力与物体位移对时间的二阶导数存在线性关系,单级倒立摆系统是一个非线性系统。 各个参数的物理意义为: M — 小车的质量 m — 倒立摆的质量 F — 作用到小车上的水平驱动力 L — 倒立摆的长度 x — 小车的位置 θ— 某一时刻摆角 整个倒立摆系统就受到重力、驱动力和摩擦阻力的三个外力的共同作用。这里,驱动力F 是由连接小车的传动装置提供,控制倒立摆的稳定实际上就是依靠控制驱动力F 使小车在水平面上做与倒立摆运动相关的特定运动。为了简化模型以利于仿真,假设小车与导轨以及摆杆与小车铰链之间的摩擦均为0。 2.单级倒立摆系统的数学模型 令小车的水平位移为x ,运动速度为v ,加速度a 。 小车的动能为212kc E Mx =,选择特定的参考平面使得小车的势能为0。 摆杆的长度为L ,某时刻摆角为θ,在摆杆上与固定连接点距离为q (0

7状态空间设计法极点配置观测器解析

第7章线性定常离散时间状态空间设计法 7.1引言 7.2状态反馈配置极点 7.3状态估值和状态观测器 7.4利用状态估值构成状态反馈以配置极点 7.5扰动调节 7.6无差调节

7.1 引言 一个被控对象: (1)()()()() ():1,():1,:,:,:x k Fx k Gu k y k Cx k x k n u k m F n n G n m C r n +=+?? =?????? 7.1 当设计控制器对其控制时,需要考虑如下各因素: ● 扰动,比如负载扰动 ● 测量噪声 ● 给定输入的指令信号 ● 输出 如图7.1所示。 给d L (k )扰动 图7.1 控制系统示意图 根据工程背景的不同,控制问题可分为调节问题和跟踪问题,跟踪问题也称为伺服问题。 调节问题的设计目标是使输出迅速而平稳地运行于某一平衡状态。包括指令变化时的动态过程,和负载扰动下的动态过程。但是这二者往往是矛盾的,需要折衷考虑。 伺服问题的设计目标是对指令信号的快速动态跟踪。 本章研究基于离散时间状态空间模型的设计方法。 7.2研究通过状态变量的反馈对闭环系统的全部特征值任意配置——稳定性与快速线。 7.3考虑当被控对象模型的状态无法直接测量时,如何使用状态观测器对状态进行重构。 7.4讨论使用重构状态进行状态反馈时闭环系统的特征值。 7.5简单地讨论扰动调节问题。 7.6状态空间设计时的无差调节问题。

7.2 状态反馈配置极点 工程被控对象如式7.1,考虑状态反馈 ()()()u k v k Lx k =+ 7.2 如图7.2所示。式7.2带入式7.1,得 (1)()()()() ()()()x k Fx k Gu k y k Cx k u k v k Lx k +=+?? =??=+? 7.3 整理得 ()(1)()() ()()x k F GL x k Gv k y k Cx k +=++?? =? 7.4 (k ) v (k ) 图7.2 状态反馈任意配置闭环系统的极点 闭环系统的特征方程为 []det ()0zI F GL -+= 7.5 问题是在什么情况下式7.5的特征根是可以任意配置的?即任给工程上期望的n 个特征根λ1, λ2, ..., λn ,有 []1det ()()0n i i zI F GL z λ=-+=-=∏ 7.6 定理:状态反馈配置极点

自动控制原理课程设计-倒立摆系统控制器设计

1 引言 支点在下,重心在上,恒不稳定的系统或装置的叫倒立摆。倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想实验平台。 1.1 问题的提出 倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自有连接(即无电动机或其他驱动设备)。对倒立摆系统的研究能有效的反映控制中的许多典型问题:如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。 倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置后,系统能克服随机扰动而保持稳定的位置。 1.2 倒立摆的控制方法 倒立摆系统的输入来自传感器的小车与摆杆的实际位置信号,与期望值进行比较后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。当没有作用力时,摆杆处于垂直的稳定的平衡位置(竖直向下)。为了使杆子摆动或者达到竖直向上的稳定,

需要给小车一个控制力,使其在轨道上被往前或朝后拉动。 本次设计中我们采用其中的牛顿-欧拉方法建立直线型一级倒立摆系统的数学模型,然后通过开环响应分析对该模型进行分析,并利用学习的古典控制理论和Matlab /Simulink仿真软件对系统进行控制器的设计,主要采用根轨迹法,频域法以及PID(比例-积分-微分)控制器进行模拟控制矫正。 2 直线倒立摆数学模型的建立 直线一级倒立摆由直线运动模块和一级摆体组件组成,是最常见的倒立摆之一,直线倒立摆是在直线运动模块上装有摆体组件,直线运动模块有一个自由度,小车可以沿导轨水平运动,在小车上装载不同的摆体组件。 系统建模可以分为两种:机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入-输出关系。这里面包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容。 鉴于小车倒立摆系统是不稳定系统,实验建模存在一定的困难。因此,本文通过机理建模方法建立小车倒立摆的实际数学模型,可根据微分方程求解传递函数。 2.1 微分方程的推导(牛顿力学方法) 微分方程的推导在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图1所示。做以下假设: M小车质量m摆杆质量 b小车摩擦系数I 摆杆惯量

控制系统的状态空间分析与综合

第8章控制系统的状态空间分析与综合 第1~7章涉及的内容属于经典控制理论的范畴,系统的数学模型是线性定常微分方程和传递函数,主要的分析与综合方法是时域法、根轨迹法和频域法。经典控制理论通常用于单输入-单输出线性定常系统,其缺点是只能反映输入-输出间的外部特性,难以揭示系统内部的结构和运行状态,不能有效处理多输入-多输出系统、非线性系统、时变系统等复杂系统的控制问题。 随着科学技术的发展,对控制系统速度、精度、适应能力的要求越来越高,经典控制理论已不能满足要求。1960年前后,在航天技术和计算机技术的推动下,现代控制理论开始发展,一个重要的标志就是美国学者卡尔曼引入了状态空间的概念。它是以系统内部状态为基础进行分析与综合的控制理论,两个重要的内容如下。 (1)最优控制:在给定的限制条件和评价函数下,寻求使系统性能指标最优的控制规律。 (2)最优估计与滤波:在有随机干扰的情况下,根据测量数据对系统的状态进行最优估计。 本章讨论控制系统的状态空间分析与综合,它是现代控制理论的基础。 8.1 控制系统的状态空间描述 8.1.1 系统数学描述的两种基本方法 统的内部结构和内部变量,如传递函数;另一种是状态空间描述(内部描述),它是基于系统内部结构的一种数学模型,由两个方程组成。一个反映系统内部变量x和输入变量u间的关系,具有一阶微分方程组或一阶差分方程组的形式;另一个是表征系统输出向量y与内部变量及输入变量间的关系,具有代数方程的形式。外部描述虽能反映系统的外部特性,却不能反映系统内部的结构与运行过程,内部结构不同的两个系统也可能具有相同的外部特性,因此外部描述通常是不完整的;内部描述则能全面完整地反映出系统的动力学特征。

状态空间法教案

一、问题引入 结合一些典型问题(分油问题)提出问题: 我们是怎样解决这些问题的?在人工智能领域又可以通过怎样的方法去解决呢?(状态空间法) 2、引导学生思考问题,并得出结论。 二、讲授新课 (一)基础知识部分 1、什么是状态空间法? 许多问题求解方法是采用试探搜索方法的。也就是说,这些方法是通过在某个可能的解空间内寻找一个解来求解问题的。这种基于解答空间的问题表示和求解方法就是状态空间法,它是以状态和算符(operator)为基础来表示和求解问题的。 2、状态空间法三要点 1) 状态(state):表示问题解法中每一步问题状况的数据结构; 2) 算符(operator):把问题从一种状态变换为另一种状态的手段; 3) 状态空间方法:基于解答空间的问题表示和求解方法,它是以状态和算符为基础来表示和求解问题的。

由上可知,对一个问题的状态描述,必须确定3件事: 1) 该状态描述方式,特别是初始状态描述; 2) 操作符集合及其对状态描述的作用; 3) 目标状态描述的特性。 问题的状态空间可用一个三元序组来表示: S:问题的全部初始状态的集合 F:操作的集合 G:目标状态的集合 4、用状态空间表示问题的步骤: 1)定义状态的描述形式 2)用所定义的状态描述形式把问题所有可能的状态都表示出来,并确定初始状态和目标状态的集合描述 3)定义一组算符,使得利用这些算符可以把问题由一个状态转为另一个状态。 4)利用状态空间图表示求解过程。 (二)实践应用部分

【分油问题】有A、B、C三个不带刻度的瓶子,分别能装8kg, 5kg和3kg油。如果A瓶装满油,B和C是空瓶,怎样操作三个瓶,使A中的油平分两份?(假设分油过程中不耗油) 解:第一步:定义问题状态的描述形式: 设Sk=(b,c)表示B瓶和C瓶中的油量的状态。 其中: b表示B瓶中的油量。 c表示C瓶中的油量。 初始状态集:S={(0,0)} 目标状态集:G={(4,0)} 第二步:定义操作符: 操作:把瓶子倒满油,或把瓶子的油倒空。 f1:从A瓶往B瓶倒油,把B瓶倒满。 f2:从C瓶往B瓶倒油,把B瓶倒满。 f3:从A瓶往C瓶倒油,把C瓶倒满。 f4:从B瓶往C瓶倒油,把C瓶倒满。

倒立摆控制系统设计报告.doc

控制系统综合设计 倒立摆控制系统 院(系、部): 组长: 组员 班级: 指导教师: 2014年1月2日星期四

目录 摘要----------------------------------------------------------------------------------3 引言----------------------------------------------------------------------------------3 一、整体方案设计--------------------------------------------------------------3 1、需求-----------------------------------------------------------------------------3 2、目标-----------------------------------------------------------------------------3 3、概念设计----------------------------------------------------------------------3 4、整体开发方案设计---------------------------------------------------------3 5、评估----------------------------------------------------------------------------4 二、系统设计--------------------------------------------------------------------4 (一)系统设计-----------------------------------------------------------------4 1、功能分析----------------------------------------------------------------------4 2、设计规范和约束------------------------------------------------------------6 3、详细设计----------------------------------------------------------------------7 (二)机械系统设计-----------------------------------------------------------8 三、理论分析---------------------------------------------------------------------9 1、控制系统建模----------------------------------------------------------------9 2、时域和频域分析------------------------------------------------------------13 3、设计PID或其他控制器---------------------------------------------------21 四、元器件、设备选型--------------------------------------------------------30

倒立摆系统的控制器设计

倒立摆系统的控制器设计

摘 要 倒立摆是一种典型的非线性,多变量,强耦合,不稳定系统,许多抽象的控制概念如系统的稳定性、可控性、系统的抗干扰能力等都可以通过倒立摆直观的反应出来;倒立摆的控制思想在实际中如实验、教学、科研中也得到广泛的应用;在火箭飞行姿态的控制、人工智能、机器人站立与行走等领域有广阔的开发和利用前景。因此,对倒立摆系统的研究具有十分重要的理论和实践意义。 本文首先将直线倒立摆抽象为简单的模型以便于受力分析进行机理建模,然后通过牛顿力学原理进行分析,得出相应的模型,进行拉氏变化带入相应参数得出摆杆角度和小车位移、摆杆角度和小车加速度、摆杆角度和小车所受外界作用力、小车位移与小车所受外界作用力的传递函数,其中摆杆角度和小车加速度之间的传递函数为: 02()0.02725()()0.01021250.26705s G s V s s Φ==- ………… (1) 即我们在本次设计中主要分析的系统的传递函数。 然后从时域角度着手,分析直线一级倒立摆的开环单位阶跃响应和单位脉冲响应,利用Matlab 中的Simulink 仿真工具进行仿真,得出结论该系统的开环响应是发

散的。 最后分别利用根轨迹分析法,频域分析法和PID 控制法对倒立摆系统进行校正。 针对目标一:调整时间0.5(2%)s t s =误差带,最大超调量%10%≤p σ,选取参数利用根轨迹法进行校正,得出利用超前校正环节的传递函数为: 135.1547( 5.0887) ()135.1547c s G s s +=+ ………………………… (2) 针对目标二:系统的静态位置误差常数为10;相位裕量为 50 ;增益裕量等于或大于10 分贝。通过频域法得出利用超前校正环节的传递函数为: 1189.6(8.15) ()99.01c s G s s +=+ …………………………… ……………………(3) 针对目标三: 调整时间误差带)%2(2s t s =,最大超调量,%15%≤p σ,设计或调整PID 控制器参数,得出调整后的传递函数为: 150()21020c G s s s =++ ………………………………………. .(4)

答案 控制系统的状态空间描述 习题解答

第2章 “控制系统的状态空间描述”习题解答 系统的结构如图所示。以图中所标记的1x 、2x 、3x 作为状态变量,推导其状态空间表达式。其中,u 、y 分别为系统的输入、输出,1α、2α、3α均为标量。 3 x 2 x 图系统结构图 解 图给出了由积分器、放大器及加法器所描述的系统结构图,且图中每个积分器的输出即为状态变量,这种图形称为系统状态变量图。状态变量图即描述了系统状态变量之间的关系,又说明了状态变量的物理意义。由状态变量图可直接求得系统的状态空间表达式。 着眼于求和点①、②、③,则有 ①:2111x x x +=α& ②: 3222x x x +=α&③:u x x +=333α& 输出y 为1y x du =+,得 1112223331000100 1x a x x a x u x a x ?? ?????? ????????=+???????????????????????? &&& []123100x y x du x ?? ??=+?? ???? 已知系统的微分方程 (1) u y y y y 354=+++&&&&&& ;(2) u u y y -=+&&&&&&32; (3) u u y y y y 75532+=+++&&&&&&&&& 。试列写出它们的状态空间表达式。 (1) 解 选择状态变量1y x =,2y x =&,3y x =&&,则有:

1223 31231 543x x x x x x x x u y x =??=?? =---+??=?&&& 状态空间表达式为:[]112233123010000105413100x x x x u x x x y x x ????????????????=+????????????????---???????? ????=?????? &&& (2) 解 采用拉氏变换法求取状态空间表达式。对微分方程(2)在零初试条件 下取拉氏变换得: 3222332()3()()() 11()12 23()232 s Y s sY s s U s U s s Y s s U s s s s s +=---==++ 由公式、可直接求得系统状态空间表达式为 1122330100001031002x x x x u x x ?? ????????????????=+? ?????????????????????-?? ?? &&& 123110 2 2x y x x ?????? =- ?????????? (3) 解 采用拉氏变换法求取状态空间表达式。对微分方程(3)在零初试条件 下取拉氏变换得: 323()2()3()5()5()7()s Y s s Y s sY s Y s s U s U s +++=+

一阶倒立摆控制系统

一阶直线倒立摆系统 姓名: 班级: 学号:

目录 摘要 (3) 第一部分单阶倒立摆系统建模 (4) (一)对象模型 (4) (二)电动机、驱动器及机械传动装置的模型 (6) 第二部分单阶倒立摆系统分析 (7) 第三部分单阶倒立摆系统控制 (11) (一)内环控制器的设计 (11) (二)外环控制器的设计 (14) 第四部分单阶倒立摆系统仿真结果 (16) 系统的simulink仿真 (16)

摘要: 该问题源自对于娱乐型”独轮自行车机器人”的控制,实验中对该系统进行系统仿真,通过对该实物模型的理论分析与实物仿真实验研究,有助于实现对独轮自行车机器人的有效控制。 控制理论中把此问题归结为“一阶直线倒立摆控制问题”。另外,诸如机器人行走过程中的平衡控制、火箭发射中的垂直度控制、卫星飞行中的姿态控制、海上钻井平台的稳定控制、飞机安全着陆控制等均涉及到倒立摆的控制问题。 实验中通过检测小车位置与摆杆的摆动角,来适当控制驱动电动机拖动力的大小,控制器由一台工业控制计算机(IPC)完成。实验将借助于“Simulink封装技术——子系统”,在模型验证的基础上,采用双闭环PID控制方案,实现倒立摆位置伺服控制的数字仿真实验。实验过程涉及对系统的建模、对系统的分析以及对系统的控制等步骤,最终得出实验结果。仿真实验结果不仅证明了PID方案对系统平衡控制的有效性,同时也展示了它们的控制品质和特性。 第一部分单阶倒立摆系统建模

(一) 对象模型 由于此问题为”单一刚性铰链、两自由度动力学问题”,因此,依据经典力学的牛顿定律即可满足要求。 如图1.1所示,设小车的质量为0m ,倒立摆均匀杆的质量为m ,摆长为2l ,摆的偏角为θ,小车的位移为x ,作用在小车上的水平方向上的力为F ,1O 为摆杆的质心。 图1.1 一阶倒立摆的物理模型 根据刚体绕定轴转动的动力学微分方程,转动惯量与角加速度乘积等于作用于刚体主动力对该轴力矩的代数和,则 1)摆杆绕其重心的转动方程为 sin cos y x l F J F l θθθ=-&& (1-1) 2)摆杆重心的水平运动可描述为 2 2(sin )x d F m x l dt θ=+ (1-2) 3)摆杆重心在垂直方向上的运动可描述为 2 2(cos )y d F mg m l dt θ-= (1-3) 4)小车水平方向运动可描述为 202x d x F F m dt -= (1-4)

倒立摆校正装置的设计

自动控制原理课程设计报告 倒立摆系统的控制器设计 指导教师:谢昭莉 学生:冯莉 学号: 20095099 专业:自动化 班级: 2009 级 3 班 设计日期: 2011.12.12—2011.12.23 重庆大学自动化学院 2011年12月

重庆大学本科学生课程设计任务书

目录 1倒立摆系统的研究背景和意义 (1) 2小车倒立摆系统模型的假设 (1) 3符号说明 (2) 4模型的建立 (2) 4.1牛顿力学法系统分析 (2) 4.2拉氏变换后实际系统的模型 (6) 5开环响应分析 (7) 6根轨迹法设计超前校正装置函数 (9) 6.1校正前倒立摆系统的闭环传递函数的析 (9) 6.2系统稳定性分析 (9) 6.3期望闭环极点的确定 (10) 6.4 超前校正装置传递函数的设计 (11) 6.4.1校正参数计算 (11) 6.4.2控制器的确定 (13) 6.4.3校正装置的改进 (13) 6.4.4Simulink仿真 (15)

7直线一级倒立摆频域法设计 (17) 7.1系统频域响应分析 (17) 7.2频域法控制器设计 (19) 7.2.1控制器的选择 (19) 7.2.2系统开环增益的计算 (19) 7.2.3校正装置的频率分析 (20) 7.2.4控制器转折频域和截止频域的求解 (22) 7.2.5校正装置的确定 (22) 7.2.6Simulink仿真 (24) 8直线一级倒立摆的PID控制设计 (25) 8.1PID简介 (25) 8.2PID控制设计分析 (25) 8.3PID控制器的参数测定 (26) 9总结与体会 (29) 9.1总结 (29) 9.2体会 (29) 10参考文献 (30)

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

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

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仿 真及实物调试。

(整理)控制系统的状态空间模型

第一章控制系统的状态空间模型 1.1 引言 工程系统正朝着更加复杂的方向发展,这主要是由于复杂的任务和高精度的要求所引起的。一个复杂系统可能有多个输入和多个输出,并且以某种方式相互关联或耦合,可能是时变的。由于需要满足控制系统性能提出的日益严格的要求,系统的复杂程度越来越大,为了分析这样的系统,必须简化其数学表达式,转而借助于计算机来进行各种大量而乏味的分析与计算,并且要求能够方便地用大型计算机对系统进行处理。从这个观点来看,状态空间法对于系统分析是最适宜的。大约从1960年升始发展起来。这种新方法是建立在状态概念之上的。状态本身并不是一个新概念,在很长一段时间内,它已经存在于古典动力学和其他一些领域中。 经典控制理论是建立在系统的输入-输出关系或传递函数的基础之上的,而现代控制理论以n个一阶微方程来描述系统,这些微分方程又组合成一个一阶向量-矩阵微分方程。应用向量-矩阵表示方法,可极大地简化系统的数学表达式。状态变量、输入或输出数目的增多并不增加方程的复杂性。事实上,分析复杂的多输入-多输出系统,仅比分析用一阶纯量微分方程描述的系统在方法上稍复杂一些。 本课程将主要涉及控制系统的基于状态空间的描述、分析与设计。本章将首先给出状态空间方法的描述部分。将以单输入单输出系统为例,给出包括适用于多输入多输出或多变量系统在内的状态空间表达式的一般形式、线性多变量系统状态空间表达式的标准形式(相变量、对角线、Jordan、能控与能观测)、传递函数矩阵,以及利用MA TLAB进行各种模型之间的相互转换。第二章将讨论状态反馈控制系统的分析方法。第三章将给出系统的稳定性分析。第四章将给出几种主要的设计方法。 本章1.1节为控制系统状态空间分析的引言。1.2节介绍状态空间描述1.3节讨论动态系统的状态空间表达式。1.4状态空间表达式的标准形式。1.5 介绍系统矩阵的特征值基本性质.1.6讨论用MATLAB进行系统模型的转换问题。 1.2控制系统的状态空间描述 状态空间描述是60年代初,将力学中的相空间法引入到控制系统的研究中而形成的描述系统的方法,它是时域中最详细的描述方法。 特点:1.给出了系统的内部结构信息. 2.形式上简洁,便于用数字计算机计算. 1.2.1 状态的基本概念 在介绍现代控制理论之前,我们需要定义状态、状态变量、状态向量和状态空间。

最新倒立摆系统的控制器设计

目录 摘要.......................................................................................................................................... - 5 - 1 倒立摆系统概述................................................................................................................................ - 6 - 1.1倒立摆的种类......................................................................................................................... - 6 - 1.2系统的组成............................................................................................................................. - 6 - 1.3工程背景................................................................................................................................. - 6 - 2 数学模型的建立................................................................................................................................ - 7 - 2.1牛顿力学法系统分析............................................................................................................. - 7 - 2.2拉氏变换后实际系统的模型............................................................................................... - 10 - 3 开环响应分析.................................................................................................................................. - 11 - 4 根轨迹法设计.................................................................................................................................. - 13 - 4.1校正前倒立摆系统的闭环传递函数的分析....................................................................... - 13 - 4.2系统稳定性分析................................................................................................................... - 13 - 4.3 根轨迹设计.......................................................................................................................... - 14 - 4.4 SIMULINK仿真..................................................................................................................... - 17 - 5 直线一级倒立摆频域法设计........................................................................................................ - 18 - 5.1 系统频域响应分析.............................................................................................................. - 18 - 5.2频域法控制器设计............................................................................................................... - 19 - 5.2.1控制器的选择........................................................................................................... - 19 - 5.2.2系统开环增益的计算............................................................................................... - 20 - 5.2.3校正装置的频率分析............................................................................................... - 20 - 5.3 Simulink仿真..................................................................................................................... - 24 - 6 直线一级倒立摆的PID控制设计................................................................................................ - 25 - 6.1 PID简介............................................................................................................................... - 25 -

控制系统的状态空间分析

第八章 控制系统的状态空间分析 一、状态空间的基本概念 1. 状态 反应系统运行状况,并可用一个确定系统未来行为的信息集合。 2. 状态变量 确定系统状态的一组独立(数目最少的)变量,如果给定了0t t =时刻 这组变量的值())()() (00201t x t x t x n 和0t t ≥时输入的时间函数)(t u , 则系统在0t t ≥任何时刻())()()(21t x t x t x n 的行为就可完全确定。 3. 状态向量 以状态变量为元素构成的向量,即[])()()()(21t x t x t x t x n =。 4. 状态空间 以状态变量())()() (21t x t x t x n 为坐标的n 维空间。 系统在某时刻的状态,可用状态空间上的点来表示。 5. 状态方程 描述状态变量,输入变量之间关系的一阶微分方程组。 6. 输出方程 描述输出变量与状态变量、输入变量间函数关系的代数方程。 二、状态空间描述(状态空间表达式) 1. 状态方程与输出方程合起来称为状态空间描述或状态空间表达式,线性定常系统状 态空间描述一般用矩阵形式表示,对于线性定常连续系统有 ? ? ?+=+=)()()()()()(t Du t Cx t y t Bu t Ax t x (8-1) 对于线性定常离散系统有 ?? ?+=+=+) ()()() ()()1(k Du k Cx k y k Hu k Gx k x (8-2) 2. 状态空间描述的建立:系统的状态空间描述可以由系统的微分方程,结构图(方框 图),状态变量图、传递函数或脉冲传递函数(Z 传递函数)等其它形式的数学模型导出。 3. 状态空间描述的线性变换及规范化(标准型) 系统状态变量的选择不是唯一的,状态变量选择不同,状态空间描述也不一样。利用线性变换可将系统的矩阵A (见式8-1)规范化为四种标准型:能控标准型、能观标准型、对角标准型、约当标准型。

单级倒立摆经典控制系统

单级倒立摆经典控制系统 摘要:倒立摆控制系统虽然作为热门研究课题之一,但见于资料上的大多采用现代控制方法,本课题的目的就是要用经典的方法对单级倒立摆设计控制器进行探索。本文以经典控制理论为基础,建立小车倒立摆系统的数学模型,使用PID控制法设计出确定参数(摆长和摆杆质量)下的控制器使系统稳定,并利用MATLAB软件进行仿真。 关键词:单级倒立摆;经典控制;数学模型;PID控制器;MATLAB 1绪论 自动控制理论是研究自动控制共同规律的技术科学。它的发展初期,是以反馈理论为基础的自动调节原理,并主要用于工业控制。 控制理论在几十年中,迅速经历了从经典理论到现代理论再到智能控制理论的阶段,并有众多的分支和研究发展方向。 1.1经典控制理论 控制理论的发展,起于“经典控制理论”。早期最有代表性的自动控制系统是18世纪的蒸汽机调速器。20世纪前,主要集中在温度、压力、液位、转速等控制。20世纪起,应用范围扩大到电压、电流的反馈控制,频率调节,锅炉控制,电机转速控制等。二战期间,为设计和制造飞机及船用自动驾驶仪、火炮定位系统、雷达跟踪系统及其他基于反馈原理的军用装备,促进了自动控制理论的发展。

至二战结束时,经典控制理论形成以传递函数为基础的理论体系,主要研究单输入-单输出、线性定常系统的分析问题。经典控制理论的研究对象是线性单输入单输出系统,用常系数微分方程来描述。它包含利用各种曲线图的频率响应法和利用拉普拉斯变换求解微分方程的时域分析法。这些方法现在仍是人们学习控制理论的入门之道。 1.2倒立摆 1.2.1倒立摆的概念 图1 一级倒立摆装置 倒立摆是处于倒置不稳定状态,人为控制使其处于动态平衡的一种摆。如杂技演员顶杆的物理机制可简化为一级倒立摆系统,是一个复杂、多变量、存在严重非线性、非自治不稳定系统。

状态空间分析法

第9章 线性系统的状态空间分析与综合 重点与难点 一、基本概念 1.线性系统的状态空间描述 (1)状态空间概念 状态 反映系统运动状况,并可用以确定系统未来行为的信息集合。 状态变量 确定系统状态的一组独立(数目最少)变量,它对于确定系统的运动状态是必需的,也是充分的。 状态向量 以状态变量为元素构成的向量。 状态空间 以状态变量为坐标所张成的空间。系统某时刻的状态可用状态空间上的点来表示。 状态方程 状态变量的一阶导数与状态变量、输入变量之间的数学关系,一般是关于系统的一阶微分(或差分)方程组。 输出方程 输出变量与状态变量、输入变量之间的数学关系。 状态方程与输出方程合称为状态空间描述或状态空间表达式。线性定常系统状态空间表达式一般用矩阵形式表示: ???+=+=Du Cx y Bu Ax x & (9.1) (2)状态空间表达式的建立。系统状态空间表达式可以由系统微分方程、结构图、传递函数等其他形式的数学模型导出。 (3)状态空间表达式的线性变换及规范化。描述某一系统的状态变量个数(维数)是确定的,但状态变量的选择并不唯一。某一状态向量经任意满秩线性变换后,仍可作为状态向量来描述系统。状态变量选择不同,状态空间表达式形式也不一样。利用线性变换的目的在于使系统矩阵A 规范化,以便于揭示系统特性,利于分析计算。满秩线性变换不改变系统的固有特性。 根据矩阵A 的特征根及相应的独立特征向量情况,可将矩阵A 化为三种规范形式:对角形、约当形和模式矩阵。 (4)线性定常系统状态方程解。状态转移矩阵)(t φ(即矩阵指数At e )及其性质:

i . I =)0(φ ii .A t t A t )()()(φφφ ==& iii. )()()()()(122121t t t t t t φφφφφ±=±=+ iv. )()(1 t t -=-φφ v. )()]([kt t k φφ= vi. )( ])exp[()exp()exp(BA AB t B A Bt At =+= vii. )( )ex p()ex p(11非奇异P P At P APt P --= 求状态转移矩阵)(t φ的常用方法: 拉氏变换法 =)(t φL -1])[(1--A sI (9.2) 级数展开法 ΛΛ++++ +=k k At t A k t A At I e ! 12122 (9.3) 齐次状态方程求解 )0()()(x t t x φ= (9.4) 非齐次状态方程式(9.1)求解 ?-+=t Bu t x t t x 0d )()()0()()(τττφφ (9.5) (5)传递函数矩阵及其实现 传递函数矩阵)(s G :输出向量拉氏变换式与输入向量拉氏变换式之间的传递关系 D B A sI C s G +-=-1)()( (9.6) 传递函数矩阵的实现:已知传递函数矩阵)(s G ,找一个系统},,,{D C B A 使式(9.6)成立,则将系统},,,{D C B A 称为)(s G 的一个实现。当系统阶数等于传递函数矩阵阶数时,称该系统为)(s G 的最小实现。 传递函数矩阵的实现并不唯一。实现的常用标准形式有可控标准形实现、可观测标准形实现、对角形实现和约当形实现等。 (6)线性定常连续系统的离散化及其求解 对式(9.1)表示的线性定常数连续系统进行离散化,导出的系统离散状态空间描述

相关文档
相关文档 最新文档