您的当前位置:首页正文

高精度全闭环伺服系统研究-控制理论与控制工程专业论文

2021-05-19 来源:步旅网



优秀毕业论文

随着当今科学技术的发展,人们逐步认识到:机电一体化技术的发展状况是衡量一个国家机械工业发展水平的重要标志。然而,我国同工业发达图家相比,机电一体化技术还比较落后。运动控制技术是机电一体化技术的核心部分。因此,对运动控制技术作深入细致的研究,把握国内外运动控制技术的最薪发展动态,提高运动控制技术水平,对提高我国的机电一体化技术具有至关重要的意义,也是摆在我们面前的一个重大课题。本文给出了运动控制的概念,阐述了运动控制系统的组成和分类,综述了运动控制技术的国内外发展现状,荠对运动控制系统孛的关键技术进行了研究。其主要内容包括以下几个方面。

1.从永磁同步交流伺服电机的数学模型着手,逐步深入到伺服系统中的控制器,控制技术,对交流伺服控制系统进行了研究。基于永磁同步电机(PMSM)的解耦状态方程,将滑模变结构控制方法(SMC)引入到对永磁同步交流电机(PMSM)位置环和速度环的设计中。并且,将单段滑模线控制扩展成包括加速段、恒速段和减速段的完全滑动轨迹控制。仿真实验表明:与传统的PID控制算法耜比,利用该控制方案使得系统具有良好的快速性、定位无超调;同时,提高系统的精度和鲁棒性。

2。优化轨迹规划算法能够提高运动控制系统的速度和精度。本文研究了直线、S曲线、指数曲线等轨迹规划算法;给出了每种算法的详细推导公式并通过Matlab仿真得到了各种算法相应的加速度、速度和位移睦线,分析了各种算法的优缺点。本文还针对多轴运动控制系统探讨了直线播补和圆弧插补算法,同时分析了多轴运动

的精度问题。

3.开放式运动控制系统是整个运动控制系统的发展趋势。在开放式运动控制系统中,运动控制嚣是核心。本文介绍了多辘运动控制卡(PMAC),研究了PID+度/力口速度前馈的控制算法。利用PEWIN软件,对系统的控制参数进行了校正和调整,提高了系统的稳态特性和动态特性,改善了系统的稳定性和响应速度。

4。为了提高IIPMAC组成的半闭环系统的定使精度,本文首先筒要介绍了基PMAC半闭环系统的组成及原理,分析了系统定位误差产生的原因;然后利用PMAC的误差补偿功能,采用软件补偿方法对可能产生的误差进行了补偿。最后以卓刨恒信AC200教学设备为实验平台,验证了该补偿方法的有效性,从而较大地提高了系统的定位精度。

关键词:4运动控制;PMSM;滑模控制;轨迹规划;腑AC;误差补偿

精品参考文献资料



优秀毕业论文

Abstract

Withthedevelopmentoftechnology nowadaysitisrealizedthat the progress of one

country’Selectromechanicalintegrationtechnologyindicates itsmechanicalindustrylevel

Comparedwiththe developedcountriesourelectromechanicalintegrationtechnologyis

underdevelopedMotioncontroltechnology isthecoreintegralpanofelectromechanical

integrationtechnologyItisallimportanttasktoresearchonmotioncontrol technology

graspthe newesttrendsand raisethelevel of ourmotioncontrol technologyMotion

controlisalsoagreattask infront of USThisthesis introduces the concept of motion

controlexpatiates

the components of motion control system and

analyzes the

developmentofmotion control technologyAndmakeadeepresearch onthekey

technologiesof motion contr01Themain contentincludesthe following

1)Startedfrom the mathematicalmodelof permanentmagnetismsynchronous

servomotionthe research gradually goes deep into the controlleroftheservosystemand

theentire systemThesliding modecontrolisusedin the designofthe outside loop of

PMSMbasedondecouplingstateequationof itInadditionthesliding line isextendedto

afullsliding trajectorycontrolincorporating accelerationconstantspeedand

decelerationsegmentsThesimulationandexperimentresults showthatthe sliding mode

controlprovides well speediness andnopositionovershootAtthe same timeitalso

enhancestheprecision and robustness of the system

Optimizingthetrajectoryplanningalgorithmhelpstoimprovethespeed and

theprecision of the motion control systemThispaperhas aresearchonT—velocity

curveS

velocitycurveAndproposes anewE—velocitycurveanalyzesthe property ofthree

CurVeSindetail andgetthe accelerationvelocity,displacementcurveviaMatlab65for

everyalgorithmAimingatmulti-axesmotion systemthepaperalsointroduceslinerand

ckcularinterpolationAtlast the precisionofthe multi-axessystem isanalyzed

3)Theopenmotion control system isthetrend for the entire motion control field

Thecorepartin openmotion controlismotioncontroHerThepaper introducedthe

programmablemulti-axescontroller andresearchedonthePID+velocityacceleration

feedforwordalgorithmTheparametersofthe controHer areadjustedviathe software

PEWINThroughthisthe precision andspeedof both stabilianddynamicin

positionsystemis improved

Inordertoraisetheprecisionthehalfclosedpositionsystemthepaper firstly

presentstheelementsandprinciplesof half closed loop systemanalyzesthereasonsof

精品参考文献资料



优秀毕业论文

positioningerrorsAnditimprovesthepositioning precision by the wayoferrorcomprehensionItisshownbyexperiments donewiththe AC-200equipment thatthe positioning precisioncanbegreatly improvedbythisway

KeywordsmotioncontrolPMSMslidingcontroltrajectoryplanningPMAC errorcomprehension

精品参考文献资料



优秀毕业论文

举位论文独铋性声明、学位论文知识产毅税属声髑

学位论文独创性声明

本人声明,所呈交的学位论文系本人在导师指导下所取锝的研究成果。凡文中涉及到非本人成果均已标注出处或得到许可,此外不再包含其他个人或集体己经发表或撰写过的科研成果,也不包含本人已用于申请其他学位的论文内容或成果。

本入如违反上述声明,愿意承掇由此孳l发的一切责任和后果。

论文作者签名:高推

网期:溯年‘月心口

学位论文知识产权权属声明
本人在导师指导下所完成的学位论文及相关的职务侔品,知识产权归属学校。

学校享有以任何方式发表、复制、公开阅览、借阅以及申请专利等权利。本人离校

后发表或使用该学位论文内容或与该论文直接相关的成果时,署名单位仍然为青岛大学

本学位论文属于:保密口,在年解密后适用

于本声明。不保密瓯

(请在以上方橇内打“√捧)论文作者签名:勰 固期游占月必翻

导师签名:f 霉拶吻

日期:曙%丽田

(本声明的版权归旨岛大学所蠢,未经许可,任何单位及任何个人不餐擅自使用)

精品参考文献资料



优秀毕业论文

第一章绪论

第一章绪论

11运动控制技术的意义

运动控制通常是指在复杂的条件下,将预订的控制方案、规划指令转变为期望的机械运动【l】。运动控制系统是被控机械实现精确的位置控制、速度控制、加速度控制、转矩或力的控制,以及这些被控机械量的综合控制。运动控制技术是一门综合性、多学科交叉的技术,是“推动新的产业革命的关键技术",其发展是“制造自动化前进的旋律”园。

运动控制最初是由电力拖动发展而来的。随着电力电子技术、微电子技术的迅猛发展,原有的毫力拖动控制已经不能充分地概括现代自动化系统中承担一线任务的全部控制设备。运动控SU(MotionContr01)作为自动化技术的~个分支,在20世纪末进入快速发展的阶段【34】。如今,运动控制技术已成为发展迅速,应用广泛,最引入瞩目的技术之~,是推动新的技术革命和新的产业革命的关键技术。运动控制技

术能够快速发展主要有两大原斟卅:首先是得益于计算机技术、数字信号处理技术、

自动控制技术、网络技术的发展;其次是有庞大的市场需求。例如传统制造领域技术

提升的需求,电子加工、芯片制造和新型光机电~体化设备控制的需求都离不开运动

控制。随着运动控制技术的不断进步和完善,运动控制簇作蔻一个独立的控制类产品已逐渐被越来越多的产业领域接受,并已经达到一个引人瞩目的市场规模。它作为现代化设备的核心控制部件,其开放性、通用性、可靠性和高速高精度是衡量它 是否能够在工业界立足的关键。近几年来,运动控制类产品发展不断加速,新产品 不断涌现。基于PC总线的开放式结构运动控制器,基于网络的开放式结构运 控制器,嵌入式结构的运动控制器等将逐步作力主导产品得到越来越广泛的疲用。

总之,只要存在对运动机构进行精确控制的任务,就离不开运动控制系统,运动控制技术得到了各个国家的重视,已经成为一个专门的技术领域。因此,对运动控制技术作深入细致的研究,把握国内外运动控制技术的最新发展动态,提高运动控制技术水平,对提高我国的工业发展具有至关重要的意义,是摆在我们面前的一个重大课题。

{2运动控制系统的维成与分类12

1运动控制系统的组成

应用在各个领域的典型运动控制系统主要由运动控制器、驱动器、执行机构、

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

机械传动机构和反馈装置构成阈,如图11所示。

11运动系统构成圈

(1)运动控利器响应闭环信号和接受控制系统的定位请求信号,将分析、计算所得出的运动命令以数字脉冲信号或模拟量的形式送到电机驱动器中。运动控制器通常是运动控制卡、具有运动控制功能的PLC、数控系统(CNC)或单片机系统等。 (2)驱动器其功能是进行功率变换,弗驱动电机根据上位控割指令转动。

(3)执行机构运动控制系统中常用的执行机构一般为步进电机、数字式交流伺服电祝和童流伺服电视等,其优点是受控性能好,精度高。

(4)反馈装置其作用是将检测到的位置或速度反馈到控制器或驱动器中,构成誊闭环或全阈环控制,其检测元件有脉冲编码器、旋转变压器、感应同步器、光栅尺、磁尺及激光干涉仪等。

{22运动控制系统的分类

1)按执行机构分类运动控制系统按照执行机构可分为:气动系统、液动系统和电动 系统。气动机

构是以压缩空气为工作介质来传递动力和控制信号的机构。这种方法以空气为工作介质,用屠可直接排到大气中,处理方便。但是,由于空气具有可压缩性,因此工作速度稳定性稍差;液压机构是以液压油为动力源来宪成预定运动要求和实现备种功能的机构。这种执行器推力较大,但比较笨重,所以现在很少使用;电动执露机构是以电能作为能源通过控制中心给出的控制信号来实现各种控制功能的机构。近几年来随着机电~体化的不断发展,电动执行器在不断改进并有继续扩大应用的趋势。就目前来看,电动执行机构主要有:步进电视、誊流电机和交流电机。其中,交流电机作为目前应用最广泛的执行机构又可分为:永磁同步(SM)电动机和感应式异步(戳型)电动机。其中,永磁同步电动撬交流伺服系统在技术上已趋于完全成熟,具备了十分优良的低速性能,并可实现弱磁高速控制,拓宽了系统的调速范围,适应了商性能伺服驱动的要求。并曼随着永磁材料性能的大幅度提高和价格的降低,其在工业生产自动化领域中的应用将越来越广泛,目前已成为交流伺服系统的主流【蜩。

2

精品参考文献资料



优秀毕业论文

第一章绪论

2)按位置控制原理分类运动控制系统根据位置控制原理,郅有无检测反馈传感器以及检测部位, 霹分

为开环、半闭环和闭环三种基本控制方案IS]。开环控制系统无检测反馈装置,其执行电动机一般采用步进电机。优点是控制方便,结构简单,价格便宜。控制系统发出的指令是单向的,故不存在稳定性问题。缺点是机械传动误差不经过反馈校正,位置控制精度不嵩;半闭环控制系统的位置反馈采用转角检测元件,直接安装在饲服电机或丝杠端部。由于具有位置反馈比较控制,可获得较大的定位精度,大部分机械传动环节包括在系统闭环环路内,因此可获得较稳定的控制特性。丝杠等机械传动误差不能通过反馈校正,但可采用软件定值章}偿的方法来适当提高其精度;全闭环控制系统是采用光栅等检测元件对被控对象进行位置检测,可以消除从电机到被控单元之闻整个机械传动链中的传动误差,得到很高的静态定位精度。缺点是稳定性不高,系统设计和调整也比较复杂。

3)按控制方式分类运动控制按被控对象的性质和运动控制方式可分为位置控制、速
度控制和力矩
控制三种类型【5一。位置控制:转角位置或直线移动位置的控制。按数控原理分为点位运动控制,连续轨迹运动控制和同步运动控制。点位控制是点到点的定位控制,它既不控制点与点之间的运动轨迹,也不在此过程中进行加工或测量。连续轨迹控铡又分直线控制翻轮廓控制。直线控制是指被控对象以一定速度沿某个方向的鹰线运动(单轴或多轴联动),在此过程中要进行加工或测量。轮廓控制是控制两个或两个以上坐标轴移动的瞬时位置与速度,通过联动形成一个平面或空间的轮廓曲线或曲面。同步控制主要是谣轴或两轴以上的速度或位置的同步运动控制。速度控制:速度控制既可单独使用,如传输机、工作台等机械速度控制,也可以与位置控制联合成为双回路控铡,如各种数控机械的双回路饲服系统。力矩控制:燮料薄膜、钢带、布品和纸张等卷取机都是恒张力控制;自动组装机的拧紧螺母以及自动钻孔等场合,应采用力矩与位置同步控制。

4)按系统结构分类根据运动控制器的系统结构来分,主要可以分为基于微机总线技
术的运动控制
器、Soft型开放式运动控制器和嵌入式结构的运动控制器隧。基于计算机标准总线的运动控制器, 它是由具有开放体系结构,独立于计算机

的运动控制器与计算机摆结会构成。这种运动控期器大都采用DSP或微机芯片作为CPU,可完成运动规划、高速实时插补、伺服滤波控制和PLC功能,它开放的函数库可供用户根据不同的需求,在DOSWINDOWS等平台下自行开发应用软件,组成各种控制系统。Soft型开放式运动控制器,提供给用户最大的灵活性,其运动控制功能全部由软件来实现,而硬件部分仅是计算机与伺服驱动和外部IO之间的

3

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

标准化通用接口。嵌入式结构的运动控制器,这种运动控制器是把计算机嵌入到运动控制器中的一种产品,它能够独立运行。运动控制器与计算机之闻的通信依然是靠计算机总线,实质上是基于总线结构的运动控制器的一个变种。

{3先进的运动控制技术

在机电一体化技术迅速发展的同时,运动控制技术作为其关键组成部分,也得

到了前所未有的大发展,国内外各个厂家相继推出运动控制的新技术、新产品。主要有全闭环交流伺服驱动技术(fullclosedACscrvo)、直线电机驱动技术(1inearmotordriving)、运动控制卡瑟内。

131全闭环交流伺服驱动技术

在一些定位精度或动态要求比较高的机电一体化产品中,交流伺服系统的应用越来越广泛,其中数字式交流伺服系统更符合数字化控制模式的潮流,褥且调试、使用十分简单,因而备受青睐。

通常情况下,带位置环的伺服系统,位置环的反馈采样取自伺服电动机的编码器,对于传动链上的间隙及误差还不能补偿克服,只能形成半闭环的位置控制系统。在一些定位精度或动态响应要求比较高的机电一体化产品中,开始使用全闭环数字式交流伺服系统。这种伺服系统的驱动器采用了先进昀数字信号处理器(digitalsignalprocessorDSP),可以对电机轴后端的光电编码器进行位置采样,在驱动器和电机之闻构成位置和速度的闭环控制,并能充分发挥DSP的高速运算能力,自动完成整个伺服系统的增益调节,甚至可以跟踪负载变化,实时调节系统增益;有的驱动器

还具有快速傅立叶交换(FFT)的功能,测算出设备的机械共振点,并通过陷波滤波方式消除机械共振。其控制原理如图12所示。

光攘尺、磁裰尺等I2全闭环交流伺服控制原理图

精品参考文献资料



优秀毕业论文

第一章绪论

该控制系统克服了半闭环系统的缺陷,位置环的采样可以直接取自装在最后一级机械上的位置反馈元件,如光栅尺、磁栅尺、旋转编码器等,丽电动机上的编码器此时仅作为速度环的反馈,这样就可以消除机械上存在的一切间隙,并且该伺服系统还可以对机械传动上逊现的误差进行毒}偿,达到真正全闭环的功能,实现高精度位置控制。而且这种全闭环控制均有驱动器来完成,无需增加上位控制器的负担。由于采用全闭环交流饲服系统能获得极高的定位精度,而不需要增加上位控制系统的复杂程度,所以它广泛应用于数控机床、台钻机等高精度数控设备。

{32直线电机驱动技术

直线电机在机床进给伺服系统中的应用,近几年来已在世界机床行业得到重视,并在西欧工业发达地区掀起‘‘直线电机熟"。在机床进给系统中,采溺直线电动机直接驱动与原旋转电机传动的最大区别是取消了从电机到工作台(拖板)之间的机械传动环节,把机床进给传动链的长度缩短为零,因焉这种传动方式又被称为“零传动”。正是由于这种“零传动"方式,带来了原旋转电机驱动方式无法达到的性能指标和优点【2’71

高速响应。由于系统中直接取消了一些响应时间常数较大的机械传动件(如丝杠等),使整个闭环控制系统动态响应性能大大提高,反应异常灵敏快捷。

精度高。誊线驱动系统取消了由于丝杠等机械机构产生的传动闻隙和误差,减少了插补运动时因传动系统滞后带来的跟踪误差。通过直线位置检测反馈控制,即可大大提高机床的定位精度。

动刚度高。由于“直接驱动’’,避免了启动、变速和换向时因中间传动环节的弹性变形、摩擦磨损和反向间隙造成的运动滞后现象,同时也提高了其传动刚度。

速度快、加减速过程短。由于矗零传动"的高速响应性,使其加减速过程大大缩短。以实现起动时瞬间达到高速,高速运行时又能瞬间准停。可获得较高的加速度,一般可达2109,而滚珠丝枉传动的最大翻速度一般只有01Q59 行程长度不受限制。在导轨上通过串联直线电机,就可以无限延长其行程长度。

运动安静、噪音低。由于取消了传动丝杠等部件的机械摩擦,且导轨又可采用滚动导轨或磁垫悬浮导轨(无机械接触),其运动时噪音将大大降低了。

效率高。由于无中间传动环节,消除了机械摩擦时的能量损耗,传动效率大大提高。

在匿外工业运动控制相对发达的国家已开始推广使用相应酶产晶。其中美匿科尔摩根公司(Kollmorgen)PLATINNMDDL系列直线电机和SERVOSTARCD系列数字饲服放大器构成一耪典型的直线永磁饲服系统,它能提供很高的动态响应速度

5

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

和加速度、极高的刚度、较高的定位精度和平滑的无差运动;德国西门子公司、日本三并精枫公司、台湾上银科技公司等也开始在其产黑中应用直线电机。

133开放式运动控制结构

随着机电一体化技术的飞速发展,开放式的控制技术受到人们越来越多的关注。这种开放体系的结构有两种:lCNC+PC主板,将PC主板插入传统的CNC机器中,PC主板主要运行非实时控制,CNC主要用来傲以运动控制为主的实时控制。2PC+运动控制卡,在PC机中标准总线槽中插入运动控制卡用来做实时控制。目前,开放式数控系统豹研究得到了世界备主要工业国家的重视和支持,藿外影响较大的研究计划有美国的NGC(TheNextGeneration WorkstationMachineControUe0 OMAC(OpenModula Architecture Controller)计划,欧洲的OSACA(Open SystemArchitecturefor Control within AutomationSystem,自动化系统中控制器的开放式体系结构)计划,以及日本的OSEC(OpenSystemEnvironment forController)计划。各国都取得了相当显著的研究成果,并提出了一些构建开放式数控系统的模式和方法,这些模式方法总起来说都采用了闭环控制,具有高速、高精度、高可靠性和高安全性的特点,厨时在控割系统的软硬件上具有嫠好的开放性疆潮。

由于PC机的发展和普及,采用PC+运动控制卡作为位置控制装置将是主要发展趋势之一。这种方式可充分利用计算枧资源,用于复杂、柔性较大的机器和设备。现代开放式的数控系统基本上由基于PC的运动控制卡、Io接口以及驱动器、伺服电机或步进电机等软硬件组成,并配有编码器、激光于涉仪或视觉识别器等传感器及四轴伺服运动控制卡的研制装置构成系统反馈回路。在硬件结构中掇供必要的总线接口和通信接口,同时针对实时性的要求,增强了浮点计算功能,提高了数据处理功能和曜络通讯功能,从箍具有了高集成度、高可靠性的特点。在软件上,开放式的数控系统提供了运动控制的开发平台,即基本的开发环境和基本的软硬件操作系统,如方便简易的编程环境、简易快捷的操作方式、底层的开发空阈和方式、基本的运动函数库等;更先迸的系统上还提供方便快捷的编译器、程序下载器,并其备对各种接口管理等的基本内部操作系统,发生误操作时或者硬件各单元和外部输入输出信号异常时的基本安全操作系统等。软硬件工程师在现场工程人员的需求指弓l下,能够快速有效的在平台上通过二次开发完成对各种机器设备的控制和操作任务,并由此逐步形成用户应用端的缴深产品。

基于以上思想,比较有代表性的是1994WiUiamDAllen等人所设计的钻石加工系统,其中采用DSP设计独立的运动控制卡,通过HEART总线与PC进行数据通讯,1998年美国YusufAltintas等人采用两块以DSP为核心的运动控制卡构建了基于PC总线的开放式数控系统,并设计了开放的实时的CNC操作系统软件和智
S

精品参考文献资料



优秀毕业论文

第一章绻论

能加工模块151YuyuanchangPauLoHsu等在高性能运动控制卡的基础上对曲线捶补方法傲了优化。还有美国的DeltaTau 公司提供了单台的解决方案和系统,插羚运算、伺服控制以及PLC功能全部由一块运动控制卡实现,利用PC完成人机交互和CAD等操作,此辩方式在单台撬床和机器入的控制中褥到了广泛应用。

在美国,最著名的运动控制卡制造商有DeltaTauGalilDMCAcrotcchTcch80等。美囡还专门成立了美困运动控制卡工程师协会(AnVIE)。在日本,开放式运动控制卡被认为是将来的第三次工业革命,并预测其应用的普遍性将与目前广泛应用的PLC类似,代表性的厂商为MAZAK公司和NOV公司。我图对开放式数控系统的研究起步晚,从搴运动控制技术豹机电产品的研究开发的单穰为数不多,虽然也取得了一定的成果,但是企业中的应用还不是很广泛,主要是一些研究单位为实现特

殊的需要和从开发的难度、成本的高低等方藤考虑,采用PC+运动控制卡的方式,构建适合于需要的运动控制系统。国内部分数控系统厂商采用此种方式将数控系统移植到PC机,如北京机床研究所的中华系列,沈阳计算所的“蓝天"系列,华中科技大学的“华中挣系列、‘‘航天"系列等。而企业界的应用则大部分选用了国外的运动控制卡,如Delta Tau 公司的PMAC系列等,构建自己的数控系统。

14本论文主要研究内容

本文围绕如何提高运动控制系统的稳态特性和动态特性,分别从控制器控制算法、运动轨迹规划算法以及误差补偿方法等角度,对提高运动控制系统性能的关键技术傲了有益的探索和研究,并通过仿真或实验验涯了这些方法兹有效性。本文的主要内容如下。

l≥探讨了运动控制系统的分类,深入分析研究了匿翦先进的运动控制技术的基本原理、特点以及发展趋势。

2)基于永磁同步电机的数学模型,将滑模变结构控制(SMC)方法引入到对永磁同步交流电机(PMSM)位置环和速度环的设计中。并将单段滑模线控制扩展成包括加速段、恒速段和减速段在内的完全滑动轨迹控制。

3≥介绍了PMAC运动控制卡,着重研究了围◆速度,加速度前馈算法及其参数的调节。

4)分析探讨7与运动轨迹规划相关的理论和算法。详细推导了直线、S形和指数形加减速算法,并通过仿真的方法得到了相应算法的速度,加速度以及位移曲线。针对多轴运动分析了插补算法以及多轴运动的控制精度问题。

5>为了提高拳闭环系统的定位精度,着重研究了基于PMAC控制器的误差李}偿方法及其实现,最后以卓创恒信AC200教学设备为实验平台,验证了该补偿方

7

精品参考文献资料



优秀毕业论文
青岛大学硕士学位论文

法的有效性。

8

精品参考文献资料



优秀毕业论文

第二辈永磁感步电掇戆宠全潺模变结构控制

第二章永磁同步电机的完全滑模变结构控制

在实际生产中,如激光加工机和数控机床的进给运动,机器人的手臂运动等应具有响应快、无超调、定位精度高等优良特性。然蠢露前普遗采用的PID控制难以有效地满足系统的特性。PID控制适用于可建立精确数学模型的确定性控制系统,愿对于实际的位置伺服系统,由于不可避免的干扰和不确定性,其控制模型的系统参数是时变的,难以建立精确的数学模型。滑模变结构控制(SMC)囝则是对非线性不确定性系统的一种有效的综合方法,对系统的参数摄动和外干扰鲁棒性非常强,且结构篱单、响应快速。墨前,这种控制策略已成功用于电力系统、机器入、航天航空飞行器等控制中。本章将该控制策略引入对永磁同步电机速度环和位置环的设计中,以期使系统具有良好的快速性、定位无超调;同时提高系统豹精度和鲁棒性。

21PMSM的数学模型

建立永磁同步电机(PMSM)的数学模型是研究伺服运动控制算法和对各种算法进行仿真的基础。PMSM的基本方程包括电动机的运动方程、物理方程和转矩方程,这些方程是其数学模型的基础。控制对象的数学模型应当能够精确地反应被控系统的静态和动态特征,数学模型的准确程度是控制系统动、静态性能好坏的关键。

在不影响控制性能的前提下,忽略电动祝铁心翁饱和,永磁材料的导磁率药零,不计涡流和磁滞损耗,三相绕组是对称、均匀的,绕组中的感应电感波形是正弦波。经过坐标系变换,将三相定子坐标系(abc坐标系)转换成转子坐标系(dq轴系)。实现了交流伺服电机矢量控制时转矩和磁通的解耦,即控制转矩时不影响磁通大小,控

制磁通时不影响转矩。dq 坐标系下PMSM 的状态方程[10,14]为:
H 二:RI L 吾:p 茹.(o,.,一夕。}]+[]

l

,.roooo.;,10

J

.%鳞

式中,R一绕组等效电阻o);岛一等效d轴电感();‘一等效q轴电感()

p。一极对数;q一转子角速度(rads)9,一转子磁场的等效磁通州b);瓦一

负载转矩(Nm);‘一d轴电流(A);‘一q轴电流(A);.,一转动惯量(1gm5

为获褥线性状态方程,遥常采用‘恒等予0的矢量控制方式,此时有:

9

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

[]2I -矿.R 爹,/I,歹一,。:7 7 ][]+l—uqlIL ]

2_2)

(22)即为PMSM的解耦状态方程。

在零初始条件下,对永磁同步电机的解耦状态方程求拉氏变换,以电压~为输

入,转子速度为输出的交流永磁同步电机原理框图如图2·l所示,其中爱。=3罗。妒, 为转矩系数。

21PMSM 系统框圈

22基于滑模变结构的矢量控制系统

221滑模变结构控制原理

滑模变结构的基本理论和设计方法是在=十世纪六七十年代奠定和发展起来的,是一种高速切换反馈控制。滑模变结构控制与一般普通控制的根本区别在于控制律和闭环系统的结构在滑模面上具有不连续性,即~种使系统结构随时变化的开

.关特性。通过适当的设计能把不同结构下的相轨迹拓扑的优点结合起来,实现预期设计的控制性能。瞻于滑模面一般都是固定的,而且滑模运动的特征是预先设计的,因此系统对于参数变化和外部扰动不敏感,是一种鲁棒性很强的控制方法。这种控制方式使系统的状态变量进入开关瑟后就被约束在开关恧的领域内滑动,此时系统的动态品质由开关面的参数决定,而与系统的参数、扰动的影响无关。变结构控制的基本要求为:①存在性,即选择滑模函数,使控制系统在切换面上的运动渐进稳定,动态品质良好。②可达性,郎确定控制作用,使所有运动轨迹在有限的时间内到底切换面。

设二阶单输入单输出的状态方程为:

=Ax+H (23)

式中,毒=b,,xr

10

精品参考文献资料



优秀毕业论文

第二章永磁疑步电视的完全滑模变结构控制

B=ob(bo)
o]
A—lo
L~口l-a2j‘l>绣撂2>。’’
设滑模控制律为:

=叫工=~∑仍鼍 (24)

其中妒力一向量,其元素之值有如下切换性:

=Pt 谚一。Ⅲ

(25)

Xt$<O

其中,

(x)=clxa+

Cl>o

(26)

s()=0称为系统的滑模开关线,这里蓦()=O是通过原点、且在二维状态空(即相平面)中的一条直线。它将楣平瑟分成为两个区域,反馈增益搿受系统状态在滑模开关线上位置的控制。若系统在滑模开关线葶(=0附近的运动轨迹方向是沿着此直线,而非脱离此随线,则系统将产生滑模运动并将保持在该直线上滑动,直到坐标原点。在此,系统产生滑模运动的条件是:

liraS。羹《0 (27)
..柚

222完全滑模变结构控制在矢量控制系统的应用

矢量控制系统是透过坐标变换将PMSM等效成囊流电机进行控制。本节将滑模控制算法应用到矢量控制系统中。图22是基于滑模控制算法的PMSM矢量控制系统的框图。

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

矢爨控制系统

22基于滑模控制的PMSM系统框圈

墨一给定的转矩电流增益,K"r~转矩增益,歹一转动惯璧,B一摩擦阻尼系数,瓦一负载转矩

扰动,‰一转子角速度,统一位置给定,0一转子位置若令而=酿一0;蔗:==馥一矽=0)m,根

据系统框图可得系统的状态方程为:

式中,

()=G 二易)()+()u+G)h

(28)

b=BJ

a=KtKlJ
d=lJ

将滑模线控制扩展为完全的滑动轨迹控制,即将单段滑模线控制s()=O延伸为

多段滑模线控制,包括加速度段、恒速段和减速段。各段的滑模线分别为:
加速段
=删;+(而一墨o> (29)

式中,鼍。隽初始使置误差。

恒速段

(2—10)

2=屯~茗笳

式中,一x妁为恒速时电机转速
减速段

3=CXl+2(2—11)

其中控制器采用了滑模控制算法。滑模控制律定义为:

12

精品参考文献资料



优秀毕业论文

第二牵永磁鼷步电规的完全溪模变结构控制

U=Askl++(2-12)

中,A、/a的值与系统所处的阶段有关。假设,当£=l23时,分别代表系统处在

翻速段,恒速段和减速段;瓯《江l23)别代表系统在相应阶段下各自的滑模线,

则式(212)中:

fl ,葶,≥0
sgn[s,卜{

I1

,岛<0

i=l23

h

,嚣#-≥o

={

,甄鼍<0

f=1,23

SiX2≥0

={

,&x2<0

控制器描述如图23所示:

23滑模控制器结构

图中p代表微分算子。

根据滑模可达条件,设计滑模控制器参数以保证系统的实际状态沿各段滑模线形成滑动。

13

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

减速段
为了在减速段形成滑动,须满足式(27)所示条件,即需满足:

3(+j2)<0 (2—13)

将式(28)所示的系统状态方程以及式(212)所示的控制律带入(213)得:
一岛鼍(挥劫~s3xz(b+aJ—C)+3<0 (2·14)

式中,若$3X。》O,则要求a2>0。由于系统处于减速段所以有五黑嘞,从而

att3>Oct3>0,同理可知:

若黾鼍<O,则确毽<o 郎磊<0

s3x2>o,则够+口以一c)>o

即殇>£≠

s3x2<O,雯JJ(b+曩磊一c)<0,即磊《竺兰

恒速段为了在恒速段形成滑动,须满足条彳牛

2j2<0 (2 15)

s2-=J2·=2·(k2 aU+d )<0 (216)

将控制律(212)和系统的状态方程(28)代入式(216)可得:

.一s2xl(aA)$2X2(+aJ—d )<0 (217)

式中,若工2 IO,贝lJaa2>0,即a2>O

s2jrl<0,萸lj 露愿<O,郎篪<O

s2 2>OSUCh+2 恐一drD>o,即恐<—(dr‘—-b)
若墨2 <O(+2 磊一drD<0即磊<·(dr -b)

14

精品参考文献资料



优秀毕业论文

第二章永磁固步电机的完全潺模变结构控制

加速段为了在加速羧形成滑动,须满足条
件:

s1tl<0 ¨)

s,il=l(22j2+)<0

将状态方程(2-8)和控制律(212)代入式(219)可得:

若墨麓>0,黉lj2 锨磊<0,即届<

一墨五(2|浇勃镌)+墨恐吻蜒一20tz/漩2+20t +1)<O

kL )

式中,

^<0,则2 彻口l0,即嘶<0

若蕞菇:>。,则苁>一望L 三兰铲

23仿真研究

23{仿真实验及参数选择

Matlab是当今流行的科学计算和仿真软件,具有强大的矩阵运算能力。Matlab提供的Simulink是一个用来对动态系统进行建模、仿真和分丰斤的功畿强大的软件包。

Simulink具有友好的用户歼发界面、开放的编程环境,用户可以开发囱己的模型。

为了验证滑模交结构控制的效果,本节利用MatlabSimulink仿真软件对位置饲服系统进行了仿真试验。建立了PMSM矢最控制系统的仿真结构图如24所示。该仿真实验平台主要由PMSM本体、逆变器、SPWM、坐标变换(dq--->abcabc-->dq)、电流调节器以及滑模变结构控制器等模块组成。本牵的重点是滑模变结构控制器的控制结构以及控制参数,对于其他模块结构的确定以及参数的选择请参照参考文献中有关利用MatlabSimulink建立PMSM矢量控制仿真平台的内容瑟7‘22]

15

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

24系统仿真结构图

实验时,在各段滑模线参数选择范围内根据仿真结果对系统的参数进行优化,最终选择的控制器的控制参数如表21所示。

21滑模控制嚣参数值

2

^

球,

A

-500

500

10

500

10

500

-500

10

-10

100

-10

-500

-10

232实验结果

基于Mtalabsimulink仿真试验,得出的位置跟踪曲线和速度响应曲线分别如图25和图26所示。图25比较了在系统输入阶跃信号墨(=lOrad时,滑模控制器和PID控铡器调节到最佳状态的位置响应曲线。对比曲线可知,滑模控制器使得系
统具有更短的响应时间和被控量无超调的特点。由于采用了完全滑动控制,图26中的速度响应曲线包括7"JJn速段、恒速段和减速段,提高了系统的性能。

16

精品参考文献资料



优秀毕业论文

第二章永磁同步电机的完全滑模变结构控制



C
o
:;

o

25位置响应曲线

26速度响应曲线

仿真试验表明:(i)滑模变结构控制算法与传统的PID控制算法相比,具有响应时间短,响应速度快和无超调等优点。(ii)完全滑模控制使系统响应速度存在加速段、恒速段和减速段,改良了系统响应。(iii)利用滑模交结构控制算法设计的位置伺服系统的外环控制器,由于其参数的选择不依赖于系统精确的数学模型,允许

17

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

被控对象参数在更大范围内变化,使系统具有良好的鲁棒性。

24本章小结

本章基于永磁同步电机(PMSM)的解耦状态方程把滑模变结构控制(SMe)方法引入到对PMSM外环的设计中。并且,将单段滑模线控制扩展成包括加速段、恒速段和减速段的完全滑动轨迹控制。仿真实验结果表明,利用该控制方案使得系统具有良好的快速性、定位无超调;同时,提高系统的精度和鲁棒性。

18

精品参考文献资料



优秀毕业论文

第三章运动轨迹援划及捶补算法

第三耄运动轨迹规划及插补算法

31轨迹规划概述

一直以来,运动控制系统动态响应的快速性,稳态跟踪的高精度以及行为的鲁棒性是运动控制系统追求的主要性能指标。为了提高系统性能,一方巍,需要弓l先进的控制算法,如滑模变结构、自适应鲁棒控制等;另一方面,需要优化轨迹规划算法。轨迹,是指机械本体或加王刀具在运动过程中的位移、速度和加速度。轨迹规划,是指根据任务的要求,计算出预期的运动轨迹团】。随着现代数控行监特别是高速数控的迅速发展,运动轨迹规划已经广泛应用于高精度的运动控制系统中。例如,在高精度数控机床加工的过程中,为了保证机床进给不产生冲击、失步、超程或振荡,按照预定的速度和位置实现快速准确地运动,加给伺服电机的输入(脉冲频率或电压)需要按照~定的规律给出,即需要利用轨迹规划的方法在进给起、停、轨迹转接过程中进行的加减速控制。由予实时性的要求,在运动控制器实际设计中实现任意复杂的脉冲频率或电压输出并非简单,特别在高速进给时轨迹规划尤为重要。因此,寻求简单、能满足精度要求和实时性的加减速控割算法,已成为嚣前设计高精度运动控制系统的关键问题之一【冽。

32轨迹规划方法

为了满足工业现场的要求,在传统的直线加减速和S鳇线加减速的基础上,出现了很多种变形的加减速控制算法以及其产生方法,如指数加减速,三角函数双S曲线加速,抛物线双S曲线加速等。

321直线加减速

由直线加减速算法形成的速度曲线为梯形,是工业界广泛采用的形式,它是一种时间最优的曲线[251。直线加减速控制速度在突变时沿一定斜率的直线上升或下降,其位移方程是关予时间的二次多项式。一般情况,馥线加速和减速过程是对称的。如图31所示,其运动过程分以下几个阶段:加速运动阶段to-q,匀速运动阶段q-t2减速运动阶段t2-t3

设给定的速度上限为’,m雌,加速度上限为a越缸,规划距离为x,加速度恒定的时

间长力t。,速度恒定的时阕长为≈。不考虑速度限制,在加速度为a一加速时闻为t。下所达到的最大速度为痧。

19

精品参考文献资料



优秀毕业论文
青岛大学硕士学位论文

time[s]

time[s]
31塞线加减速算法仿真躁

31是基于Maflab 65对直线加减速算法的仿真图,其中有三段加速度变化的时间,对应关系如下:
f‘=^0=f3t2

1)

b—fl

8。’

参茎‰雌到达B 点所用的最短时

闻为:

2)

>‰

f =

(3—2)

精品参考文献资料



优秀毕业论文

第三章运动轨迹规麓及插李b算法

设全程所用的时间为t。。最大速度限制%蛙。设移为最短时间下系统应该达到的最

大速度,有:

=气缸· (3—3)

广—一

都≤Vm瓤,即’没有超过麟上限;贝lJtx=2t.观√亡

若移>Vm瓤则:

==,.k=m缸.t<x (34)

m“

这样,系统在最大速度阶段经历的时间:

t,:兰立 (35)

lm

由此可得系统在整个时间段内的速度曲线方程为:

S曲线加减速是由于系统在加减速阶段的速度曲线形状呈S形而得名。S曲线

加减速是嚣前运动控制器中最常用的轨迹规划算法[263。正常情况下的S曲线加减速

如图32所示,运行过程可分为7个阶段:加加速运动阶段”_tl,匀加速运动阶

ll—赴,减加速运动阶段t2--t3,匀速运动阶段分≮,加减速运动阶段妒奄,匀减速

运动

阶段t^,减减速运动阶段t雨。假定规划的距离为x,速度上限为y群戡,加速度上

2l

精品参考文献资料



优秀毕业论文
青岛大学硕士学位论文

限为口。缸,加加速度上限为厶“,设恒加加速度的时间为‘J,恒加速度时间为乙,恒

速度时间为乙。图32所示的是基于Matlab65S曲线加减速算法的仿真图。

32 S 形加减速算法仿真圈

除了开始运动的时间toi-7段加加速度变化的时闻的关系由式(37)式给出。

fJ2^一气2f3f22t5一气=如~气

f=f2fl=气一ts (3—7)

0然气-f3

按照行程长短以及速度上限值、加速度上限值不同,S形曲线可分成四种情况,以下分别进行讨论。

1)不考虑加速度和速度限制,lPt=O,气=O
为了使轨迹运行时间最短,则在每个加加速度变化区间内取其定值+‰

一丸旺。

a.在气≤f≤fl,即恒加加速度jf+t情况下,加速度,速度和位移方程为: 22

精品参考文献资料



优秀毕业论文

第三章运动轨迹规划及插补算法

a(t)=jlnut+o

(f)=i1 厶.u12+口。f+

(3-8)

(=吉。『mⅡr3+aot2+vet+‰

上式中,初始条件a--v=Xo。由于没有加速度和速度限制,在时间最短的

前提下可以得到fl=f2=‘Jt3=f4则:

a(t2J5 口【flJ2_mutj
川:)1(f1)=L。中 (3-9)

地:)=m)=L“3

b.在f2≤f≤f3,即恒加加速度j=Lu情况下,加速度,速度和位移方程为:口∽=_L 。。13f一岛)+反如)

={丘乒一矿+)留一乞)+) (3-10)

=L髯一乞)3+主毗)g一秽+)口一乞)+)f=f3=f4时,根据式(3—9)以及(3—10)-J

a(t4)=a(t3)=0

vCt4)=1(f3)=LutJ2 (3-11)

(f)=LutJ3

根据曲线的对称性工()=2x(t3)=2Lutj3,得到在恒加加速度下运动轨迹长为工所用的最短时间为:

t=4t=4·

(312)

2)考虑加速度上限,不考虑速度上限由式(3—
9)n--丁知最大加速度发生在t=tl,有:

23

精品参考文献资料



——_————————___———_———_————————_—__——_—————_———————————一一优秀毕业论文一童鱼奎堂堡圭堂堡笙奎一.——

(313)

=JJ1

若鑫>∥m缸,则需从新计算0

(314)
t}=ama,

厶弧

要保证时闻最短则需要}。僮达到最大值·

af。蕊f≤f:,即加速度恒定口=amax情况下,加速度,速度和位移方程为:

a(t)Jm tj

(3_15)

y0)=五扛fj◇^)+p()

(f)=il Lu‘(f—t1)2+V(f1)(f—f1)+(f1)根据式(3—9)可得

a(t2)=Ltj

(f2)=Lv+Jln“q2 (3_16)

(f2)ljjjtf+2jm,t2t1.蕾醢fj3

b。在}2≤}≤f3,即恒加加速度歹=一矗情况下,加速度,速度和位移方程为:

O)=^0f2)+a(t2)

vp>:一妻丘缸。一ti)2+482)◇一乞)+y() (3-17)

=一丢L扛”∥+扣:瓣。:)2¨(f2Ⅺ叫:)怕魄)

根据式(315)可得:

a(ts)=-j.蛙tj+克糕t=0v(tD:一寻尢缸fJ2+LⅡfJ2+jfu∥+Lf

2=LⅡfJ2+JlnⅡV4

(3_18)

x(f):厶“fJ+吾丘缸fj2+jllv2

现假设速度上限没有达到,予是气=气,根据馥线的对称性可得:

24

精品参考文献资料



优秀毕业论文

第三章运动鞔透援划及捶补葬法

()=2()=2z吐;fj3+3Ltta+.『mtta2= (3—19)

由式(3-l8)可求出

3

l

(320)

=i j◆j

3)考虑加速度上限和速度上限考虑速度上限

,最大速度出现在厶时刻

=v(t3)=矗缸‘,气+矗弑0(321)

由式(3-20)可得

f。;—Vra--j—mntj*:垦墅一f仁■石_2q (322婚’

由式(318)可褥最大速度持续的时闻力铲型塾笠旦望&(3-

结合式(3-20)可得出轨迹总路径x-tj,t。,t,和L的函数关系:23) Vm

=Jm(2t3+3tita+fta2+f12≈+fto> (3-24)

S曲线加减速的速度曲线在从启动到加速、加速到匀速、匀速到减速以及速度衰减为0

时候平滑过渡,将直线加减速速度曲线的原各冲击点进行了平滑加速、平滑减速处理,避免了

冲击。但是,由于其加加速度不连续,加加速度在起始位置和终止位置以及在正受值的切换点位置

均存在突变,加速度在各个切换点不是平滑过渡,存在拐点,其柔性受到一定的限制。

323指数加减速

指数加减速麓线,简称嚣睦线。它具有加减速不对称的特性,运算方程简单,计算量小,控

制的目的是使速度按指数规律上升或下降。设在速度限制为’,。u和加

速度限制为口mⅡ的条件下,给出速度方程:

(0=K(1--£。) (3—25)

K是与’,_址有关的一个系数,两者满足关系K≥vuK越大速度上升就越快,

精品参考文献资料



优秀毕业论文
青岛大学硕士学位论文

但同时,当存在速度上限时,速度的变化会变的不平滑。t是与最大加速度有关的系数,对',在t=0时刻求导数可以得到初始加速度为:
(o)Le-记:墨 (326)

根据上式指数曲线的特点,为了达到时间最优初始加速度应该为最大值,令

(o)=a=u可得f=Kla。Ⅱ,因此式(3-26)可写成:

!!‘

vCt)=KO—g工’) (3-27)

假设规划的距离为X,在乙时刻的速度为痧:1)

不考虑速度限制,即痧≤%缸

在不考虑速度限制的情况下,如果想达到时间即要保证时间的对称性,则最优需满足下面的方程组:
BI≈ (3-28) =
由式3-28可解得乙和痧因此在不考虑速度限制的条件下,得到速度曲线 方程为:

2(1一口‘)Iv(t)rrl一一一争、0≤f---%。ta M(3-29) I工:痧一聊I争鸭’) <t<2t

2)考虑速度限制,即痧>%Ⅱ如果痧>u,则由式3·29可知,速度到达V~所经历

的时间为『一为:

ku=一云K 圳一争
m

(330)

那么经历最大速度的时间f,:

f,:!
lm

(331)

^=f-t2=0+f,,t3=2f-+f,因此可以得到在这种情况下的速度曲线方程

精品参考文献资料



优秀毕业论文

第三牵运动辕迹规划及捶孝}算法

一勤堂l

v(O=K(1--e f)

0<ttl

(332)

v(O=%缸,

<t≤t2

v(f)=%虹一K(1--e 一芋aw f 一飞

t2<t≤t3

33是基于Matlab 65对指数形加减速算法进程仿真褥到的结果。

,‘

l

f
{

J

罨基】A

|?

|

|

i

、、~

{

一弋

time[s

N


27

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文


./_

P’

./。

×

7
/。

time[ms]

33指数形加减速算法仿粪瀚

S形加减速算法相比,指数形加减速算法具有方程简单,运算量小的优点。同时,在点位控制中,梯形和S形速度曲线在时间上都有较大的滞后,即机械实际到位时间要比勰划时闻晚,这在生产实际中容易造成危险。以数控钻床为例,如果轨迹规划路径时间已经到了,但实际钻床还没有到达预期位置,这样提前下钻会对加工产品造成破坏。指数形加减速算法能够改善时间滞后现象,且时延较小有时甚至提前到达运动目标点£27]。但指数曲线轨迹规划运动时间较长,如采提高加速度,启动过程仍然会存在较大的冲击。这是指数速度曲线的一个缺点,如何改善这种特
性,还有待予进一步研究。

33插补概述

运动规划算法在运动控制系统的主控制器上运行,完成对系统的任务作总体的
规划。在对规划{|譬到的结果被运动控制器执行之前,运动控制器还需要对运动规划
结果作进一步的插补运算,如直线插补和圆弧插补簿。所谓插补是指数控系统根据
输入的基本数据(直线的起点和终点,圆弧的起点、终点和圆心,进给速度和加
速度等),在起点和终点之间,计算如若干个中间点的坐标值。插补算法的精度和速度直接影响了运动控制系统的响应精度和速度。在多轴运动中,首先根据加减速算法得到轨迹规划值,然后根据坐标变换得到备个轴在每个轨迹规划周期内的起始点和终止点,再进行插补,计算出两值之间的多个中间坐标值,以其作为目标位置,进行伺服补偿。撬补与轨迹规划、坐标变换、伺服补偿的关系如图3。毒所示。

精品参考文献资料



优秀毕业论文

第三章运动轨迹觏划及撬补算法

俘譬琏及

刊插补器F 叫翌j



坐标位置~ 轨迹控制算法

331 誊线插补

坐标变换■插补器刚PID34控制顺序图

直线插毒}的实质是用~定数量的插补点所组成的折线来逼近目标曲线,可以分为二维宣线插补和多维直线插补两种情况,是机床重要的插补方法之一12sl。两者原理基本相同,以二维直线插补为例,如图3S 所示。

五以

35 直线插补零意图

设直线按梯形速度曲线为基础进行插补,需要根据运动的轨迹将参数分解到相应的轴上去。假设为第一象限平面蛊线,童线的起点和终点坐标差较大坐标轴取为基本坐标进行位置检测,直线的斜率取为被积累的数值。假设起点取为原点(0O)

终点力(澎,ye),在直线上任意一点(xy),有下列关系式满足:

三:一xey-j 工:黟j=——j =j 拦脚。A‘x 拦脚, (3_33)

Y ye

f i
-ZAx=∑

i

i

(334)

Y=∑Ay=∑l=i

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

f“
+l=∑Ax=k(i+I)=‘+

i+1

(335)

Yi+l=∑△y=f+l

332圆弧插补

常用的圆弧插补算法是逐点比较法和数字积分法四】。逐点比较法是应用很广的一种插补运算方法。它的特点是加工机械每走一步,就进行一次偏差计算和偏差辨别,即比较到达的新位置和理想线段上对应点的位置之间的偏差程度,然后根据偏差大小确定下一步的走向。在插补过程中,每走一步要完成以下四个步骤。

(1)偏差判别:判别当前运动点偏离理想曲线的位置。(2)进给控制:根据判别结果确定进给的坐标及进给方向。(3)偏差计算:到达新位置后,计算出新偏差,作为下一个判别的依据。(4)终点判别:判断是否到达终点,如果到了则结束,否则回到第一步。逐点比较法的关键是如何建立偏差计算公式和终点判别公式,建立偏差计算公

式和终点判别公式的依据分别是:能够根据偏差计算的结果判断运动点所处的位置,能够根据终点判别公式计算的结果判断动点是否到达终点,并且计算过程要简单、快速。这种方法算法简单,便于软件实现,进给速度易于控制。但多轴联动时,扩展困难,计算量剧增。数字积分法是利用数字积分原理建立起来的一种插补方法。其插补装置叫做数字积分器,或微分分析器,简称DDA(DigitalDifferentialAnMyz)数字积分法最大的优点是易与实现坐标的扩展,可以用几个相同模块的组合得到多坐标的联动轨迹控制系统。可以实现一次、二次、三次甚至高次曲线的插补,因此它在轮廓数字控制系统中得到广泛的应用,其缺点是速度调节不够方便。上述插算法一般在上位机实现,在下位机中实现比较困难。采用圆弧插补算法的基本原理是:两个幅值相等且具有固定相位差900的信号形成的图形将会是一个正圆弧。根据这一原理进行圆弧插补,从整个运动的过程看,是角速度、角加速度的累加;从每一个插补周期看,进行的是直线运动。需要设定的参数是角速度∞、角加速度a,同样需要根据运动的轨迹将参数分解到相应的坐标轴上去。

333多轴运动系统的精度分析

随着高精度数控加工日益增长的需要,对于轮廓控制中多轴位置伺服系统准确跟踪指定轨迹的能力提出了更高要求。提高多轴运动的精度大致上分为两种方法。第一,提高单轴运动的精度。实际上,任意一个坐标运动轨迹的偏差都将会导致整

30

精品参考文献资料



优秀毕业论文

第三章运动轨迹规划及插补算法

个运动规律的变化,最终造成轮廓加工误差,因此,多轴运动控制系统的精度很大程度上取决于各轴位置伺服系统的精度。第二,提高多轴协调运动的能力。尽管许多古典和现代控制理论都集中讨论和提高单轴的运动性能,但如果在控制器的设计过程中不充分的考虑多轴的协调性,高速高精度就很难实现。事实上,在连续轨迹运动中,一个较大的跟踪误差未必会引起一个较大的轮廓误差,并且,轮廓误差的控制更为重要[30l

Korenl311将多轴运动系统看成一个整体,而不是各个环节的组合,提出了交叉耦合的概念并将其应用于机床控制。一个典型的交叉耦合控制器(CrossCoupleController,ccc)包括计算轮廓误差的算法和消除轮廓误差的控制方法两部分。许多控制方法,如最优控制,自适应控制,模糊控制和鲁棒控制都已应用于耦合控制当中。一个典型的交叉耦合运动控制器如图36[3132]所示。l(e是与编码器分辨率和传动
比有关的一个比例系数;P血和Pdyx轴和Y轴的规划位置,PxPay是两轴的实际位置;GxGy是两个轴的位置增益;ExEy是跟踪差;CxCy是与几何轮廓有关的可变增益;e是由几何关系计算的轮廓误差。在这一类型的交叉耦合控制器中,交叉藕合控制器的输出被分解重新输入到两个环中,以减小轮廓误差。

36交叉耦合控制结构图

34本章小

本章介绍了三种加减速控制算法:直线加减速控制算法,S曲线加减速控制算法以及指数加减速控制算法;给出了每种轨迹规划算法的详细推导公式并通过Matlab仿真得到了各种算法相应的加速度,速度和位移曲线;分析了各种算法的优缺点以及适用范围。本章还针对多轴运动探讨了直线插补和圆弧插补算法,同时分析了多轴运动的精度问题。

31

精品参考文献资料



优秀毕业论文

第匿章基于多辘运动控制卡酶双闭环PID+速度功瑟速度蓠馕算法研究

第四章基于多轴运动控制卡的双闭环P l 叶速度/加速度前馈算

研究

随着机电一体化技术的飞速发展,开放式的控制技术受到人们越来越多的关注。这种开放体系的结构有两种:1CNC+PC主板,将PC主板插入传统的CNC机器中,PC主板主要运行j}实时控制,CNC主要用来做以运动控制为主的实时控制。2PC+运动控制卡,在PC机中标准总线槽中插入运动控制卡用来做实时控制。由于PC机的发展和普及,越来越多的运动控制系统采用PC+运动控制卡作为位置控铡装置瞄抛。因此,研究运动控制卡对研究开放式运动控制系统具有重要的意义。本章以可编程多轴运动控制卡PMAC为核心,着重研究了基于PMAC卡的双闭环PID+速度功酲速度前馈的控制算法,并通过PMAC提供的PEWIN软件完成了对PID以及前馈参数的调节。

41多轴运动控制卡PMAC

411PMAC卡介绍

PMAC(programmablemultiaxescontroller)是由美国DeltaTau公司开发的开放式多轴运动控制器,它以MotorolaDSP56001224bit数字信号处理器为核心,提供了运动控制、离散控制、内务处理以及同主机交互等强大功能,能同时控制8根轴运动,是当今世界上功能最强、灵活性最大的运动控制器。PMAC控制器因其强大的运动控制功能,能广泛应用于各种各样的设备:从d,lJd,于百万分之一英寸的精密仪器,大割那些需要数酉予瓦或马力的大型设备。PMACCPU与轴是通过特殊设计的门阵列ICs(PDSPGATE)来实现接口的。每一个ICs能够控制4个模拟输出通道、4个作为输入的编码器、4个来自附件的模拟驱动输入。PMAC控制器还提供了含速度和加速度前馈的PID控制和阶式滤波器,用户可以通过自动和手动方式调节PID参数,从而很好地解决了大部分系统特性问题。

该卡优秀的控制功能和良好的开放性特点包括以下几个方面溺;1、运动控制功能。

>运算速度快 每轴55s的伺服更新速度
>数据精度高 位置可到32位的数据精度、输也数据精度为1618

>内置丰富优秀的掘毒p算法 直线、圆弧、PVT(位置速度时闻)、三次样条 插补算法,用以产生各种类型的运动轨迹

>良好的通用性.~支持标准的机床加工代码G代码编程

33

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

》灵活、简练的运动程序语言 简便易学

》优良的伺服控制算法.一PID+NOTCH滤波+速度,加速度前馈,并且支持

用户自己的伺服控制算法2、过程

控制功能(PLC逻辑顺序控制)

>运算速度快典型程序运行时间在5-9ms,较普通PLC快一个数量级

》可容纳程序量犬

216K字节存储容量(包含运动程序)

>程序语言蔫单易操作 类似高级语言,方便编辑存储窝运行
》模块化管理 可分成32 PLC 程序模块,并且可编译为PLCC,运 行速度可提高20-30 倍,方便程序调用和管理
3、数据交换功能及开放的接口。

功能完善的动态链接库 提供200 多个库函数,利用高级语言编程调用 这些丞数,使得同上位机交换数据非常方便
》简单易用的专用控件 同上位机交换数据更加简单,容易学习和掌握 >允许用户访问和使用卡上内存和寄存器地址空间
4、硬件扩展功能、适用性及灵活性。

>通过多卡链接的方式可以控制多达128 轴同时运动。

》通过选用不同的附件和选项来发送不同的控制信号,控制不同的电机》通过选用不同的附件和选项来接收不同类型传感器的不同反馈信号>通过选用不同的附件和选项来提升系统的各项功能,满足一些特殊要求

412 PC+PMAC 运动控制系统的构成

PC+运动控制器PMAC 所构成的运动控制系统通常采用图41 所示的系统框架。

41 系统框架图

图中,由PC+运动控制器所组成的位置控制系统的核一tL,是多轴运动控制器PMAC。它采用速度÷位置的双阂环PID+速度,加速度前馈的控制算法。在速度反馈中采用的是PID.前馈控制算法,前馈算法可以按扰动进行控制,计算出相应的控制作用恰好能抵消扰动的效应,使被控变量保持不变。核-tL,单元PMAC 适用于所有电
3

精品参考文献资料



优秀毕业论文

第四章基于多辕运动控剖素约双趣舔PID+速度,翻速度_|l蓼镄算法研究

机,包括普通的交()流电机、交()流伺服电机、步进电机、直线电机等,对不同电机,PMAC可提供相应的控制信号;PMAC可接收各种检测元件的反馈信号,包括测速发电机、旋转变压器、并行数据、光电编码器、光栅尺等。PMAC的绝大部分地垃向用户开放,包括电机的所有信息、坐标系的所有信息及各种保护信息等;对于其控制的每一个电机,PMAC都以一个固定频率(通常为2kHz左右)对其进行伺服更新,伺服更新工作进程是:先根据运动程序或别的运动指令得到的等式求得要求的位置增量,然后将此与由反馈传感器读回的实际位置相比较,最后在两者之差的基础上,发出一个输出命令使此差值变小,如此反复,直到此差值令人满意为止。

42基于PMAC的双闭环PI D+速度/加速度前馈算法

421控制算法的原理

PMAC运动控制器核心是MotorolaDSP56000ICPU。控制器通过IsA总线与IBM-PCXTIAT或其兼容机相连。PMAC控制器可以提供4轴独立闭环控制,也可以通过软件进行多轴协调运动控制。它具有24bit的位置、速度和加速度分辨率,采用带有积分饱和限制的PID补偿加Noah滤波和速度、加速度前馈算法,比例、积分、微分系数具有16bit分辨率。其伺服周期单轴可达60ps,二轴联动为llOlas,可进行精密的伺服控制。控制算法原理图p5】如图42所示。

42控黼算法原理翟

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

在图42中,PC机发送的指令位置是实际闭环系统的跟踪目标,也就是常规意义下

的控制输入。控制输出为比例、微分、积分这三部分的代数和。比例部分为误差部分

ek与比例系数kp的乘积:微分部分为误差变化量ePek1与微分系数l(d的乘积;

积分部分采用了防积分饱和限制,有误差累计值经积分极限0n1(∑【舾(.『)).饱 i=o

和限制后,与积分系数ki相乘得到。Kp、&、Kd均可由软件进行设置。对于电机x使用的计算

机控制输出的PID算法的实际公式如下所示:

DACout(n)=219XIx30x[{Ix08x[FE(n)+(Ix32 xCV(n)+Ix35xCA(n))128

+Ix33XIE(n)223)Ix31XIx09XAV(n)128

DACout(n)16位的伺服周期输出命令(-327681J+32767)。它被转换成-lOv

+10v的输出,DACout(n)的值由Ix09定义。

08 为电机x 的一个内部位置放大系数。

09为电机x的速度环的一个内部放大系数。AV()是伺服周期n内的实际速度,即为每

个伺服周期最后两个实际位置的差

AP(n)AP(n1)cV(n)是伺服周期n内的指令速度,即为每个伺服周期最

后两个指令位置的差

CP(n)CP(n1)

CA(n)是伺服周期n内的指令加速度,每个伺服周期最后两个指令速度的差值

CV()CV(n—1)

FE()是伺服周期n内所得的跟随误差,即为该周期内的命令位置与实际位置

的差值CP(n)AP(n)

(n)是伺服周期n内的跟随误差的积分,大小为∑a-I(力】。 _o

422控制算法的实现

PMAC运动控制卡利用其核心DSP强大的运算功能来实现复杂的运动控制算

36

精品参考文献资料



优秀毕业论文

第四章基于多轴运动控制卡的双闭环PID+速度,加速度前馈算法研究

法。PMAC将控制算法中重要的控制参数以I变量的形式提供给用户。因此用户可以根据实际需求,通过改变I参数的方式来完成对控制参数的调节。在PMAC卡中双闭环PID+速度,加速度前馈控制算法实现的如图43所示口61

43双闭环控制算法在PMAC中的实现

要利用PMAC构成一个完整的闭环控制系统,涉及到Ix00Ix02Lx03Ix04等几个参数的设置(43)。其中,Lx00:电机x激活,该参数决定了哪个电机处于激活(=1)或未激活(=O)的状态;Ix02:电机X的模拟量指令输出(DAC)地址,该参数设定了PMAC把输出的参数放在哪里,该地址是二进制或十六进制,通常输出结

果直接显示在DAC的寄存器上。Ix03:电机位置环反馈地址,存放的是安装在负载上的位置反馈元件检测值(即光栅的检测值),它告诉PMAC到哪里去寻找位置反馈以使电机x闭上位置环;Ix04:电机x速度环反馈地址,存放的是安装在电机后面的反馈元件检测值(即编码器的检测值),它由卡经过运算,转换为速度值。这样PMAC通过编码器转换表将位置及速度反馈给控制卡,然后与指令值比较经过PID运算后变为模拟量指令存放到DAC输出表中,由该值来控制电机的运动。如果是半闭环控制,即电机编码器既作为速度反馈又作为位置反馈,则Ix03Ix04都指向电机的编码器:在闭环控制系统中,编码器作为速度反馈,光栅作为位置反馈。对于这种有双重反馈的电机(电机和负载),用Lx04指向电机的编码器,同时用Lx03指向负载上的反馈元件(光栅)。详细的对应关系如表4135】。

37

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

41 控制参数与PMAC I 变量对应关系表

变量 参数 作用 调整值域 数值影响

IX30 P参数, 提供系统所需的刚 -8388608—8388607 数值越大,系统刚性越好,但

比例增益性(快速性) 缺省为2000 太大会产生振荡。太小系统会

反应迟缓。

IX33

I 参数,

用于消除稳态误差

0-8388607

IX63 时间积分误差有关;

积分增盏

(准确性)

缺省为1280

渠辕篷稳满,IX33无效。

IX34

积分模式决定积分增益是全 0

IX34=0 积分增益全程有效 程

IX3l

有效还是只在速 缺省为l

IX34=1 积分增益只在速度必

0 度为0 时才有效

时有效

D 参数,

用于提供足够的阻 -83886088388607

数值越大,阻尼越大,系统越

微分增益尾以保证系统稳定

缺省为1280

稳定

(稳定性)

lX32 速度嚣馈减夺由予微分璜盏 ID83886I对电流环,IX32应等于或略大的引入所

引起的跟 缺省为1280 于Ⅸ3l。对速度环,Ⅸ32应远

误差 大予IX31

IX35 加速度前减小由于系统惯性0-8388607 反应滞后特别明显时,增加

所带来的跟随误差缺省为0 Ⅸ35

68 摩擦增益减小由于摩擦产生 32767-32768该变鼙正比于要求速度的符的跟随误差,

带负缺省为0号,速度为正,Ⅸ68被加进输载调整时有效 出,速

度为受,Ⅸ锚飙输出中

减去

43基于PMACPlD 一前馈控制参数调整

431 P I D参数调整的必要性

在机电一体化系统中,为了获得良好的稳态特性和动态特性,需要对系统的控制环进行校正和

调整。在整个枧电一体化系统中,它对系统的影响是蓬大豹,所以当系统的基本特性(包括机械传

动、电机选型等)确立以后,系统的特性(模型)就确定下来,为了获褥良好的控制效果,就需要

对系统的控制环进行调整了。

PMAC控制器卡为用户提供了Pm+速度肋日速度前馈+NOTCH滤波的控制环算法。鉴于系统会受

到周围存在的干扰影响,其必然存在一些不稳定的因素。试验中

3

精品参考文献资料



优秀毕业论文

第窭章基于多转运动控制拳兹双逮环PID+速廖秀羹速度前馈算法研究

曾经遇到在程序执行过程中闭环控制系统突然开环,使程序中断。经反复操作,发现跟随误差报警,翻阅资料着发现是因为PID。前馈参数的调整不合理所致。重新调整参数后,系统正常工作,并且达到要求的精度。

432PlD参数调整原

联比例》珏积分p礴£分)调节是自动控制中最早产生的一种控制方法,自20世纪40年代美国布朗仪表公司推出PID气动调节器以来,PID控制器在工业生产过程控制中的应用已有几十年的历史。它是自动控制系统设计中最经典应用最广泛的~种控制器。PID调节器可以实现智能化是因为PID调节比较完整地模拟入工的粗调、精调与提前调的动作。任何闭环控制系统的首要任务是要稳(稳定)、快(快速)、准(准确)的响应命令。PID调整的主要工作就是如何实现这一任务。PID算法本身就有很多种结构,但归根到底离不了PID三个参数。增大比例系数P将加快系统的响应,它的作用于输出值较快,但不能很好稳定在一个理想的数值,不良的结果是虽较能有效的克服扰动的影响,但有余差出现,过大的比例系数会使系统有比较大的超调,并产生振荡,使稳定性变坏。积分能在比例的基础上消除余差,它能对稳定后有累积误差的系统进行误差修整,减小稳态误差。微分具有超前作用,对于具有容量滞后的控制通道,引入微分参与控制,在微分项设置得当的情况下,对于提高系统的动态性能指标,有蓿显著效果,它可以使系统超调量减小,稳定性增加,动态误差减小。综上所述,P比例控制系统的响应快速性,快速作用于输出,好比“现在”(现在就起作用,快)I-~积分控制系统的准确性,消除过去的累积误差,好比“过去"(补偿过去,回到准确轨道)D
微分控制系统的稳定性,具有超前控制作用,好比“未来"(未雨绸缪)

433利用PEWIN软件调节PID

通过调节PMAC控制器提供的PID+速巷彩加速度前馈调节器的参数能够解决大部分的系统特性问题,但怎样调节这些参数,调到一个什么程度才可以,需要~些王具来分孝厅,PMACPEWIN软件嘲为用户提供了这样的王具。PEWIN透过分析系统的脉冲响应和正弦曲线响应来评估系统特性,其中脉冲响应曲线用于评估PID参数的调整,正弦睦线响应用来评估前馈参数的调整。

运行PEWIN软件后,点击TOOLS菜单下的PMACTuning 菜单出现PMAC

Tuning工具(44),出现如图45所示的PID调整的界面。

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

44tools 下拉菜单

45PID 调整界面图
通过图45所示的人机交互界面设置PID以及速度、加速度前馈参数后,选择执行脉冲响应,即选中PID调整界面中的PositionStep,然后点击右边的DoAStepMove按钮,将会出现如图46所示的脉冲相应曲线,图中红色为指令脉冲信号(),蓝色为实际位置响应。通过不断调整PID参数,使系统脉冲响应曲线与理想状态下的脉冲响应曲线基本吻合,从而使系统的PID控制达到最优。

M—I’铆●●·”Plot^●●城缸·c‘州■协,o47zI44

一/
:彰
掣一;

篓潞警黼㈦。^荔一一憎曲c㈨’_■蜊,■●一‘_·t÷☆h'●■t抽“■"叫日■●一—缕滋。一。一=..菘曩涮臻一 *g

^_*¨eh^噍★m■_h‘I一■错q蚺’-●-·e-t‘,●_o■●■●‘■■l 舳■,^'■¨'j^州■-E^州舢■-●?■●■-·■●H^0,●啪
■_-odht●a}∞t—■‘'■}月‘●■嗤:轴☆■-__o■-●n_“撕●●w^■^●‘吖㈣州'u

46脉冲响应曲线

40
精品参考文献资料



优秀毕业论文

第四章基于多轴运动控制卡的双闭环PID+速度,力H速度前馈算法研究

在对系统PID参数进行调节的过程中,遇到的典型输出曲线以及分析如下(输入脉冲波大小为1000ets和持续时间为500ms)

1)

471脉冲响应曲线

分析:摩擦过大,有持续的外力或者系统受限改进:增大Ki(Ix33)同时增大Kp(Ix30)

2)
^r纠鞠档粕忡Plot舡螂:£嫩I拟蕾‘7:垤:越硎
44

472脉冲响应曲线

分析:阻尼比过大或者比例增益过小改进:增大
Kp(Ix30)

41

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

3)

f m

Qt4

。“1-t*脚’;,一0蝌川;坩o·O叫■州幅撕。=;.々∞;■时qn■"mm≯a》糍㈣4。嘶h^1*v埘。劬~㈣A”口冀to6d*:’^_o,删:{yw+}*“fh州㈣惴州㈣■~㈣j■f"”#二椰 cm、,qP:~,**f_rmg崎啪■mm"
b#轴,

o—Hktpt_J^“hmaH

473脉冲响应曲线

分析:阻尼比过小或者比例增益过大改

进:减少Kp(Ix30)同时增大Kd(Ix31)

434利用PEWIN软件调节前馈控制参数

在一个良好的控制系统中,仅有PID控制是远远不够的,PID控制是一种反馈控制,它的控制机理是需要有反馈信号的。从反馈元件得到信号然后同指令信号进行比较运算是有延时的,而在很多系统中,延时是非常常见的,反馈控制会失去宝贵的时间,可能使控制失效或者造成系统滞后。为了防患于未然(或者说已经知道扰动量的大小,系统提前给一个相反方向的指令,所以也有人说前馈控制是基于扰动信号的),很多系统都引进的前馈控制。前馈控制作用于系统的前向通道上,在PMAC中前馈参数包括速度、加速度、摩擦前馈。

Velocity选项,执选中PID参数调节界面(45)中间部位的Parabolic
DoAStep Move按钮,出现如图48所示的正弦波响应曲线,图中红色为指令速度曲线,蓝色为实际曲线,绿色为跟随误差曲线。脉冲响应过程主要是用来调整系统的PID等参数,而正弦波主要是用来调整系统的动态特性,涉及的参数主要是速度和加速度前馈。

42

精品参考文献资料



优秀毕业论文

第四章基于多轴运动控制卡的双闭环PID+速尉加速度前馈算法研

48正弦波响应曲线

为了达到良好的前馈控制效果,需要根据如图49所示的调整原则来调节各

个前馈控制参数‘291

理想情况
随误差减到最小并且纂
,沿运动轨迹均
匀分布

加速度躁港误差过大

蘧度跟随谡茇避太 这度蹯随瀑差迎太鼹

原园:随尼的引入逢煦 原因。摩擦力遗成串在中部

调整:增加速度前馒‰{躺句 调整:墙加积分增益IX33

加遮度跟随误差边走一:}{速度跟随误差及

原因;狠转游屠遗成

原因?物瑷系统限篱{遗成

原因:速度莉馈过丈
调整:减小‰f 嘲裔

调整:增加‰《姻5

调整:减小突然的加速度

速度琢隧溟麓过大

加速度鼹随误差边大

加速度、遵度跟随误楚都近丈


精品参考文献资料

原因:赚擦和阻尼蹬威

厦因:加速度翦甥过丈

原园:积分滞后和摩擦力皤成

调整:增加‰‘b 盘≈

调整t 减小‰绺鼢

调整:增加妇{Id5}

49 正弦波响应曲线





优秀毕业论文

青岛大学硕士学位论文

在图49正弦波响应曲线中,绿色为指令速度曲线,红色为实际速度曲线,蓝色为速度跟随误差曲线,根据图示原则可以调整速度和加速度前馈以使系统的动态特性达到最佳状态。

重复脉冲波和正弦波响应过程,直到跟随误差曲线形状与理想阶跃响应曲线基本重合。经调整PID.前馈参数后,得到的符合要求的动态响应曲线如图410示。

1

蛹孽蜮鞲蟛爱i 纂鳓毫ji 嘲’嘲醚

3



哆一 吩.;纠√0 雷.ii 虬;r

一。

^_

<—f.”,

410系统阶跃响应时脉冲响应曲线

44本章小结

本章介绍了多轴运动控制卡PMAC,分析了双闭环PID+速度,力口速度前馈算法的原理及其在PMAC卡中的实现。利用PMAC卡提供的PEWIN软件,通过系统的脉冲响应曲线以及正弦波响应曲线不断调整PID参数和前馈参数,使定位系统达到了良好的稳态特性和动态特性。最后以卓创恒信AC200教学设备(详见第五章)为实验平台,得到当系统达到最优状态时的参数如表42所示。

42系统控制参数表

1130(Kp)

1131(Kd)

1132(Kvff)

1133(Ki)

1134(积分模式) 1135(K )

3980

5900

50

1

84000

5600

精品参考文献资料



优秀毕业论文

第五章基于PMAC半闭环的定位误差分析及误差补偿

第五章基于PMAC半闭环系统的定位误差分析及误差补偿

在机电一体化系统中,机械本体的运动是控制系统控制的目标,控制的目的是为了尽量获得能够满足期望精度、稳定性好、且能快速响应目标值的系统。因此,运动系统的精度是机电一体化系统的一个重要指标。随着现代工业的发展,高精度位置定位技术受到了人们越来越多的关注。运动系统的精度包括运动精度、位置精度。其中位置精度对精密定位系统最重要【37】。而定位精度对位置精度影响最大。在数控机床、微电子、微机械、精密加工、生物工程等领域对精密定位的要求也越来越高。然而由于生产环境或生产工艺的限制,定位系统的位置反馈信号有时只能取自伺服电机的编码器,形成半闭环的控制结构。这种结构不能补偿传动链上的间隙和误差,定位精度不高【381。针对这种情况,本章以北京卓创恒信AC200教学设备为平台,首先介绍了基于PMAC半闭环定位系统的组成,分析了系统的定位误差。

通过人为地制造一个与原误差大小相等、方向相反的误差去补偿修正原有误差的定位误差补偿方法来提高系统的定位的精度。

51AC200系统构成

卓创恒信AC200教学设备主要是由基于PC的运动控制卡PMAC、伺服驱动器和伺服电机、检测反馈装置和运动平台组成。信息处理和控制由美国Deltatau公司PMAC(可编程多轴运动控制器)完成;驱动元件为日本富士伺服驱动器(200W)执行机构是它的配套电机;机械本体为一个两维的XY工作平台,是工业应用中最典型的控制对象之一;反馈用检测元件为编码器或者光栅尺。此系统是典型的PC+运动控制卡的形式,系统的实物图如51所示,原理图如52所示。

51AC200系统实物图

45

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

52系统原理图

在基于PMAC的半闭环定位系统中,用户通过PC机发出位置信号,由PMAC卡指令伺服驱动器和伺服电机完成定位操作。编码器位置反馈信号通过PMAC接口电路接入伺服环,从而形成了闭环的控制算法。这种带位置环的伺服系统,由于位置环的反馈采样取自伺服电动机的编码器,对于传动链上的间隙及误差还不能补偿克服,是半闭环的位置控制系统。

511信息处理和控制单

在整个系统中所有的运动控制指令都是由上章所介绍的运动控制卡PMAC发出的,因此PMAC卡是整个运动控制系统的信息处理和控制单元,也是整个系统的灵魂。在以PMAC为核心控制器的系统中,PMAC卡为用户提供了PID+速度,加速度前馈+NOTCH滤波的控制环算法,能够满足大部分应用场合的要求,用户可以根据自己系统的要求来调整其中的相关参数。PMAC所带的控制软件PEWIN是用户与PMAC进行交流的桥梁,控制功能也十分强大。用户可以利用PEWIN软件改变变量和参数的值从而可以方便的调节控制算法中重要的控制参数以达到优化系统性能的目标。用户可以通过PEWIN编写运动及加工程序,PMAC控制器的运动程序编制是利用自己的一套类似BASIC的高级语言实现的。用户还可以通过它来检测和控制整个系统的运行状况。

512运动平台和检测反馈装

46

精品参考文献资料



优秀毕业论文

第五章基于PMAC拳闭拜既定位误差分析及误差补偿

运动平台的根本任务是将伺服电机的旋转运动转化为工作台的直线运动。运动平台是整个工俸台的本体,本系统中的运动平台采用了滚珠丝杠的驱动方式。伺服电机通过柔性轴带动滚珠丝杠,滚珠丝杠通过丝杠螺母副带动工作台往返运动,完成精密定位。滚珠丝柱的导程是10ram,驱动进给辘的高速运动,移动物体是由滚动导轨支撑的。对滚珠丝杠和滚珠导轨施加了合适的预载荷,以保持高刚度和无间隙连接,减小反向间隙。各坐标轴的驱动是通过与滚珠丝杠直接相连的三相交流永磁同步伺服电机和放大器来实现的。为了形成闭环的控制算法,需要对电机的位嚣进行实时的检测。本系统所用的检测反馈元件为与伺服电机直接连接的增量式码盘编码器。编码器靛分蒺率和精度在很大程度上将会影响系统的定位精度。安装在工作
台上分辨率为l岬的直线光栅,被运动控制器的数据采集模块所记录,用来分析x-Y

工作台的运动精度。

52半闭环系统的误差分析

半闭环系统的定位精度由于只在电机轴上安装的反馈元件,因此其反馈实现的控制精度只能局限在驱动环路部分,环路之外的丝杠、螺母副和平台本身所有传动误差、制造误差、热变形等引起的误差不麓由环路所矫正。

S2{传动误差

它包括滚珠丝杠螺母副的传动误差及传动间隙,滚珠丝杠螺母副处于传动链末级,其传动误差巍接影响平台的定位精度。当丝枉转动时,螺母随着丝杠的转动做直线运动。螺母的实际运动曲线与理想运动曲线之间的最大差值为其传动误差。主要由于螺旋副本身的毒l造误差如螺距累积误差、螺纹滚道型面误差、直径尺寸误差、螺旋副的装配误差及其在装置上的安装误差等综合形成。其中最主要的是螺距累积误差。

滚珠丝杠螺母副的接触变形比滑动副大,其引起的误差影响传动精度和间隙。润滑、摩擦条件、表面粗糙度及材料质量、热处理硬度等都有影响。增大预紧力可以提高接触剐度,僵会增大摩擦温升,弓|怒热变形,因此预紧力要合理取值。

522热变形误差

由于长时间工作,产生摩擦温升引起的热变形造成的定位误差。包括电机发热、滚珠丝枉螺母副、轴承以及导轨副等相对运动部分豹摩擦热。负载部分带来的热影响等。有丝杠和螺母相对运动产生的热伸长严重影响定位精度。热伸长与材料热膨胀系数、温升、平台行程有关。如温升为3"O,行程为100ram,材料为GCrl5钢,

47

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

其热伸长为:
△Z=砚△f=0012×10—3oC×100×30C=00036mm

523导轨的误差

导轨副的导向精度对开环和闭环系统都非常重要。当导轨副的导轨面存在直线度误差、平面度误差、两导轨间的平行度误差,导轨导向面的V形角误差及滚动体的形状、尺寸误差时,都会使运动体不能沿给定方向直线运动,产生运动轨迹非直线性,使运动体颤摆(上下摆动)或摇摆(左右摆动),产生导向误差,直接影响定位精度。

滚动导轨中滚动体的接触变形影响也较大,通过适当的预紧,增大接触刚度可以减小其影响。

以上各种因素中,由固定不变的或按规律变化的因素引起的定位误差是系统性误差。如螺距积累误差、间隙误差等。由不确定的,随机变化的因素引起的误差是随机性误差,如轴承游隙的变化量、摩擦力变化、表面粗糙度不均引起的误差等。机械系统中各种机构间隙、结构弹性变形等综合形成的反向运动时的矢动量(反向间隙),也是定位误差中系统性误差的一个组成部分。

53定位误差补偿

由于系统性误差在总误差中占较大比重,必须采取措施减少误差以提高系统的定位精度。定位误差补偿是一种十分有效的方法,它包括电气补偿法和软件补偿法。软件补偿方法由于不增加系统的硬件并且使用灵活方便,因此被广泛的应用以提高系统的定位精度。

531定位误差补偿的原理

定位误差补偿原理:人为地制造一个与原误差大小相等、方向相反的误差去补

偿修正原有误差。即岛+蠢≈0 (f=123,,n)

式中:毛——各定位点的定位误差值

鼻——误差修正值

只要实测出各坐标轴的定位误差后,就可以确定误差修正值对空间或平面任一点的定位误差进行补偿。一般用于补偿系统误差,因为系统误差总是大于随机误差,可以取得显著效果。

精品参考文献资料



优秀毕业论文

第五章基予PMAC半翊巧的定盈误差分析及误差枣}、偿

532基于PMAC卡误差补偿功能的实现

利用PMAC卡误差补偿方法可以消除定位误差,包括螺距累积误差补偿、方向闻隙误差补偿及热变形误差补偿。还可以根据定期测定的定位误差值,於偿由予磨损等引起的精度损失。灵活性大,补偿量可以方便地改变。

532{基于PMAC卡误差补偿的原理

PMAC能执行误差补偿的功能,这种补偿是在伺服环内被执行的,以获缛最大的速度和最高 的精度。PMAC通过取得原电机的位置,以在表内找到瓯配的位置。通常,该位置是在表的两个入口 之间。因此,PMAC能在这两个入口间线性的插补,从而修正当前的馕萋值。在补偿表中,修正的入 日毖须是整数僮,并显带有目标电机
116计数单位(即一个48的入口值代表3计数)。在多数情况下,间隙补偿表将和一个螺距补偿表联合起来使用,以产生一个双向毒}偿表的效果。对于一个给定的电机位置,间隙表的间隙补偿值将被加到Ix86常数间隙参数上,在电机位置的回零位置使用该参数定义的误差补偿值。为了利用PMAC的误差补偿功能,要将补偿的量 化成为螺距补偿表和反向间隙补偿表的格式,并在执行程序中定义补偿表和定义

相关参数。

为了利用修正误差值进行误差李}偿,必须逶过实验的方法获取各定位点豹定位误差值。在本系统中利用了英国雷尼绍RGH41系列光栅尺的标定来求得各点的定位误差。用户可以利用计算机通过指令或者程序的方式(将长度单位转换为脉冲形式)指令工作台的运动。为了说明补偿袭的获得,以一个假定长度为10000脉冲单位的长度行程上测量8个点的正反向定位误差补偿作为实例,在实验的过程中得到的补偿表如下所示:

51芷反向实际测量值(单位:脉冲量cts)

49

精品参考文献资料



优秀毕业论文
青岛大学硕士学位论文

PMAC误差补偿功能所涉及到的参数主要有:Ix86:电机的常数间隙大小,代
表电机零位置的间隙,单位是116计数位。Ix51:螺距补偿使能。该参数决定
是否采用螺距补偿表。当Ix510时,禁止
所有补偿且无校正;当为l时,允许所有补偿并按照这些补偿表进行校正。因此,由实验所得的数据建立的螺距补偿表可表示为:
1 :指定要补偿的电机序号l

DEFINE COMP 810000

;要补偿的点数为8,覆盖10000个脉冲,点间距1250

5174139125108240186O;各个补偿点应补偿的量。单位为116cts最后一个输入值为0,这是给在10000 计数位和零计数位的修正。

反向间隙补偿表可表示为:

l

DEFD E BLCOMP 81000096145

16011510916213lO

因为在零点处存在的常数间隙为16 个脉冲量,所以Ix86=96

5322 系统误差补偿功能的实现

在基于PMAC 的半闭环系统中,考虑到丝杠的螺距为5ram,工作台的总行程为100ram。在实际测量中每5mm 测量一次,共测得21 个点(包括零点)。往返测量

lO 次,然后求得每个定位点的平均定位偏差i

X i=1 10 =0,1,2,--'20)

将定位偏差转化成脉冲的形式为:ni=16384x Xx16(向电机发送16384 个脉

冲,X 轴走1 微米)根据实验数据建立的螺距
补偿表如下:

#1

精品参考文献资料



优秀毕业论文

第五章基于PMAC半闭环的定位误差分析及误麓补偿

DEF E COMP 21172032

891

l∞

1022

1100

1027

1085

69

130

293

432

667 734

1074

1029

1037

1017

899

1028

1051

0

1008

反向间隙补偿表为:

l

DEF]E B∽OMP 21172032

9

O

l-4

15

2l

18

7

O

2

14

ll

8

15

13-6

2

ll

13

16

O

测得回零点的间隙误差为05pm,所以Ix86=13
对于每2个测定点(5ram)内的任意定位点,PMAC卡会根据螺距补偿表自动进行一阶线性插补补偿。

5323实验结果

经过反复测量实验,得出的实验结果如下:
1)在没有任何补偿的条件下,(100ram总行程,每5mm测一次,反复lO)正向定位精度和反向定位耩度分别为:A()=max[Xf+2Si门蠢=1,2

, ,2=487,um(D=max[i+2S#如秘=1,2, ,2l

=455am

双向定位精度:A=487朋,重复定位精度:R6SG=12, ,21)=51,m

2)在正反双向螺距补偿条件下,(10触嫩总行程,每5mm测一次,反复lQ)正向定位精度A(t)=43}tm,反向定位精度A(1)=39pro,双向定位精度A=43pm,重复定位精度R=37ttm

54本章小结

本章以北京卓刨恒信AC200教学设备为平台,介绍了基于PMAC运动控制卡的半闭环系统的组成,分析了半闭环系统的定位误差。利用PMAC的误差补偿方法,人为地制造一个与原误差大小相等、方向相反的误差,补偿修正了原有误差。最后通过实验证明了该方法可以有效提高系统的定位精度。

51

精品参考文献资料



优秀毕业论文

第六章总结与震望

第六章总结与展望

61总结

运动控制是自动化领域的共性基础技术,是推动新的技术革命和新的产业革命的关键技术。在庞大的市场需求刺激下,加上计算机、高速数字处理器(DSP)、自动控制、网络技术的发展,运动控制技术蓬勃发展,已应用到越来越多的产监领域。然而,我国运动控制技术的发展相对落后,提高运动控制技术水平是促进我国机电一体化技术发展的重要环节。本文针对提高运动控制系统性熊的关键技术做了有益的探索和研究,主要工作如下。

1)深入分析、研究了飚前先进的运动控制技术的基本原理、特点以及发展趋势,探讨了运动控制系统的分类。

2)基于永磁同步电机的数学模型,将滑模变结构控制(SMC)方法引入到对永磁同步交流电机(PMSM)位置环和速度环的设计中,并且将单段滑模线控制扩展成包括加速段、恒速段和减速段的完全滑动轨迹控制。

3)分析探讨了与运动轨迹规划耜关的理论和算法。详细推导了直线、S形和指数形加减速算法,并通过仿真的方法得到了相应算法的速度,加速度以及位移曲线;针对多轴运动分析了插补算法以及多轴运动的控制耩度闻题。

4)介绍了PMAC运动控制卡,着重研究了Pm+速度,加速度前馈算法及其参数

的调节。

5)为了提高半闭环系统的定位精度,蓿重研究了基于PMAC控制器的误差补偿方法及其实现,以卓创恒信AC200教学设备为实验平台,验证了该补偿方法的有效性。

62展望

为了提高运动控制系统的速度与精度,本文深入研究了先进的控制算法、轨迹规划算法,并通过仿真或实验的方法验证了其有效性。但是由于试验条件和现有技术的限制,还存在~些局部的不足之处有待于进一步研究。

()为了提高运动控制系统的性能,在第二章中研究了滑模变结构控制器,并把它雩l入到对永磁同步电机的控制当中。通过仿真实验验证了这种控制方法的有效性。但是,滑模变结构控制器控制参数较多,调节起来较为复杂。因此,优化滑模变结构控制器的控制结构和研究滑模变结构控制器参数的调节规律将是以后本课题的两大研究方向。

()在轨迹规划一章提出,指数鳇线轨迹规划能够改善时闻滞后的问题。但这 53

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

样规划方法所用的运动时间较长,如果提高加速度,则启动过程仍然会存在较大的冲击。这是指数速度曲线的一个缺点,如何改善这种特性,还有待于进一步研究。

()研究运动控制卡是研究开放式运动控制系统的关键。本文基于多轴运动控制卡PMAC研究了其控制算法以及提高系统定位精度的方法。目前市场上出售的运动控制卡大多数为国外品牌,而且价格昂贵。因此,研制性价比较高的运动控制器系列产品也是摆在我们面前的一大课题。

精品参考文献资料



优秀毕业论文

攻读硕士学位期间的研究成果

参考文献

1冷增祥.运动控制系统概述.江苏电机工程,1995(14)35-44
2丛爽,李泽湘.实用运动控制技术.电子工业出版社,20061
3吴宏,蒋仕龙等。运动控制器的现状与发展.制造技术与机床,2004(1)24-264邓红辉.基于DSP的运动控制系统的研究.合肥工业大学硕士论文,2002I-3
5闫砺锋.运动控制技术研究及运动控制板卡开发.四川大学硕士论文,20012-4
6王雄耀,吴建明等.运动控制与工业生产.现代制造,2004(17)22-26
7舒志兵.交流伺服运动控制系统.清华大学出版社,20068
6胡裕德.伺服系统原理与设计,北京:北京理工大学出版社,1993
9UtkinV IVariablestructuresystems withsliding modes[3]IEEETransonAC1977· 22(2)212-222

10IBoldeaand SANasarVectorControl of AC DriresCRCPressNY1992
11Bimal KBoseModernPower Electronics and AC Drives[M]Beijingchinamachine

press20031

12Chiu—Keng LaiKuo—KaiShyuAnovelmotordrivedesign for incremental motion systemviasliding—modecontrolmethodIEEETransactions onIndustrialElectronics200552(2)499-507

13Lin F JChiuSLShyuK KNovelsliding mode controller for synchronous motor

driveIEEETransactions onAerospaceand Electronic Systems199834(2)532—54214史晓娟.基于复合滑模变结构控制的位置伺服系统研究[J].电工技术学报,2003
18(3)64-66
15贾洪平,孙丹,贺益康.基于滑模变结构的永磁同步电机直接转矩控制.中国电机工程学报,
200626(20)134-138
16张昌凡,王耀南.滑模变结构的智能控制及其应用.中国电机工程学报,200121(3)27—29
17崔培良.高性能交流电机变频控制及效率改善.青岛大学硕士论文,20064
18王晓磊,赵克友.永磁同步电机最小损耗的直接转矩控制.电机与控制学报,2007(4)
19李崇坚.交流同步电机调速系统.北京:科学出版社,2006
20姚俊,马松辉.Simulink建模与仿真.陕西:西安电子科技大学出版社,2002
2l周渊深.交直流调速系统与MATLAB仿真.北京:中国电力出版社,2003

22EWilliamSimulationof Motion Control SystemsInternational Thomson Computer

Press1997112
23陆莲仕.最具运动平滑性的轨迹规划算法.广西大学硕士论文,2006

24Dong—I I KimJin—II SongDependenceOf Machining Accuracy On Acceleration

55

精品参考文献资料



优秀毕业论文

青岛大学硕士学位论文

DecelerationAndInterpolation Methods InC}iC MachineTools[J]IEEE1993(3 8)1898-1905
25胡建华,廖文和,周儒荣.CNC系统审凡种秀降速控铺曲线的研究舄比较。南京航空航天大 学学报,1999(6)706-711

26P.珏。MeeklPBArestidesand疆。CWoodsOptimizedS—Curve Motion Profiles for Minimum Residual Vibration Proceeding of theAmericanControlConference199827康健。舞放式高精度运动控躺系统的研究。珏安交逶大学博±学位论文,200312
28彭彬彬,庞学慧。马天海.一种新型捅补算法及其经济型数控系统中的应用.新技术新工艺, 2001(n)45-48
29赵玉刚。数控技术.机械工娩出版社,20043
30TGeorgeCChiuand MTomizukaContouringControlofMachine Tool FeedDrive SystemsATaskCoordinateFrame ApproachIEEETransactionsonControlSystems Technology20019(1)130—139

3l¥。TShihACLeeA Novel Cross-Coupling Control Design for Bi-AxisMotion InternationalJournalofMachineToolsManufacture2002421539-1548

32SSYehPLHsuANew Approach toBi—AxialCross-Coupled Contr01IEEEInternational ConferenceOilControlApplieations2000168—173

33罗睿梅.高速数控系统的运动控制技术.南京航空航天大学硕士论文,2003
34PRAC瘸户手册。薯艺京卓截慑信公司,2006
35欧阳航空.基于PMAC的精密定位控制系统的研究.上海大学硕士论文,2005
36PMAC software usermanualDELTATAU DataSystems1998
37汪小澄袁立宏等.可编程序控制器运动控制技术.机械工业出版社,200596-116
38孙一兰.多轴控制系统的研究。东北大学硕士论文,20051
39杨更更簿。数控机床丝杠传动误差正反双向补偿功能的实现[J]。缀合机床与融动化加工技术
2002(6)4-5
钧米菇文,戴趋涵.大行程精密定位控翱系统豹研究。仪器饺表学报,199821(1)89-9141精密定位平台的系统误差分析及螺距误差补偿方法的实现.机电工程,200522(1)22-24
42基于PMAC的耩密建位系统研究。机电一体纯,2005l30-32
43PMAC Users’ManualDELTATAU Data Systems1998
44GEllisRDLorenzComparisonof Motion Control Loops for Industrial Applications

IEEEIAS Annual MeetingPhoenix199942599—2605
45LPaulTrajectoryplanningand Feedforward Design for EleetromechanicalMotion SystemsReportnrDCT2003—182003()13—22
46陈伯时.电力拖动自动控制系统一运动控制系统.北京;机械工业出版社,20037

56

精品参考文献资料



优秀毕业论文

攻读硕±学位期闷熬研究成采47尔桂花,窦日轩.运动控制系统.北京:清

华大学出版社。2002

8e |labTM。,K.轰。StelsonPointtoPointMotion Commands that E1 iminate ResidualVibration

Proc1995 American Control ConfSeattle1997909—913

49丛爽.运动控制中先进控制策略得研究综述。微特电机,1998(I)I-5

50胡科峰.高速商精运动控制系统的软件研究.华中科技大学硕士论文,20044

5l孙慧驹.基于运动控制卡的全闭环控制系统研究.四川大学硕士论文,20035

52嚣。霉。ZhouControlDesign for Tracking Performance in Machine Servo SystemsDoctor

degreeof philosophyTheUniversityof Tulsa2001

57

精品参考文献资料



优秀毕业论文

攻读硕士学位麓闼的磺究成果

攻读硕士学位期间的研究成果

l 高菲,潘松峰等。基于PMAC半闭环系统的定位误差分析及误差补偿。山东科技 大学学报,20072640-42
2高菲,潘松峰等.永磁网步电机的完全滑模变结构控制.微特电机,200836(3) 33-35
3王磊,潘松峰,高菲.基于TMS320F2812的电参数谐波分析系统研究.电子技术, 200837(3)4547
4韩金恒,潘松峰,高菲.基于PMAC伺服系统豹P∞~前馈算法及其参数调节.信 息技术与信息化,将于20086月发表

59

精品参考文献资料



优秀毕业论文

致谢

致谢

本研究及学位论文是在我的导师潘松峰教授的亲切关怀和悉心指导下完成的。他严肃的科学态度,严谨的治学精神,精益求精的工作作风,深深地感染和激励着我。从课题的选择到最终完成,潘老师都始终给予我细心的指导和不懈的支持。两年多来,潘教授不仅在学业上给我以精心指导,同时还在思想、生活上给我以无微不至的关怀,在此谨向潘老师致以诚挚的谢意和崇高的敬意。

感谢本课题组的指导老师赵克友教授、于海生教授、原明亭副教授等,感谢他们给我提供的理论指导和良好的试验环境。

在此,还要感谢在一起愉快度过研究生生活的同学们,尤其是同窗王磊、关中杰,以及师弟韩金恒、林蒙、刘亚男、刘福乾、乔磊等。两年多来的共同生活使我们结下了深厚的友谊,正是由于你们的帮助和支持,才能使我克服一个又一个的困难和疑惑,直至本文的顺利完成。这一切都将是我今后人生道路上的精神力量,让我永远铭记在心。

最后我要感谢培养我长大含辛茹苫的父母和家人,谢谢你们给了我前进的动力

和勇气1

6l

精品参考文献资料

因篇幅问题不能全部显示,请点此查看更多更全内容