高精度平臺運動系統設計
前言：想要寫出一篇引人入勝的文章？我們特意為您整理了高精度平臺運動系統設計范文，希望能給你帶來靈感和參考，敬請閱讀。
摘要:為實現Stewart平臺的高精度運動控制，設計了基于運動學模型的運動控制系統。在工作空間中使用梯形速度曲線進行軌跡規劃，通過位置反解得到關節空間中各支腿的規劃軌跡，設計位置—速度雙環控制器控制支腿跟蹤各自軌跡。為抑制外部擾動，提高魯棒性，使用基于模型輔助線性擴張狀態觀測器的自抗擾控制器作為速度環控制器。為在保證軌跡跟蹤精度的同時，加快系統鎮定速度，使用分段積分重置PI控制器作為位置環控制器。將所設計的控制器應用到實際控制系統中，并進行了運動控制實驗。實驗表明:在所設計控制系統的控制下，平臺運行平穩，并能夠較快穩定到目標位姿。
關鍵詞:Stewart平臺;自抗擾控制;模型輔助線性擴張狀態觀測器;積分重置
0引言
大型望遠鏡光路系統通常包括主鏡、次鏡，為了保證良好的成像質量，需要主鏡與次鏡的反射面焦點重合，光軸重合。然而由于重力、振動等原因，主鏡和次鏡之間的位姿往往會發生改變，從而導致望遠鏡成像質量受到影響，因此需要對主次鏡之間的位姿進行精確的調整和校正。由于主鏡的尺寸、質量遠大于次鏡，若對主鏡進行調整，其功耗較大，實際工程中往往采用次鏡調整機構來調整主次鏡之間的相對位姿［1］。
而Stewart平臺因其高精度、高剛度的優點，在大型望遠鏡中作為次鏡調整機構被廣泛使用［2］。本文所研究的Stewart平臺控制系統，作為次鏡調整機構，控制任務為控制動平臺從當前位姿點運動到目標位姿點，要求運動過程平穩且不超過工作空間，并且能夠快速無差的穩定到目標位姿。
1Stewart平臺運動學模型及其反解
1．1Stewart平臺運動學模型
本文Stewart平臺為6—UCU構型，由上平臺、下平臺及6條支腿構成，其中上平臺為動平臺，下平臺為靜平臺。上下平臺與6條支腿之間通過虎克鉸相連，支腿運動機構可簡化為移動—轉動副，通過控制6條支腿的長度變化，可控制上平臺的3個方向的平移和3個方向的旋轉。
1．2Stewart平臺位置反解
已知上平臺和下平臺之間的位姿關系，求解對應的各支腿長度，被稱為Stewart平臺的位置反解(此處位置的含義為廣義位置)。位置反解是對Stewart平臺進行運動控制的基礎［3］。
2工作空間軌跡規劃
由于并聯平臺特殊的閉環運動鏈構型，其工作空間有限［4］，若讓各支腿直接運動到運動學反解計算出的目標位置處，在運動的過程中動平臺可能會超出工作空間，因而必須對并聯平臺進行軌跡規劃。考慮動平臺從位姿點u1到位姿點u2的軌跡規劃，由于所設計控制系統只需實現點位控制，對軌跡形狀不做要求，為求簡便，取軌跡為6維空間內的一條線段。同時為使運動更加平穩，使用梯形速度曲線對平臺運動速度進行規劃按平臺能否加速到最大速度分為兩種情況，
1)能夠加速到最大速度時，速度和加速度曲線，0～t1段為加速段，以amax做均加速運動;t1～t2段為勻速段，以vmax做勻速運動;t2～t3段為減速段，以－amax做勻減速運動。
2)不能加速到最大速度時，速度和加速度曲線，，0－t4段為加速段，以amax做均加速運動。
3關節空間建模與辨識
在對實際系統缺乏了解時，直接進行控制器設計往往存在風險和不便。因此，在控制器設計之前，首先通過辨識的手段，得到關節空間的信息，即支腿的模型信息。關節空間的控制任務為控制支腿跟蹤由工作空間規劃軌跡反解得到的位置曲線，由于支腿位置可看作是運動速度的積分，本節將對支腿的速度—電壓關系進行建模和辨識。關節空間中，由直流電機驅動滾珠絲桿帶動支腿上部運動，使支腿長度發生改變。不考慮負載力的影響，可將支腿的速度—電壓開環傳遞。
為得到式中參數的具體數值，使用頻率響應法對支腿進行辨識，其思想為測量系統在不同頻率正弦信號輸入的輸出響應，以求得系統模型的待定參數［5］。對每個測試頻率，運行6s，并記錄其中2～4s的速度值，進行多次實驗，將相同時間點處的速度值取平均值，求得各頻率點幅值放大倍數和相移角度。
4關節空間控制器設計
在高精度位置控制器設計中，往往采用位置—速度雙環控制方案。其中，速度內環控制的主要目的是抑制外部擾動，增強魯棒性。通常希望通過內環控制器的校正作用，使得校正后的內環特性盡可能的接近名義模型，這樣在外環控制器設計時，即可將名義模型視為實際的控制對象［6］。
已通過辨識實驗得到關節空間的速度—電壓模型，但由于未建模部分和外部擾動的影響，其和真實系統之間必然存在差距。選取狀態變量:x1=y，x2=y，x3=f＇，則x=［yyf＇］T為包含了總擾動的擴張狀態向量，將式(8)轉換為擴張狀態空間方程描述式中err為位置環參考信號r＇與當前位置y＇之差，errI為位置誤差的積分。為加快鎮定速度，在最后穩定階段引入積分重置策略，即當檢測到當前位置超過目標位置時，直接將errI重置為0，從而減小支腿運動超調的距離。
5實際控制系統與實驗
Stewart平臺控制系統的總體框架如圖4所示。實際控制系統由上位機、下位機、Stewart平臺組成。采用FPGA+DSP異構方案，FPGA和DSP通過外部存儲器接口通信，實現傳感器信息(增量式編碼器、限位開關)的讀取和控制信號(PWM信號)的產生［8，9］。接口板實現差分轉單端、電平變換、光耦隔離等功能。驅動板由6對PWM信號控制，驅動平臺按照給定軌跡運動。
為驗證所設計控制系統性能，進行Stewart平臺運動控制實驗。平臺具體尺寸為r=90mm，R=148mm，θ=110．0786°，φ=15．7965°。控制周期為1ms，限制平臺位姿的位置分量的最大速度和最大加速度幅值為1mm/s和1mm/s2，姿態分量的最大速度和最大加速度幅值為1°/s和1°/s2。控制Stewart平臺從中位點［00244．8273000］T運動到［4－1247．82733－1－1］T處，記錄0～20s各時刻的支腿長度，并利用高斯—牛頓法求得對應的動平臺位姿。動平臺按照所規劃的軌跡運動，運行平穩，且在開始運動和停止運動時均有妥善的過渡過程。其在0～5s的軌跡跟蹤階段，平臺位置跟蹤誤差在0．01mm以下，姿態角跟蹤誤差在0．005°以下，并且在5．8s左右，動平臺位姿鎮定。最終平臺穩定在［3．99989－0．99990247．827172．99992－1．00001－1．00002］T，偏差與位置傳感器量化誤差在一量級，因而可以將其忽略，認為平臺已經穩定在給定位姿上。
6結論
實驗結果表明:在本文所設計的控制系統控制下，高精度Stewart平臺運行平穩，具有良好的跟蹤精度，并且最終能夠較快的穩定到目標位姿，取得了理想的控制效果。
參考文獻:
［1］于陽．大型空間望遠鏡次鏡精密調整機構研究［D］．長春:中國科學院研究生院(長春光學精密機械與物理研究所)，2016．
［2］梅萊．并聯機器人［M］．北京:機械工業出版社，2014．
［3］黃真．并聯機器人機構學理論及控制［M］．北京:機械工業出版社，1997．
［4］李云峰，楊兆宜，李長峰．精密并聯機器人運動軌跡規劃的研究［J］．機床與液壓，2009，37(10):67－71．
［5］周儒勛，張澤龍，亓迎川．直流電機模型參數的直接辨識［J］．計算機仿真，2006，23(6):31－33．
［6］劉強．高性能機械伺服系統運動控制技術綜述［J］．電機與控制學報，2008，12(5):603－609．
［7］葉東，周志煒，張飚，等．基于FPGA的多路光電編碼器數據采集系統［J］．傳感器與微系統，2006，25(5):45－47．
［8］張鋒，彭正輝，任強，等．基于FPGA平臺的光電編碼器在探地雷達中的應用［J］．傳感器與微系統，2015，34(8):149－151．
作者：武錫銅 周烽 王永 單位：中國科學技術大學 信息科學技術學院