摘要
小型稳定平台有着广泛的应用前景,但低成本的小型稳定平台研究较少。论文采用两框两轴结构,进行了结构设计及关键部件选型,完成了小型稳定平台的研制。研制了电机数字控制器,并利用CAN总线及RS232组建了通信网络,实现了系统数据的实时共享。推导了电机驱动数学模型,进行了PID三环结构控制研究。建立了稳定平台姿态与电机驱动系统的空间矢量模型,通过反馈控制算法实现了2自由度电机驱动系统的解耦。针对电机驱动控制系统参数时变的特点,完成了包括:对象模板生成、约束条件建立、回路成型以及前置滤波器的QFT控制器的设计,试验结果表明有效抑制了参数变化影响。针对外部参数扰动以及内部参数变化的特点,研究了基于“模糊比例趋近率”的最优滑动模态的变结构控制算法,研究表明有效地提高了电机驱动系统的响应速度,并抑制了非线性对系统的影响。开发了实验研究平台,实验研究表明了算法的有效性。
Small-size stable platforms have a broad prospect, but small stable platform with low-cost relatively has little research. In the dissertation, a small stable platform with two two-axis frame structure has been developed. And structural design and selection of key components (such as:servo drive system, inertial measuring instrument) are described. A digital servo motor controller with CAN bus and RS232 has been developed. The system can share real-time data through CAN bus and RS232 communication network. The mathematical model of servo motor drive system is derived. The characteristics of the servo motor with current loop, velocity loop, and position loop were tested. The servo motor controlled by PID controller with three loops has been studied by the simulation and experiments. The special vector model between the stable platform attitude and two motor driver systems have been established. The feedback control algorithm is employed to decouple 2 degrees of freedom. The experiments show the decoupling algorithm validity. In order to deal with time-varying parameters of the servo motor drive system, the QFT controller design has been completed, including:plant model generation, constraint condition establishment, loop shaping and pre-filter design. The simulation results show that the QFT controller has a suppressive effect on time-varying parameters. To overcome internal parameter variability and external parameter disturbances effects on the servo motor control system, the optimal sliding mode variable structure control algorithm with fuzzy proportional approaching rate is studied. And simulation and experimental results show the rapid response ability of the motor drive system was improved, and the effects of the nonlinearity, hysteresis on the control system are restricted. An experimental research platform has been developed. The experimental study of the algorithms has been performed. And experiments show the algorithms validity.
引文
[1]贾平,张葆,刘晶红.轻型摄像稳定平台方案设计报告[D]:中科院长春光机所,1998
[2]张鹏.舰载摄像稳定平台的结构设计[J].舰船电子对抗,2006,29(3):70-73
[3]周燕.数控机床滚珠丝杠副的选择与计算[J].机床与液压,2005,(1):218-219
[4]吴鹏.精确制导光电导引头稳定平台数字拎制技术[J].弹箭与制导学报,2002,22(3):37-41
[5]满益明,龚建伟,陈慧岩等.车载捷联三自由度稳定平台设计与性能试验[J].农业机械学报,2009,40(3):16-20
[6]李游,张冰,姜建国.数字两轴稳定平台的工程实现[J].工矿自动化,2003,(4):33-35
[7]王继东.移动载体稳定跟踪平台测控关键技术研究[学位论文].国防科学技术大学,2003
[8]肖万选.几种稳定平台驱动系统的传动型式[J].舰船电子对抗,2000,(5):33-36
[9]王启明,张辉,汪劲松等.一种串并联式Stewart平台机构的误差分析[J].工具技术,2002,36(12):11-13
[10]Bi Shusheng, Zong Guanghua, Liu Rongwang, et al. Accuracy analysis of the serial-parallel micromotion manipulator. Proc. IEEE Int.Conference on Robotics and Automation, 1997:2258-2263
[11]丁蛟腾.舰载雷达稳定平台的机电动力学建模及其摩擦补偿[D].西安:西安电子科技大学,2008
[12]张振庄.机载卫星通信天线稳定平台的实现[J].无线电工程,1998,28(2):59-61
[13]姜明勇,陈向宁.基于TMS320LF247的遥感稳定平台控制器设计[J].测绘科学,2008,33(10):102-103
[14]吴树平.车载三轴稳定平台控制系统的研制[D].南京:南京理工大学,2007
[15]朱有为.精密稳定跟踪机构的动态设计[D].长沙:国防科学技术大学,2004
[16]吴麒.自动控制原理[M].北京:清华大学出版社,1992
[17]郑大钟.线性系统理论[M].北京:清华大学出版社,1989
[18]周东华.非线性系统的自适应控制导论[M].北京:清华大学出版社,2002
[19]K. J. Astrom, B. Wittermark. Adaptive Control [M]. Swedish:Addison-Wesley Publishing Company, 1989
[20]李清泉.自适应控制系统理论设计与应用[M].北京:科学出版社,1990
[21]周克敏,J. C.Doyle, K. Glover著,毛剑琴等译Robust and optimal control[M]北京:国防工业出版社,2002,7
[22]Jing-Chung Shen. H∞ control and sliding mode control of magnetic levitation system [J]. Asian Journal of Control,2002,4(3):333-340
[23]Chen Bing, Liu Xiaoping. Fuzzy approximate disturbance decoupling of MIMO nonlinear systems by backstepping and application to chemical processes [J]. Fuzzy Systems, IEEE Transactions on,2005,13(6):832-847
[24]石红生,卢广山.一种新型状态观测器在陀螺稳定平台中的应用[J].光与控制,1999,(1):24-28
[25]陶永华.新型PID控制及其应用[M].北京:机械工业出版社,2002
[26]Y. Mitsukura, T. Yamamoto, M. Kaneda. A design of self-tuning PID controllers using a genetic algorithm [A]. American Control Conference,1999 Proceedings of the 1999 [C],1999. 1361-1365 vol.1362
[27]胡祜德,曾乐生,马东升.伺服系统原理与设计[M].北京:北京理工大学出版社,1993
[28]夏超英,田树苞,李书生.机电控制系统的模型参考自适应控制[J].控制理论与应用,1988,(4):113-119
[29]马纪明,付永领,高波.基于定量反馈理论EHA控制器设计[J].北京航空航天大学学报,2006,32(5):553-557
[30]C. H. Houpis, M. Pachter. Application of QFT to control system design-an outline for engineers [J]. International Journal of Robust and Nonlinear Control,1997,7(6):515-531
[31]Navid Niksefat, Nariman Sepehri. Design of a Force Controler for a Hydraulic Actuator in Contract with an Uncertain Environment via Quantitative Feedback Theory[M]. The 14th world Congress of IFAC. Beijing, China.1999:91-96
[32]Cho, Junhee. Dynamic Modeling and Analysis for Swash-Plate Type Axial Pump Control Utilizing Indexing Valve Plate[D]. Columbia:University of Missouri,2000
[33]Wei Wu, Suhada Jaysuriya. A QFT design methodology for feedback systems under input saturation[[M]. Proceedings of the American Conference. Michigan.2000,6:1250-1254
[34]Wei Wu. A QFT design methodology for SISO uncertain LTI systems subject to input saturation [D]. American:Texs A&M University,2000
[35]Navid Niksefat, Nariman Sepehri. A QFT Fault-Tolerant Control for Electrohydraulic Positioning Systems [J]. IEEE Transaction On Control Systems Techology,2002,10(4):626-632
[36]So Ldak, C Baril. Quantitative Design of A Class of Nonlinear Systems with Parameter Uncertainty[J]. International Journal of Robust and Nonlinear Control,1994,4(1):101-118
[37]肖永利,张琛,陈文华.定量反馈理论(QFT)及其设计应用[J].信息与控制,1999,28(6):437-445
[38]王燕山,王益群.基于QFT的电液力伺服系统的鲁棒控制[J].中国机械工程,2003,14(9):731-733
[39]富强,尔联洁,赵国荣.基于定量反馈理论的飞行仿真转台鲁棒控制[J].北京航空航天大学学报,2004,30(5):410-413
[40]李英,葛文奇,王绍彬.稳定平台的自适应逆控制[J].光学精密工程,2009,17(11):2744-2749
[41]I. Horowitz. Survey of Quantitative Feedback Theory[M]. International Journal of Control. 1991:255-291
[42]V.I. Utkin. Variable structure systems with sliding modes[J]. IEEE Transactions on Autom atic Control,1977,22(2):212-222
[43]Weibing Gao, Yufu Wang, Homaifa A. Discrete-time variable structure control systems [J]. IEEE Transactions on Industrial Electronics,1977,42(2):117-122
[44]贾洪平,孙丹,贺益康.基于滑模变结构的永磁同步电机直接转矩控制[J].中国电机工程学报,2006,26(20):134-138
[45]彭书华,李华德,苏中.不确定参数电动舵机滑模变结构控制[J].电机与控制学报,2009,13(1):128-132
[47]桑勇,祁晓野,王占林.基于滑模变结构控制的电机-泵组、阀复合调速的研究[J].煤炭学报,2006,31(5):674-678
[48]邹云飞,刘金琨,王宗学.一种离散变结构控制方法在伺服系统中的应用[J].机床与液压,2002,(2):31-33
[49]G. Zames. Feedback and optimal sensitivity:Model reference transformations, mutiplicative semi norms, and approximate inverse[J]. IEEE Transactions on Automatic Control,1981,26(2): 301-320
[50]韩曾晋.自适应控制[M].北京:清华大学出版社,1994
[51]P. A. Inoannou, S. Jing. Robust adaptive control [M]. Prentiee--Hall International,1996
[52]Qingding Guo, Limei Wang,Ruifu Luo. Completely digital PMSM servo system based on new self-tuning PID algorithm and DSP[A]. Industrial Technology,1996 (ICIT'96), Proceedings of The IEEE International Conference on[C],1996.71-75
[53]Paul Stewart, Visakan Kadirkamanathan. Dynamic model reference PI control of permanent magnet AC motor drives[J]. Control Engineering Practice,2001,9(11):1255-1263
[54]Hsien Tsung-Lieh,Tsai Mi-Ching, Sun York-Yih. Robust speed control of permanent magnet synchronous motors:design and experiments[A]. Industrial Electronics,Control, and Instrumentation,1996, Proceedings of the 1996 IEEE IECON 22nd International Conference on [C],1996, vol.1172,1177-1182
[55]P. Gahinet, P. Apkarian. A linear matrix inequality approaeh to control [J]. InterJ Robust and Nonlinear Control,1994,421-448
[56]E. Soroka, U. Shaked. On the robustness of LQ regulators[J]. IEEE Transactions on Automatic Control,1984, AC-29(Copyright 1984, IEE):664-665
[57]C. L. Hwang, S. Y. Han. Mixed H-2/H-inf inity design for a decentralized discrete variable structure control with application to mobile robots[J]. Ieee Transactions on Systems Man and Cybernetics Part B-Cybernetics,2005,35(4):736-750
[58]W. M. Haddad, D. S. Bernstein, D. Mustafa. Mixed-norm H2/H-infinity regulation and estimation-the discrete-time case[J]. Systems & Control Letters,1991,16(4):235-247
[59]A. A. G. Siqueira, M. H. Terra, B. C.O. Maciel. Nonlinear mixed H2/H infinity control applied to manipulators via actuation redundancy[J]. Control Engineering Practice,2006,14 (4): 327-335
[60]卢伯英,于海勋.现代控制工程[M].北京:机械工业出版社,2000
[61]徐小琴.三闭环直流调速系统仿真研究[J].南通职业大学学报,2009,23(4):82-85
[62]冯艳娜,高满茹.基于DSP技术的三闭环直流调速系统设计[J].电器技术,2008,6,32-37
[63]I Horowitz. Quantitative feedback theory[J]. IEE Proceedings:Electric Power Applications, 1982,129(6):215-226
[64]I Horowitz. Survey of Quantitative feedback theory (QFT) [J]. Int J Control,1991,53(2): 255-291
[65]I Horowitz. A synthesis for linear feedback systems with large plan ignorance for prescribed time-domain tolerances[J]. International Journal of Control,1972,16(2):287-309
[66]D. J. Balance, P. J. Gawthrop. Control sytems design via a quantitative feedback theory approach[M]. Proceedings of IEE Conference "Control'91".1991:476-480
[67]I. M. Horowitz, A. Gera. Optimization of the loop transfer function[J]. International Journal of Control,1980, (31):389-398
[68]Ch Houpis.Sj Rasmusen. Quantitative feedback theory fundamentals and applications[M]. NewYork:Marcel Dekker,2006
[69]J. M Adams, K. S Rattan. Genetic multi-stage fuzzy PID controller with a fuzzy switch [J]. IEEE Transactions Systems, Man and Cybernetics,2001, (4):2239-2244
[70]肖永利,张琛,陈文华.定量反馈理论(QFT)及其设计应用[J].信息与控制,1999,28(6):437-445
[71]刘长年.液压伺服系统的分析与设计[M].北京:科学出版社,1987
[72]Navid Niksefat. Robust force controller design for a hydraulic actuator based on experimental input-output data[M]. Proceedings of the 1999 IEEE International Symposium on Computer Aided Control System Design Kohala Coast-Island of Hawai'i. Hawai'i, USA.1999: 492-497
[73]J. M Rodrigues,Y Chait,C.V Hollet.An effect algorithm for computing QFT bounds. Journalof DynamicsSystems[J]. MeasurementandControl,1997,119(9):548-552
[74]N Niksefat.N Sepehri. Fault tolerant control of electrohydralic servo positioning system [J]. Proceedings of the American Control Conference Arlington:Institute of Electrical and Electronics Engineers Inc,2001,4472-4477
[75]D. F Thompson, D. I Nwokan. Analytical loop shaping methods in quantitative feedback theory [J]-Journal of Dynamic Systems, Measurement, and Control,1994,116(3):169-177
[76]Y Chait.QFT loop shaping and minimization of the high-frequency gain via convex optimization[M]. Proceedings of the Symposium on Quantitative Feedback Theory and other Frequency Domain Methods and Applications.1997:13-28
[77]G. N Saridis, C. S. G Lee. An approximation theory of optimal control for turntables manipulators [J]. IEEE Trans Systems Man Cybern,1979,9(3):152-159
[78]李笑.电液比例复合变量泵神经网络控制的研究[J].机床与液压,2002,(5):29-31
[79]Sw Pan,Hy Su,Xh Hu.Variable structure control theory and application:A survey[A].3rd World Congress on Intelligent Control and Automation[C],HEFEI, PEOPLES R CHINA,2000.I E E E,345 E 47TH ST, NEW YORK, NY 10017 USA 2977-2981
[80]Mounir Ben Ghalia, Ali T.Alouani.Sliding Mode Control Synthesis Using Fuzzy Logic[A]. Proceedings of the 1995 American Control Conference Part 2 (of 6)[C].Seattle, WA, USA, 1995.1528-1532
[81]韩崇伟.火炮位置伺服系统的鲁棒控制与应用研究[D].西安:西安交通大学,2002
[82]侯忠生.无模型自适应控制的现状与展望[J].控制理论与应用,2006,23(4):586-592
[83]姚琼荟,黄继起,吴汉松.变结构控制系统[M].重庆:重庆大学出版社,1997
[84]刘金琨,孙富春.滑模变结构控制理论及其算法研究与进展[J].控制理论与应用,2007,24(3):407-418
[85]K. David Young, Vadim I. Utkin, Umit Ozguner. A control engineering's guide to sliding mode control[J]. IEEE Transaction on Control Systems Technology,1999,7(3):328-342
[86]邹伟全,姚锡凡.滑模变结构控制抖振问题研究[J].控制与检测,2006,(1):53-55
[87]I. Boiko, L. Fridman, R. Iriarte. Analysis of chattering in continuous sliding mode control [A]. Proceedings of the 2005 American Control Conference[C],2005.2439-2444
[88]Hoon Lee, Vadim I. Utkin. Chattering suppression methods in sliding mode control systems[J]. Annual reviews in control,2007,31(2):179-188
[89]J. H. Lee, P. E. Allaire, G. Tao. Integral sliding-mode control of a magnetically suspended balance beam:Analysis, simulation, and experiment[J]. IEEE/ASME Transactions on Mechatronics,2001,6(3):338-346
[90]Wu-Chung Su,Sergey Drakunov,Urnit Ozguner. Sliding mode with chattering reduction in sampled data systems [A]. Proceedings of the 32nd IEEE Conference on Decision and Control [C], San Antonio, TX, USA,1993. Publ by IEEE, Piscataway.NJ, USA,1993:2452-2457
[91]Chen Hong-ming, Jyh-Chayang Renn, Juhng-Perng Su. Sliding Mode Control with Varying Boundary Layers for an Electro-hydraulic Position Servo System[J]. International Advanced Maunfature Technology,2005,26 (26):117-123
[92]高为炳,程勉.变结构控制系统的品质控制[J].控制与决策,1989,(4):1-6
[93]高为炳.变结构控制研究的发展与现状[J].控制与决策,1993,8(4):241-248
[94]苏心怡,朱纪洪,胡金春.基于模糊逻辑的直升机终端滑模控制[J].清华大学学报,2004,44(4):554-557,562
[95张志强,李战明.模糊趋近律滑模变结构的二级倒立摆系统控制仿真[J].西华大学学报,2008,27(1):81-84
[96]张金明,张平安,李人厚.一类非线性系统的模糊趋近律控制[J].西安石油学院学报,2000,15(3):35-38
[97]Kang-Bark Park, Ju-Jang Lee. Sliding mode controller with filtered signal for robot manipulators using virtual plant/controller[J]. Mechatronics,1997,7(3):277-286
[98]Don Krupp, Yuri B. Shtessel. Chattering-free sliding mode control with unmodeled dynamics [A]. Proceedings of the 1999 American Control Conference[C],San Diego, CA, USA,1999. Piscataway, NJ, USA:IEEE,1999:530-534
[99]H. Yanada,H. Ohnishi. Frequency-shaped sliding mode control of an electrohydraulic servomotor[J]. Proceedings of the Institution of Mechanical Engineers, Part Ⅰ(Journal of Systems and Control Engineering),1999,213(16):441-448
[100]姜静.坦克炮控系统的鲁棒变结构控制[D].北京:北京理工大学,2005
[101]吴麒.自动控制原理(下册)[M].北京:清华大学出版社,1992:419-421
[102]张平.Matlab基础与应用简明教程[M].北京:北京航空航天大学出版社,2001
[103]江坤,张井岗.一种新的基于模糊趋近律的滑模控制方法[J].系统仿真学报,2002,14(7):964-967
[104]Seung-Bok Choi,Jung-Sik Kim. A fuzzy-sliding mode controller for robust tracking of robotic manipulators[J].Mechatronics,1997,7(2):199-216
[105]W. Li, X. G. Chang, Jay Farrell. Design of an Enhanced Hybrid Fuzzy P+ID Controller for a Mechanical Manipulator[J]. IEEE Transactions on System, Man, and Cybernetics-Part B:Cybernetics,2001,31 (6):938-945
[106]孙增圻,张再兴,邓志东.智能控制理论与技术[M].北京:清华大学出版社,广西科学技术出版社,1997
[107]刘金琨.滑模变结构控制的MatLab仿真[M].北京:清华大学出版社,2005
[108]李国勇.智能控制及其Matlab实现[M].北京:电子工业出版社,2005
[109]黄忠霖.自动控制原理的Matlab实现[M].北京:国防工业出版社,2007
[120]王丰尧.滑模变结构控制[M].北京:机械工业出版社,1995
[111]田宏奇.滑模控制理论及其应用[M].武汉:武汉出版社,1995
[112]庄开宇.变结构控制理论若干问题研究及其应用[D].杭州:浙江大学先进控制研究所,2002
[113]Sinn-Cheng Lin,Yung-Yaw Chen. Design of self-learning fuzzy sliding mode controllers based on genetic algorithms[J]. Fuzzy sets and systems,1997,86(2):139-153
[114]付华,杜维.利用遗传算法优化模糊控制器综述[J].石油化工自动化,2001,24(1):24-27
[115]R. J. Wai, F. J. Lin. Fuzzy neural network sliding-mode position controller for induction servo motor drive[J].IEE Proceedings:Electric Power Applications,1999,146(3):297-308
[116]穆效江,陈阳舟.滑模变结构控制理论研究综述[J].控制工程,2007,14(7):1-5
[117]Pai-Yi Huang, Sinn-Cheng Lin,Yung-Yaw Chen.Real-coded genetic algorithm based fuzzy sliding-mode control design for precision positioning[A].1998 IEEE international conference on fuzzy systems proceedings IEEE world congress on computational intelligence[C], Anchorage, AK, USA,1998. IEEE, New York, NY, USA:1247-1252
[118]张昌凡,王耀南.滑模变结构的智能控制及其应用[J].中国电机工程学报,2001,21(03):27-30
[119]孙常胜,刘妃,陈杰.坦克稳定器滑动模态变结构控制[J].计算机仿真,2004,21(1):22-25
[120]Her-Terng Yau, Chieh-Li Chen. Chattering-free fuzzy sliding-mode control strategy for uncertain chaotic systems [J]. Chaos Sol itons&Fractals,2006, (30)709-718
[121]冯亮,马晓军,王冬.坦克炮控伺服系统的模糊滑模变结构控制[J].电气传动,2007,37(11):46-49
[122]周兆敏.用极点配置方法设计滑模控制器[J].信息与控制,1988,(4):47-49
[123]高为炳.变结构控制的理论及设计方法[M].北京:科学出版社,1996
[124]李友善,李军.模糊控制理论及其在过程控制中的应用[M].北京:机械工业出版社,1993
[125]Mahdi Jalili-Kharaajoo, Kaveh Kangharloo, Farzad Habibipou Roudsari.Fuzzy sliding mode control design based on genetic algorithms:application to building structures[A].2004 IEEE International Conference on Industrial Technology[C], Hammamet,Tunisia,2004. Institute of Electrical and Electronics Engineers Inc.:27-31
[126]Chung-Chun Kung, Chih-Chi Chen. Grey fuzzy sliding mode controller design with genetic algorithm [A]. Proceedings of the 36th IEEE Conference on Decision and Control [C], San Diego, CA, USA,1997. IEEE, New York, NY, USA:2748-2753
[127]J. Y. S Luh, M. W Waler, Paul R. P. Resolved acceleration control of mechanical manipulators [J]. IEEE Trans, Auto Contr,1980,25(3):468-474
[128]王芳菲.两自由度稳定平台的控制策略分析[D].大连:大连海事大学,2009