液压挖掘机工装轨迹控制及仿真技术研究

哈尔滨工业大学课程设计说明书（论文）综合课程设计II项目总结报告题目液压挖掘机工装轨迹控制及仿真技术研究院（系）机电工程学院专业机械设计制造及其自动化学生学号班号指导教师填报日期2013年3月15日哈尔滨工业大学机电工程学院制2013年3月哈尔滨工业大学课程设计说明书（论文）说明一、总结报告应包括下列主要内容1项目背景分析；2研究计划要点与执行情况；3项目关键技术的解决；4具体研究内容与技术实现；5技术指标分析；6存在的问题与建议。二、总结报告由指导教师填写意见、签字后，统一交所在院（系）保存，以备检查。指导教师评语指导教师签字检查日期哈尔滨工业大学课程设计说明书（论文）哈尔滨工业大学课程设计任务书姓名院（系）专业机械设计制造及其自动化班号任务起至日期2013年2月25日至2013年3月15日课程设计题目液压挖掘机工装轨迹控制及仿真技术研究已知技术参数和设计要求1）结构参数名称长度MM行程MM转角范围0驱动件MM缸径MM活塞杆直径MM动臂2558660117双缸8045斗杆1332585117单缸9050铲斗835500170单缸80452）工作负责参数M500KG3）工装轨迹参数挖掘水平直线4）控制系统要求以51单片机为控制处理器5）角度传感器选择电阻式位移传感器工作计划安排周1周2周3周4周5第1周系统简图运动学分析运动学分析液压系统液压系统第2周电路设计电路设计电路设计控制方法控制方法第3周MATLAB仿真分析答辩哈尔滨工业大学课程设计说明书（论文）同组设计者及分工指导教师签字_年月日教研室主任意见教研室主任签字_年月日哈尔滨工业大学课程设计说明书（论文）第一章挖掘机工装轨迹控制的机电液系统介绍11单斗液压挖掘机的机械模型简介本次课程设计的液压挖掘机是针对学校的实验室用的样机模型，其容量为001立方米，动臂和斗杆为四连杆机构，动臂、斗杆和铲斗均由液压缸驱动，它们之间以销轴连接。在动臂和斗杆的销轴上分别安装了角度传感器，用以检测相对位角。模型不具备回转机构，无回转功能。其结构简图如图11所示，其参数如表11所示。图11样机结构简图表11样机结构参数表液压挖掘机是工程机械的重要机型，在工业及民用建筑、交通运输、水利水电、军事施工建设中发挥着非常重要的作用。液压挖掘机被应用于众多诸如平整场地、一定形状的沟、渠道挖掘等复杂作业。其工作装置运动轨迹的自动控制是研制中的一个重要课题。由于挖掘机在实际工作中，挖掘阶段转台不回转，静止不动，转台回转时，工作装置不挖掘，因此，工作装置挖掘轨迹的控制，可归结为动臂、斗杆和铲斗三个杆件的平面控制问题，即对于任意给定的动臂、斗杆目标轨迹和铲斗方位角，可将其变换为工装三杆件的目标转角序列，由微机控制电液伺服驱动系统，使动臂、斗杆和铲斗跟踪各自的目标转角，从而实现轨迹控制。其机、电液一体化系统简图如图12所示。名称长度（MM）行程（MM）转角范围（）驱动件缸径（MM）活塞杆直径（MM）动臂2558660117双缸8045斗杆1332585117单缸9050铲斗835500170单缸8045哈尔滨工业大学课程设计说明书（论文）图12液压挖掘机机、电液一体化系统简图本次课程设计中机遇实验室的液压挖掘机装置主要设计参数如下挖掘机工作负载参数要求M500KG挖掘机工作装置轨迹参数要求挖掘水平直线挖掘机工作装置轨迹控制系统设计要求以51单片机为控制处理器角度传感器选择电阻式角位移传感器12电液控制系统的组成电液控制系统是在要控制的转轴处增加了角度传感器获取转角数据，通过控制器处理并由电液转换元件驱动液压缸运动，使铲斗达到预计的轨迹。计算机控制系统由液压缸、电液比例流量阀、比例放大器、角度传感器、A/D和D/A卡等环节组成，如图13所示。系统可分为数字和模拟两部分，通过A/D和D/A转换器把两部分组成一个数字、模拟混合系统。数字部分采用51单片机，模拟部分包括除51单片机外的各环节。RY给定值输出值图13系统控制框图（1）角度传感器角度传感器将各臂位置角转化为电信号，供控制器处理。在研究中，我们将斗尖轨迹的控制转化为对动臂和斗杆各自的相对转角的控制。控制装置中的选择是电阻式角位移传感器，输出为模拟电压量，需要通过A/D转换环节才能供控制器处理。（2）控制器及数据采集卡控制器D/A放大器电液比例阀液压缸动臂/斗杆A/D角度传感器哈尔滨工业大学课程设计说明书（论文）控制器主要完成将传感器的信号按照控制算法进行运算后输出控制量的工作。本设计采用在PC机内接入集成了A/D和D/A转换芯片的模入模出控制卡，此卡将角度传感器输出的模拟量转化为对应角度的数字值，运算后将结果转换为模拟信号，将控制量以电压形式输出。（3）电液转换部分此部分主要由电液比例阀，放大器组成。实验平台选用北京华德液压工业集团有限责任公司生产的2FRE6A20B/10QM型号二通比例调速阀，并配有与之配套的放大器VT5010S30在液压控制系统中，虽然采用伺服阀精度最高，且响应最快，但其成本高，对污染敏感，很少用在普通场合。而比例阀的价格只有伺服阀的1/81/10，但具有与节流阀相似的抗污染能力。虽然与伺服阀相比，比例阀的频宽较窄、精度稍差，但如果和微机及角度传感器构成闭环反馈系统，应用合适的控制方法，完全可以达到较高的定位精度。因此在本设计中采用微机控制比例法系统的方式实现液压挖掘机工装轨迹的控制。第二章液压挖掘机工装轨迹的运动学分析21运动学问题运动学是指对给定的液压挖掘机，已知杆件几何参数和关节变量，求铲斗相对于参考坐标系的位置和姿态。按照DH坐标系的规则和定义，设置微机操纵系统液压挖掘机的杆件坐标系，如图哈尔滨工业大学课程设计说明书（论文）21所示。第0号坐标系在基座上的位置和方向任选，只要轴沿第一关节运动轴，即0Z挖掘机上车回转中心即可。最后一个坐标系，即第4号坐标系，可放在铲斗的任何部分，只要与垂直即可。去铲斗纵向对称面上铲斗与斗杆的铰接点与斗齿尖连成轴，3Z43O4X铰点的回转轴线为轴。是工装纵向对称面上的一根水平轴，在动臂两端铰点连线1X2X上，在斗杆两端铰点连线上。I取0、1、2、3、4时个参数值见表213X图21反铲斗液压挖掘机工作装置示意图表21各参数的含义为到沿方向上的距离（与同方向为正）ID1IOI1IZ1IZ到沿方向上的距离与同方向为正IAIIIXIX从到绕轴的转角（逆时针为正）I1II1IIIIIDIL11901122002L330344904L哈尔滨工业大学课程设计说明书（论文）到沿方向上的距离IL1IOIIX通过矩阵变换，首先把第四象限的坐标变换到第三象限，再把第三象限的坐标变换到第二象限，再把第一象限的坐标变换到第一象限，再把第一象限变换到第0象限，因此，铲斗坐标系到大地坐标系的变换矩阵为012344TT本次设计中取取斗尖位置坐标在基123450,58,12,0LMLLML座坐标系中的表示为，由此得铲斗尖位姿的正解为1XYZ12342321COS83SCOS58COS6IN50/6ININXYZ为获取斗尖包络区域，为下面轨迹位置选择提供参考，取动臂转角范围为步长为；斗杆转角范围为，步长为，利用MATLAB做出斗尖所50671140231能达到的位置，如图22。哈尔滨工业大学课程设计说明书（论文）0100020003000400050006000400030002000100001000200030004000图22斗尖包络区域22运动学逆问题为简化计算，将第1号坐标系轴建立在平面内，。并将铲斗1X00YOZ190以锁死，即。取直线轨迹，将所需控制的轨迹离散为若干点坐标，30430350Y并根据上述方程，可得出斗尖的在每一点时的动臂、斗杆的角度序列。利用MATLAB解上述方程组，得到10组数值解如表22所示。表22运动学逆问题求解哈尔滨工业大学课程设计说明书（论文）第三章液压挖掘机液压系统的建模分析对于一个连续系统数学模型的表示，可采用微分方程、传递函数、状态方程等方式。在本文中，对控制系统数学模型的描述采用传递函数的方式。本章通过计算各环节的传递函数，进而得到整个被控系统的传递函数，作为控制仿真的模型，进而实现获取系统的特性，检验控制方法的效果，实现对控制参数的整定等目标。31斗杆液压缸的传递函数斗杆液压缸的缸径、活塞杆直径、形成，活塞杆及90DM50DM58HM负载的质量。5MKG1）活塞平均面积2232095498104DA2）容腔总容积30154MTVH液压缸有效面积（活塞行程阀至缸间管路折算距离）（80）263）液压缸固有频率YZ231000100020068131181100100016613130401200100013324129461300100010216128371400100073051127141500100046022125791600100021125124321700100001650112273180010002234012104190010004097711925哈尔滨工业大学课程设计说明书（论文）2832H34710406565ETAVM式中取E84）液压阻尼比2268332162C015705101440430MR5141ASECEHTCCEKVADKP式中阀芯直径，由上，得斗杆液压缸传递函数32动1534222732710100165QHKAGSSSSSS臂液压缸的传递函数斗杆液压缸的缸径、活塞杆直径、形成，活塞杆80DM450DM60HM及负载的质量。5KG1）活塞平均面积222320845104DA2）容腔总容积34MTVH液压缸有效面积（活塞行程阀至缸间管路折算距离）150（6）23）液压缸固有频率2832H471041689325ETAV式中取E84）液压阻尼比则单个液2268332162C0157051019724430MR51010ASECEHTCCEKVADKP式中阀芯直径，哈尔滨工业大学课程设计说明书（论文）压缸的传递函数为因两个25342229079071111683QHKAGSSSSSS液压缸并联驱动动臂，故动臂液压缸的传递函数为2G2534221001QHKAGSSSS33其它环节传递函数试验台2FRE6A20B/10QM型号二通比例调速阀，并与之配有配套的放大器VT5010，依据厂家提供的技术规格，其频率特性为2HZ，这一值在一般情况下为系统在公称压力时阀相应的最高频率，在一般工作情况下，其频率响应一般在1HZ左右，这一值同系统的动力执行机构液压缸的频响相比，电液比例阀的频率特性是不可忽略的，视为一阶惯性环节来讨论，其传递函数可近似的写成3S1QKGIT式中电液比例阀的时间常数T电液比例阀增益K由产品性能查得比例阀的额定流量0/MINL线圈输入电流最大值2CIA则电液比例阀的流量增益440E120716QKI当电液比例阀的频率特性为1HZ时，其时间常数592F1T则电液比例阀的传递函数为43S071QKGIS比例放大器的输入信号为DAC0832卡的输出电压信号，范围为010V，其输出信号为比例阀的电磁铁的线圈电流，范围为022A，故此放大器传递函数为4S201IV所选的传感器是电阻式角位移传感器，它输出的是电压值，经A/D转换得到数字信号，A/D转换器的时间常数远小于机械本体的时间常数以及计算机的采样频率，可以忽略其时间效应，将其视为一个比例环节，近似为单位负反馈，即传递函数为哈尔滨工业大学课程设计说明书（论文）1HS此处斗杆的传递函数为斗杆液压缸的活塞位移与斗杆相对于动臂的角度的关系。根据设计数据，斗杆相对于机身的转角范围为，斗杆液压缸活塞杆的行程为017，故斗杆的传递函数为058M5178S3490G动臂的传递函数为动臂液压缸的活塞位移与动臂相对于机身的角度的关系。根据设计数据，动臂相对于机身的转角范围为，动臂液压缸活塞杆的行程为，1706M故动臂的传递函数为51780S396G34斗杆系统的整体建模与仿真系统闭环传递函数为64532018673872109901867BLGSSSS用MATLAB对其进行仿真，得到闭环系统的单位阶跃响应如图32，同时得到其动态时域指标，峰值，即无超调，峰值时间，调整时间。图33为单PYPT209ST位阶跃响应稳态误差曲线，由图中可得到系统的静态时域指标，稳态误差。ES控制器D/A022410759S53422721010SS349A/D1哈尔滨工业大学课程设计说明书（论文）与与与与与与与与与与与与与与与与SEC与与05010015020025030000102030405060708091SYSTEMGB1FINALVALUE1SYSTEMGB1RISETIMESEC117SYSTEMGB1SETTLINGTIMESEC209图32斗杆系统无控制器单位阶跃响应05010015020025030000102030405060708091与与与与与与与与与与与与与与与与与与与与SEC与与图33斗杆系统无控制器单位阶跃响应稳态误差系统的开环传递函数为哈尔滨工业大学课程设计说明书（论文）6453201873872909KLGSSSS图34为系统的开环伯德图，有图可以得到系统的开环频域性能指标，幅值裕度。幅值穿越频率，相位裕度，剪切频率9MDB6/ECGRAD89DEGMP。输入的正弦信号，系统的响应如图35所示，从图中可以看0187/SECCRASIN2出，跟踪过程存在相当大的误差和相位延迟。25020015010050050与与DB10210110010110210310436027018090DEG与与与与与与与与与GM988DBAT142RAD/SEC,PM898DEGAT00187RAD/SEC与与RAD/SEC图34斗杆系统开环伯德图051015202530351080604020020406081与与与与与与与与与与与与与与与与SEC与与与与图35斗杆系统正弦跟踪35动臂系统的整体建模与仿真哈尔滨工业大学课程设计说明书（论文）系统闭环传递函数为645320495107281049BLGSSSS用MATLAB2012对其进行仿真，得到闭环系统的单位阶跃响应如图36，同时得到其动态时域指标，峰值，即无超调，峰值时间，调整时间。图37PY1PT18ST为单位阶跃响应稳态误差曲线，由图中可得到系统的静态时域指标，稳态误差。0ES05010015000102030405060708091与与与与与与与与与与与与与与与与SEC与与图36动臂系统无控制器单位阶跃响应控制器D/A022410759S3098A/D153428100SS哈尔滨工业大学课程设计说明书（论文）05010015000102030405060708091与与与与与与与与与与与与与与与与与与与与SEC与与图37动臂系统无控制器单位阶跃响应稳态误差系统的开环传递函数为6453202951710BLGSSSS图38为系统的开环伯德图，有图可以得到系统的开环频域性能指标，幅值裕度。幅值穿越频率，相位裕度，剪切频率8MDB8/ECGRAD896DEGMP。输入的正弦信号，系统的响应如图39所示，从图中可以看042/SECCRASIN2出，跟踪过程存在相当大的误差和相位延迟。哈尔滨工业大学课程设计说明书（论文）20015010050050与与DB10210110010110210336027018090与与DEG与与与与与与与与与GM886DBAT118RAD/SEC,PM896DEGAT00423RAD/SEC与与RAD/SEC图38动臂系统开环伯德图与与与与与与与与与与与与与与与与SEC与与051015202530351080604020020406081图39动臂系统无控制器争先跟踪曲线第四章控制系统的电路设计哈尔滨工业大学课程设计说明书（论文）对挖掘臂上动臂和斗杆两个转角进行控制，达到铲斗尖在与地面垂直面上按特定轨迹运动的目的。拟采用动臂先动，斗杆跟随的方案。将在垂直面上的铲斗尖轨迹离散为若干点，铲斗尖一次达到这些点，就能近似完成所需轨迹。由运动模型可知，每一点都对应一组动臂和斗杆的角度值（，），动臂上角度传感器检测到动12臂转角为时，通过所设计的控制器控制斗杆转角达到，即完成一点的控制。当1依次完成所有点时，即完成所需轨迹的控制。控制流程图及系统总体结构如图41所示。图41对于本系统，选用PC作为控制器，通常被检测和控制的量是连续变化的模拟量，而计算机能直接处理的是数字量，所以需要将检测元件输出的模拟量转化为数字量，A/D转换卡；另外为了实现控制量的输出，需要将数字量转换为模拟量对液压挖掘机轨迹进行控制，即还需要D/A转换卡。41角度传感器的选择本系统装置选用的角度传感器是电阻式位移传感器，具有线性度好的特点，输出电压05V。角位移传感器相当于一个滑动变阻器，当角度发生变化时，输出端的电阻值发生变化，从而引起输出端电压产生变化。（1）角度传感器的标定液压挖掘机的动臂和斗杆的工作角度都有一定范围的，根据设计的理论推荐制和样机的实际工装尺寸，选择动臂的角度范围为0110，斗杆的角度变化范围为0120。为实际安装和测试方便，两角度传感器选用统一的标定。为确保工作装置的可靠，选择角度传感器的量程为0125，则有5/125004伏/度，即角度传感器没变化一度，其输出电压变化002伏。（2）角度传感器接口角度传感器相当于一个滑动变阻器，为使其工作在最佳线性区段，应是其工作在满量程的2/3范围内。为保证测量电压稳定，减少测量误差，角位移传感器及其接口电路如图42所示。由于供电电源的波纹大小直接影响到A/D转换的精键盘显示器51单片机A/DD/AD/A动臂角度传感器电液比例阀操作手柄斗杆角度传感器电液比例阀动臂液压缸斗杆液压缸斗杆动臂哈尔滨工业大学课程设计说明书（论文）度，故将电源电压经330NF和1000F电容分别进行高低频滤波，在经过7809稳压后，供给角位移传感器，为确保角位移传感器输出电压在05V，对角位移传感器输出端信号用1K电阻和47NF电容进行滤波，二极管钳位后送入ADC0809进行A/D转换。图42角度传感器与ADC0809的接口电路42A/D转换器及其接口电路该电路的输入端口由74LS00和74LS30及38线译码器74LS138所组成。译码电路受PC机IOW和IOR信号控制，即只有在进行I/O读写操作时，该译码电路才起作用，为了减轻PC机IOW和IOR线的负载，将它们经74LS125缓冲，74LS125工作在通常状态下。本卡中共使用了六个地址，地址分配如下278H用于起动ADC0809开始转换；279H用于检查A/D转换结束否；27AH用于向ADC0809发送允许输送信号OE，以便将转换的数据取走27BH用于D/A转换芯片DAC0832的片选信号；27CH用于A/D的中断允许寄存器置1，即相当于开A/D中断27DH用于清零A/D的中断允许寄存器，相当于关A/D中断。（1）ADC0809功能介绍ADC0809是CMOS器件，不仅包括一个8位的逐次逼近型的ADC部分，而且还提供一个8通道的模拟多路开关和通道寻址逻辑，因而有理由把它作为简单的“数据采集系统”。利用它可直接输入8个单端的模拟信号分时进行A/D转换，运动控制中应用十分广泛。主要特性如下1）分辨率8位2）转换时间取决芯片时钟频率，如CLK500KHZ时，转换时间约为128S3）模拟输入电压范围单极性05V；双极性5V，10V4）单一电源5V5）使用时不需进行零点和满刻度调节6）具有可控三态输出缓存器（2）A/D转换工作方式该电路由DAC0809转换芯片、74LS123单稳触发器，74LS90分频器和74LS74D触发器等组成，并带有74LS74中断屏蔽寄存器，当程控开中断时，A/D转换结束信号EOC可作为中断请求信号。1）工作过程本卡使用74LS90将PC机扩充槽的时钟信号CLK分频变成适合ADC0809工作的频率。用口地址27BH作为ADC0809起动信号送入地址，启动信号有数据线D7位产生，而通道哈尔滨工业大学课程设计说明书（论文）号由D0D1D2产生，当选中278BH口地址，并且D7位由1变为0时，则经与非门U产生一正阶跃，用此信号触发单稳，产生宽度约1S左右的启动脉冲用于起动A/D进行转换，实现此过程可用以下指令序列，如对0通道启动采样MOVDX，278HMOVAL，80HOUTDX，ALMOVAL，00HOUTDX，AL如对第4通道采样，则可用如下指令序列MOVDX，278HMOVAL，80HOUTDX，ALMOVAL，04HOUTDX，AL其他通道同理即用D7位产生10的变化，以形成一个起动A/D转换的脉冲，而D2,D0,D1保持不变，以表示通道号转换是否结束，采用查询方式，对口地址279H不断进行读出操作，当第7位为1时，表示转换结束，可用口地址27AH将转换结果取走，如可采用如下指令序列MOVDX，279HLOOPINAL，DXTESTAL，80JZLOOPMOVDX，AHINAL，DXMOVBUFFER，AL；将转换结果送入缓冲区INCBUFFER；缓冲区地址加一JIMSTART；转A/D启动指令去执行上述是查询工作方式，若要中断方式下工作，则可采用如下指令序列MOVDX，27CHOUTDX，AL；开中断A/D转换结束产生EOC信号通过三态门，成为中断请求信号。当从A/D中断服务程序退出，主程序不在使用A/D中断或退回EOS时，应关A/D中断屏蔽器，以便将A/D占用的中断号让出，即用指令MOVDX，27DHOUTDX，ALAL中可为任意数43D/A转换器及接口电路1）DAC0832功能介绍DAC0832是八位分辨率的转换集成芯片，与处理器完全兼容。这种芯片的价格低廉、接口简单、转换控制容易。DAC0832是最早和微处理器兼容的、双缓冲的转换器。其工作特性如下A）DAC0832是微处理器兼容型转换器，可以充分利用为处理器的控制能力实现对D/A哈尔滨工业大学课程设计说明书（论文）转换的控制。B）集锁存器控制功能，能够实现多通道D/A转换器，能实现多通道D/A的同步转换输出。C）DAC0832内部无参考电压源，需要外接。D）ADC0832为直流输出型D/A转换器，要获得模拟电压是需要外加转换器电路。具体电路在A/D、D/A转换电路中可以看到。2）D/A转换电路该电路由D/A转换芯片DAC0832及双运算放大器LM358等组成。LM358输入失调电压2MV，它有自调零功能，因而省去了调零电路。LM358可用LM258或ML158代替，也可用国产的一些，这些都是低价格的。由于D/A电路具有数字地和模拟地之分，因此在电路连接时，模拟地汇集一点，数字地汇集一点，然后两点连接共地，否则会形成串模干扰，造成转换时的误差。电阻R2R3R4应是较精确电阻，阻值精确到04即可，R2R4，R2/R32，本电路采用R2R415K、R375KDAC0832工作于单缓冲方式下，即当CS和IOW来信号时，直通立即转换，当IOW信号消失时，便将数据锁存于输入寄存器，使转换输出保持不变。该电路的片选CS信号用地址27BH，将待转换的数据通过数据总线，送入DAC0832时，可立即用输出指令将转换结果输出，采用如下程序MOVDX,27BHMOVAL,0FFHOUTDX,AL此时将会把FFH转换出一个496V左右电压。45控制系统的电路原理图设计根据上述设计理论讲A/D、D/A转换器与他们的外部接口连接在一起，放在电路板上，然后连接在51单片机的外部接口上，再与角位移传感器相连，即构成了控制系统的整体电路图，如43图所示哈尔滨工业大学课程设计说明书（论文）图43DAC0832的双缓冲接口电路第五章控制方法的选择及MATLAB仿真技术哈尔滨工业大学课程设计说明书（论文）51计算机实现PID控制常用的有PID控制器、超前、滞后补偿控制器等，用以调整系统稳定性、裕度值等多项指标。PID控制器是最早发展起来的控制策略之一，在产生过程的发展历程中，PID控制是历史最久、生命力最强的基本控制方式。因为这种控制具有简单的控制结构，在实践应用中又较易于整定，所以它在工业过程控制中有着最规范的应用。常规PID控制系统原理框图如图51所示，系统由模拟PID和被控对象组成。在连续控制系统中，按偏差的比例（P）、积分（I）和微分（D）进行控制是最为常用的一种控制规律。该控制规律具有原理简单、易于实现，鲁棒性（ROUSTNESS）强和适用范围广等特点。PID控制器是应用最为广泛的一种调节器。该控制器的参数比例系数KP、积分时间常数TI和微分时间常数TD相互独立，参数整定比较方便。此外，PID控制算法简单，计算工作量小，易于实现多回路控制。MATLAB是当今世界上最优秀的数值计算软件，具有丰富可靠的矩阵处理、图形绘制功能，语句简单、易学易用等特点。MATLAB中的SIMULINK工具箱，是控制系统计算与仿真最先进的工具。其主要功能是实现动态系统建模、仿真与分析，从而可以在实际系统制作出来之前，预先对系统进行仿真与分析，并可以对系统做适当的实时修正或者按照仿真的时间，实现高效率的开发系统的目标。本文用MATLAB2012B实现对反铲单斗液压挖掘机的控制系统仿真。52斗杆系统PID控制仿真斗杆系统PID的参数。使用MATLAB2012B，对系统的时95,02,1KPIKD域和频域性能指标进行分析。系统的闭环传递函数为2_45432816851210930795041682PIDBLSGSSSS选择RUNGEKUTTA四阶算法，采用周期为005S，输入为单位阶跃信号，系统的单位阶跃响应曲线及误差曲线如图51所示，图中线条为输入单位阶跃信号，2为系统的响应曲线，3为误差曲线。同时得到其动态时域指标，峰值为，即无超调，峰值PY时间，调整时间，静态时域指标稳态误差。此时与原系统单位2PTS10ST0ES阶跃响应比较如图52所示，从图中看出，斗杆系统加入PID控制后，在保证其它指标不变的同时响应时间明显缩短。哈尔滨工业大学课程设计说明书（论文）00204060811214161800102030405060708091与与与与与与PID与与与与与与与与与与与与与SEC与与与与与与与与图51斗杆PID控制系统单位阶跃响应及误差05010015020025030000204060811214与与与与与与与与与与与PID与与与与与与与与与与与与与与SEC与与图52单位阶跃响应的比较斗杆系统的开环传递函数为2_4543208116852937950PIDKLSGSS哈尔滨工业大学课程设计说明书（论文）系统的开环伯德图如图53所示，与原系统伯德图的比较如图54所示。由图55可以得到系统的开环频域性能指标，幅值裕度，幅值穿越频率591GMDB，相位裕度，剪切频率。从图55中可157/SECGRAD748DEGPM7/SECCRA以看出，系统加入PID控制后，比原来的截止频率变大，截止带宽变宽，及系统允许工作的最高频率范围变大，动态性能变好，响应的快速性变好。4003002001000100与与DB10110010110210310410510636027018090与与DEG与与PID与与与与与与与与与GM591DBAT153RAD/SEC,PM748DEGAT171RAD/SEC与与RAD/SEC图53斗杆PID控制系统开环伯德图哈尔滨工业大学课程设计说明书（论文）4003002001000100与与DB10110010110210310410510636027018090与与DEG与与与与与PID与与与与与与与与与与与与与RAD/SEC图54开环伯德图的比较当给系统输入的正弦信号，系统对其的跟踪程度如图55所示，图中1为输SIN2入信号，2为系统的跟踪输出。从图中可以看出，跟踪过程存在微小的误差和相SI位延迟，可以在较快的时间内达到设定的控制量。051015202530351080604020020406081与与与与与与PID与与与与与与与与与与SEC与与与与哈尔滨工业大学课程设计说明书（论文）图55斗杆PID控制系统正弦跟踪53动臂系统PID控制仿真MATLAB的SIMULINK工具箱，可以绘制出动臂回路的PID控制模型图，如图57所示。斗杆系统PID的参数。使用MATLAB2012B，对系统的时45,02,1KPIKD域和频域性能指标进行分析。系统的闭环传递函数为2_45432365865338910810901826PIDBLSGSSSS选择RUNGEKUTTA四阶算法，采用周期为005S，输入为单位阶跃信号，系统的单位阶跃响应曲线及误差曲线如图56所示，图中线条为输入单位阶跃信号，2为系统的响应曲线，3为误差曲线。同时得到其动态时域指标，峰值为，即无超调，峰值PY时间，调整时间，静态时域指标稳态误差。此时与原系25PTS09ST029ES统单位阶跃响应比较如图57所示，从图中看出，斗杆系统加入PID控制后，在保证其它指标不变的同时响应时间明显缩短。00204060