高精度平臺運(yùn)動系統(tǒng)設(shè)計

前言：想要寫出一篇引人入勝的文章？我們特意為您整理了高精度平臺運(yùn)動系統(tǒng)設(shè)計范文，希望能給你帶來靈感和參考，敬請閱讀。

摘要:為實現(xiàn)Stewart平臺的高精度運(yùn)動控制，設(shè)計了基于運(yùn)動學(xué)模型的運(yùn)動控制系統(tǒng)。在工作空間中使用梯形速度曲線進(jìn)行軌跡規(guī)劃，通過位置反解得到關(guān)節(jié)空間中各支腿的規(guī)劃軌跡，設(shè)計位置—速度雙環(huán)控制器控制支腿跟蹤各自軌跡。為抑制外部擾動，提高魯棒性，使用基于模型輔助線性擴(kuò)張狀態(tài)觀測器的自抗擾控制器作為速度環(huán)控制器。為在保證軌跡跟蹤精度的同時，加快系統(tǒng)鎮(zhèn)定速度，使用分段積分重置PI控制器作為位置環(huán)控制器。將所設(shè)計的控制器應(yīng)用到實際控制系統(tǒng)中，并進(jìn)行了運(yùn)動控制實驗。實驗表明:在所設(shè)計控制系統(tǒng)的控制下，平臺運(yùn)行平穩(wěn)，并能夠較快穩(wěn)定到目標(biāo)位姿。

關(guān)鍵詞:Stewart平臺;自抗擾控制;模型輔助線性擴(kuò)張狀態(tài)觀測器;積分重置

0引言

大型望遠(yuǎn)鏡光路系統(tǒng)通常包括主鏡、次鏡，為了保證良好的成像質(zhì)量，需要主鏡與次鏡的反射面焦點重合，光軸重合。然而由于重力、振動等原因，主鏡和次鏡之間的位姿往往會發(fā)生改變，從而導(dǎo)致望遠(yuǎn)鏡成像質(zhì)量受到影響，因此需要對主次鏡之間的位姿進(jìn)行精確的調(diào)整和校正。由于主鏡的尺寸、質(zhì)量遠(yuǎn)大于次鏡，若對主鏡進(jìn)行調(diào)整，其功耗較大，實際工程中往往采用次鏡調(diào)整機(jī)構(gòu)來調(diào)整主次鏡之間的相對位姿［1］。

而Stewart平臺因其高精度、高剛度的優(yōu)點，在大型望遠(yuǎn)鏡中作為次鏡調(diào)整機(jī)構(gòu)被廣泛使用［2］。本文所研究的Stewart平臺控制系統(tǒng)，作為次鏡調(diào)整機(jī)構(gòu)，控制任務(wù)為控制動平臺從當(dāng)前位姿點運(yùn)動到目標(biāo)位姿點，要求運(yùn)動過程平穩(wěn)且不超過工作空間，并且能夠快速無差的穩(wěn)定到目標(biāo)位姿。

1Stewart平臺運(yùn)動學(xué)模型及其反解

1．1Stewart平臺運(yùn)動學(xué)模型

本文Stewart平臺為6—UCU構(gòu)型，由上平臺、下平臺及6條支腿構(gòu)成，其中上平臺為動平臺，下平臺為靜平臺。上下平臺與6條支腿之間通過虎克鉸相連，支腿運(yùn)動機(jī)構(gòu)可簡化為移動—轉(zhuǎn)動副，通過控制6條支腿的長度變化，可控制上平臺的3個方向的平移和3個方向的旋轉(zhuǎn)。

1．2Stewart平臺位置反解

已知上平臺和下平臺之間的位姿關(guān)系，求解對應(yīng)的各支腿長度，被稱為Stewart平臺的位置反解(此處位置的含義為廣義位置)。位置反解是對Stewart平臺進(jìn)行運(yùn)動控制的基礎(chǔ)［3］。

2工作空間軌跡規(guī)劃

由于并聯(lián)平臺特殊的閉環(huán)運(yùn)動鏈構(gòu)型，其工作空間有限［4］，若讓各支腿直接運(yùn)動到運(yùn)動學(xué)反解計算出的目標(biāo)位置處，在運(yùn)動的過程中動平臺可能會超出工作空間，因而必須對并聯(lián)平臺進(jìn)行軌跡規(guī)劃?？紤]動平臺從位姿點u1到位姿點u2的軌跡規(guī)劃，由于所設(shè)計控制系統(tǒng)只需實現(xiàn)點位控制，對軌跡形狀不做要求，為求簡便，取軌跡為6維空間內(nèi)的一條線段。同時為使運(yùn)動更加平穩(wěn)，使用梯形速度曲線對平臺運(yùn)動速度進(jìn)行規(guī)劃按平臺能否加速到最大速度分為兩種情況，

1)能夠加速到最大速度時，速度和加速度曲線，0～t1段為加速段，以amax做均加速運(yùn)動;t1～t2段為勻速段，以vmax做勻速運(yùn)動;t2～t3段為減速段，以－amax做勻減速運(yùn)動。

2)不能加速到最大速度時，速度和加速度曲線，，0－t4段為加速段，以amax做均加速運(yùn)動。

3關(guān)節(jié)空間建模與辨識

在對實際系統(tǒng)缺乏了解時，直接進(jìn)行控制器設(shè)計往往存在風(fēng)險和不便。因此，在控制器設(shè)計之前，首先通過辨識的手段，得到關(guān)節(jié)空間的信息，即支腿的模型信息。關(guān)節(jié)空間的控制任務(wù)為控制支腿跟蹤由工作空間規(guī)劃軌跡反解得到的位置曲線，由于支腿位置可看作是運(yùn)動速度的積分，本節(jié)將對支腿的速度—電壓關(guān)系進(jìn)行建模和辨識。關(guān)節(jié)空間中，由直流電機(jī)驅(qū)動滾珠絲桿帶動支腿上部運(yùn)動，使支腿長度發(fā)生改變。不考慮負(fù)載力的影響，可將支腿的速度—電壓開環(huán)傳遞。

為得到式中參數(shù)的具體數(shù)值，使用頻率響應(yīng)法對支腿進(jìn)行辨識，其思想為測量系統(tǒng)在不同頻率正弦信號輸入的輸出響應(yīng)，以求得系統(tǒng)模型的待定參數(shù)［5］。對每個測試頻率，運(yùn)行6s，并記錄其中2～4s的速度值，進(jìn)行多次實驗，將相同時間點處的速度值取平均值，求得各頻率點幅值放大倍數(shù)和相移角度。

4關(guān)節(jié)空間控制器設(shè)計

在高精度位置控制器設(shè)計中，往往采用位置—速度雙環(huán)控制方案。其中，速度內(nèi)環(huán)控制的主要目的是抑制外部擾動，增強(qiáng)魯棒性。通常希望通過內(nèi)環(huán)控制器的校正作用，使得校正后的內(nèi)環(huán)特性盡可能的接近名義模型，這樣在外環(huán)控制器設(shè)計時，即可將名義模型視為實際的控制對象［6］。

已通過辨識實驗得到關(guān)節(jié)空間的速度—電壓模型，但由于未建模部分和外部擾動的影響，其和真實系統(tǒng)之間必然存在差距。選取狀態(tài)變量:x1=y，x2=y，x3=f＇，則x=［yyf＇］T為包含了總擾動的擴(kuò)張狀態(tài)向量，將式(8)轉(zhuǎn)換為擴(kuò)張狀態(tài)空間方程描述式中err為位置環(huán)參考信號r＇與當(dāng)前位置y＇之差，errI為位置誤差的積分。為加快鎮(zhèn)定速度，在最后穩(wěn)定階段引入積分重置策略，即當(dāng)檢測到當(dāng)前位置超過目標(biāo)位置時，直接將errI重置為0，從而減小支腿運(yùn)動超調(diào)的距離。

5實際控制系統(tǒng)與實驗

Stewart平臺控制系統(tǒng)的總體框架如圖4所示。實際控制系統(tǒng)由上位機(jī)、下位機(jī)、Stewart平臺組成。采用FPGA+DSP異構(gòu)方案，F(xiàn)PGA和DSP通過外部存儲器接口通信，實現(xiàn)傳感器信息(增量式編碼器、限位開關(guān))的讀取和控制信號(PWM信號)的產(chǎn)生［8，9］。接口板實現(xiàn)差分轉(zhuǎn)單端、電平變換、光耦隔離等功能。驅(qū)動板由6對PWM信號控制，驅(qū)動平臺按照給定軌跡運(yùn)動。

為驗證所設(shè)計控制系統(tǒng)性能，進(jìn)行Stewart平臺運(yùn)動控制實驗。平臺具體尺寸為r=90mm，R=148mm，θ=110．0786°，φ=15．7965°?？刂浦芷跒?ms，限制平臺位姿的位置分量的最大速度和最大加速度幅值為1mm/s和1mm/s2，姿態(tài)分量的最大速度和最大加速度幅值為1°/s和1°/s2?？刂芐tewart平臺從中位點［00244．8273000］T運(yùn)動到［4－1247．82733－1－1］T處，記錄0～20s各時刻的支腿長度，并利用高斯—牛頓法求得對應(yīng)的動平臺位姿。動平臺按照所規(guī)劃的軌跡運(yùn)動，運(yùn)行平穩(wěn)，且在開始運(yùn)動和停止運(yùn)動時均有妥善的過渡過程。其在0～5s的軌跡跟蹤階段，平臺位置跟蹤誤差在0．01mm以下，姿態(tài)角跟蹤誤差在0．005°以下，并且在5．8s左右，動平臺位姿鎮(zhèn)定。最終平臺穩(wěn)定在［3．99989－0．99990247．827172．99992－1．00001－1．00002］T，偏差與位置傳感器量化誤差在一量級，因而可以將其忽略，認(rèn)為平臺已經(jīng)穩(wěn)定在給定位姿上。

6結(jié)論

實驗結(jié)果表明:在本文所設(shè)計的控制系統(tǒng)控制下，高精度Stewart平臺運(yùn)行平穩(wěn)，具有良好的跟蹤精度，并且最終能夠較快的穩(wěn)定到目標(biāo)位姿，取得了理想的控制效果。

參考文獻(xiàn):

［1］于陽．大型空間望遠(yuǎn)鏡次鏡精密調(diào)整機(jī)構(gòu)研究［D］．長春:中國科學(xué)院研究生院(長春光學(xué)精密機(jī)械與物理研究所)，2016．

［2］梅萊．并聯(lián)機(jī)器人［M］．北京:機(jī)械工業(yè)出版社，2014．

［3］黃真．并聯(lián)機(jī)器人機(jī)構(gòu)學(xué)理論及控制［M］．北京:機(jī)械工業(yè)出版社，1997．

［4］李云峰，楊兆宜，李長峰．精密并聯(lián)機(jī)器人運(yùn)動軌跡規(guī)劃的研究［J］．機(jī)床與液壓，2009，37(10):67－71．

［5］周儒勛，張澤龍，亓迎川．直流電機(jī)模型參數(shù)的直接辨識［J］．計算機(jī)仿真，2006，23(6):31－33．

［6］劉強(qiáng)．高性能機(jī)械伺服系統(tǒng)運(yùn)動控制技術(shù)綜述［J］．電機(jī)與控制學(xué)報，2008，12(5):603－609．

［7］葉東，周志煒，張飚，等．基于FPGA的多路光電編碼器數(shù)據(jù)采集系統(tǒng)［J］．傳感器與微系統(tǒng)，2006，25(5):45－47．

［8］張鋒，彭正輝，任強(qiáng)，等．基于FPGA平臺的光電編碼器在探地雷達(dá)中的應(yīng)用［J］．傳感器與微系統(tǒng)，2015，34(8):149－151．

作者：武錫銅 周烽 王永 單位：中國科學(xué)技術(shù)大學(xué) 信息科學(xué)技術(shù)學(xué)院