已阅读5页,还剩1页未读, 继续免费阅读
版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
52ActaElectrotechnicaetInformatica,Vol.11,No.2,2011,5257,DOI:10.2478/v10198-011-0019-6ISSN1335-8243(print)2011FEITUKEISSN1338-3957(online)/aeiTHEMOSTSUITABLEALGORITHMFORINVERTEDPENDULUMCONTROLPeterPSTORDepartmentofAvionics,FacultyofAeronautics,TechnicalUniversityofKoice,Rampov7,04121Koice,SlovakRepublic,e-mail:pastor_ABSTRACTTheaimofthepaperistoshowcomparisonbetweenthreepossiblerealizationsofthePIDregulatorconnection.Inthiscasetheregulatedparameterisdeviationfromdesiredverticalposition.Thestructureoftheregulatorissamelikestructureofautopilotusedinaircraftforpitchanglestabilization.Threedifferentstructuresofalgorithmsaredescribedandthesestructuresdifferbyproportional,integrationandderivategainconnection.Thegoalistofindthemostsuitablestructureforpendulumstabilization.Thecriteriaforthebestsystemselectionaresystemsstability,widerangeofstabilizedangle,uncomplicatedfinalstructureandnoovershootingofinputslimitations.Keywords:invertedpendulum,thrustvectoringnozzle,PIDregulator,autopilot1.INTRODUCTIONInvertedpendulumisatypicalexampleoftheinherentlyunstablesystemandiswidelyusedasbenchmarkfortestingcontrolalgorithms(PIDcontrollers,neuralnetworks,fuzzylogic,etc.).Thissystemapproximatesthedynamicsofarocketimmediatelyafterlift-off,ordynamicsofathrustvectoredaircraftinunstableflightregimesinlowdynamicpressureconditions.Theobjectiveoftherocketcontrolproblemistomaintaintherocketinaverticalattitudewhileitaccelerates1.Angularpositionoftheinvertedpendulumiscontrolledbyinputforce.Inthiscasethecontrollingforceisgeneratedbysystemofvectorednozzles,whereforceisdirectlyproportionaltonozzledeflection.Positionlimitation(20deg),ratelimitation(60deg/sec)andnozzledynamicrepresentingby2ndordertransferfunctionarealsoconsidered.Themodelofthesystemofthevectorednozzleswillbebrieflydescribedlater.Thismodelisconnectedwiththenonlinearmodeloftheinvertedpendulumgivenbyfollowingequations:()22222cosdxddMmmlmlFdtdtdt+=(1)()22222cossinddxJmlmlmgldtdt+=+(2)whereMmassofthecart,mmassofthependulum,llengthtopendulumcentreofmass,Jinertiaofthependulum,deviationfromverticalposition,xcartpositioncoordinate,gaccelerationofgravity,Finputforce.Theconstructionofthemodelisdescribedinmoredetailsinpublication2.Thissystemwillbeappliedforfinalnonlinearanalysesoftheselectedcontrollingsystem.Transferfunction,givenbyequation(3)willbeutilizedforcontrollerdesignandregulatorsparameterssetting:()()5222201,2815101,90836lsKJmlUssssgJ=+(3)whereKgainofthesystem,0naturalfrequencyofthesystem.ThisfunctioniseasytoanalyseandthePIDregulatordesignisalsonotcomplicated.2.1STALGORITHMThefirstalgorithmstructureisdescribedbyfollowingcontrollaw3:()()()()ZFsPsssDs=+(4)whereF(s)forceappliedtothependulum;Z(s)desiredvalueofangle;P,Dcoefficientsoftheregulator.ThestructureofthisautopilotconsistsoftwoloopsouterandinnerandisdepictedinFig.1.Fig.1Structureofthe1stAlgorithmThetransferfunctionoftheinnerloopis:2202202201KssKsKDssKDss+=+(5)Andtransferfunctionofthewholesystem:()()()220ZsKPssKDsKP=+(6)TheP,Dparameterscouldbecalculatedbycomparingthedenominatorofequation(6)withdesireddenominatorshape:222SPSPSPs+(7)ActaElectrotechnicaetInformatica,Vol.11,No.2,201153ISSN1335-8243(print)2011FEITUKEISSN1338-3957(online)/aeiFrompreviousformulayoucanfindthesimilaritywithaircraftshortperiodmodeandthesamecriteriaforshortperioddampingSPandfrequencySPareuseableforthispurpose.Thecriteriaforshortperioddampingandfrequencyaccording4,5,6are:0,351,3;1/secSPSPradComparedenominatorofequation(6)withexpression(7):()222202SPSPSPsKDsKPs+=CoefficientDcanbecalculated:12SPSPJDkgmsl=(8)AndcoefficientP:22SPJPmgkgmsl=+(9)Fig.2showsthestepresponse,wheninputsignalisstepfunctionwithfinalvalue:/10.Thisvaluewasapproximatelycalculatedfromequations(1)and(2).ValueofPcoefficientis:P=-461049andDcoefficient:D=-312133.Fig.2AngleTimeResponseYoucanseefromFig.3,thattheinputforceint=0exceedsthelimitationandthisstructurecannotbeusedforfurtherdesign.Fig.3InputForceTimeResponse3.2NDALGORITHMThesecondalgorithmisgivenbyfollowingcontrollaw3:()()()()ZPsIFssDssss+=+(10)whereIintegrationcoefficientofthePIDregulatorandmeaningofotherparametersissamelikeinequation(4).ThestructureoftheautopilotisdepictedinFig.4.Fig.4Structureofthe2ndAlgorithmThemodelconsistsalsofrom2loopsinnerandouterandthetransferfunctionvalidforinnerloopisgivenbyequation(5).Includingouterloop,thefinaltransferfunctionis:()()()3220ZsKPsKIssKDsKPsKI+=+(11)Binomialstandardformfor3rdordersystemdescribesdesiredtimeresponse3:322333ZZZsss+,whereZisdesiredvalueofnaturalfrequency.TheP,I,Dcoefficientsare:223ZJPmgkgmsl=+(12)33ZJIkgmsl=(13)13ZJDkgmsl=(14)Thetimeofregulationcanbeapproximatelycalculatedbyusingformula:7secrZt(15)ThestepresponseisshowninFig.5andthePIDregulatorcoefficientsare:P=-1085315,8;I=-624267;D=-468200.ItcanbeobservedinFig.5theundesirableovershoot.TrytoadjustP,IandDcoefficientstoeliminatetheovershoot.ThecoefficientsfordifferentZvalueareshowninTable1.Table1CoefficientsfordifferentZvalueZPID1-383015,8-73033-2341002-1085315,8-624267-4682004-3894515,8-4994133-93640054TheMostSuitableAlgorithmforInvertedPendulumControlISSN1335-8243(print)2011FEITUKEISSN1338-3957(online)/aeiFig.5AngleTimeResponseItispossibletodeterminefromFig.6therelationshipbetweenovershootandZvalue.IftheZvalueisincreasing,theovershootisdecreasingandviceversa.Fig.6AngleTimeResponseYoucanseeinFig.7thatinputforceexceedslimitationagainforallcoefficientsvaluesetting.Fig.7InputForceTimeResponse4.3RDALGORITHMThefollowingcontrollawisvalidforthirdalgorithm3:()()()()()2ZsFssDssPsIss=+Letsdividethepreviousexpressionby1/s:()()()()()ZIFssDsPssss=+(16)ThestructureoftheautopilotisshowninFig.8.Fig.8Structureofthe3rdAlgorithmThestructureconsistsofthethreeloopsinner,middleandouter.Theformoftheinnerloopisthesamelikeinpreviousexamplesandisgivenbyequation(5).Thetransferfunctionincludingmiddleloophasform:()220KsKDsKP+Andthetransferfunctionofthewholesystem:()3220KIsKDsKPsKI+(17)Thedenominatorofequation(17)hasthesameformlikedenominatorofequation(11),sothesamevalueofP,I,Dcoefficientarevalid.Fig.9showstimeresponsetoinputstepfunctionwithfinalvalue/10.Fig.9AngleTimeResponseFig.10InputForceTimeResponseActaElectrotechnicaetInformatica,Vol.11,No.2,201155ISSN1335-8243(print)2011FEITUKEISSN1338-3957(online)/aeiYoucanobserveinFig.10thatinputforcedoesnotexceedthelimitation,whichisdepictedasredlimitingline.Thisstructureisthemostsuitableforanglecontrol,becauseinpreviousexamplestheinputforceexceedslimitedvalue.TheBodecharacteristicoftransferfunctiongivenbyequation(17)isshowninthefollowingfigure.Fig.11BodeCharacteristic5.NONLINEARANALYSESThestructurefornonlinearanalysesconsistsoftwononlinearmodelsmodelofinvertedpendulumdescribedbyequations(1)(2)andmodelofthrustvectoringsystemofaircraftsengineincludingdynamicofnozzlesgivenby2ndordertransferfunctionsimilarlikeinpublication4:240040400ss+Itsdeflectionislimited20deginpositionand60deg/secinrate1.Modelprovidescalculation7ofthesummaryforcesandmomentsgeneratedbythrustsystem.Inthisexampleonlyforceinpitchcontrolisconsidered:()()sinFsTs=(18)whereTisthethrustproducedbynozzleanditsvalueisconstantduringsimulation;anglebetweenvectorednozzledeflectionandlongitudinalaxes.Substituteequation(18)intocontrollaw(16):()()()()()sinZITssDsPssss=+(19)Letsassumethesimplificationforsmallangleofnozzledeflection(approximatelyupto20deg)isvalid:sin(s)=(s).Divideequation(19)bythrustT:()()()()()1ZDPIssssssTTTs=+(20)Equation(20)representscontrollawforsystemmentionaboveandshowninFig.12.Fig.12SystemforNonlinearAnalysesNewP,I,Dvaluescanbecalculatedbyapplyingeq
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 通风与空调综合项目工程综合项目施工专项方案
- 文化创意服务买断协议书
- 天然气开采用地地基转让合同
- 学生游泳安全协议
- 特殊路基处理综合项目施工专项方案
- 综合项目工程部经理岗位职能职责
- 雨季综合项目施工安全专项综合项目施工专项方案
- 企业相亲会活动专项方案
- 差旅费管理规定 (18篇)
- 山东建筑大学建筑城规学院《344风景园林基础》(建)专业硕士历年考研真题汇编合集
- 绿植租摆服务投标方案(技术方案)
- 帆船俱乐部商业计划书
- 学科情感教育
- 四年级德育教育题库(附答案)
- 黎平机场改扩建项目可研阶段社会稳定风险评估报告文书
- 变电站110kV-GIS-742开关(B4)SF6六氟化硫-气室SF6气体泄漏处置演练方案
- 银行授信报告案例
- 杂质度的测定-测定方法
- 【格力电器公司税收筹划方案设计(5000字论文)】
- 火花塞检查与更换教案
- 滑坡灾害应急救援抢险技术指导书
评论
0/150
提交评论