摘要:針對末端效應器是一個(gè)典型的非線(xiàn)性系統,且在微重力、環(huán)境溫度變化劇烈的太空中,機械機構的參數隨著(zhù)負載狀態(tài)和環(huán)境變化而變化,很難得到一個(gè)準確的動(dòng)力學(xué)模型。因此文中研究的主要內容是在空間環(huán)境中,如何實(shí)現末端效應器穩定可靠的控制,完成捕獲、拉緊及鎖合任務(wù)。 本文設計了高可靠性的獨立控制系統,并且從軟硬件的角度采提高系統的可靠性;在高可靠性獨立控制系統的基礎上,通過(guò)采用合理的容錯控制策略來(lái)提高末端效應器的可靠性和延長(cháng)使用壽命。 隨著(zhù)我國的空間站建設已經(jīng)提上日程,空間站建設是一個(gè)復雜的大系統工程,在建設過(guò)程中要求有搬運能力強的空間大機械臂,實(shí)現目標飛行器和機械臂之間的數據傳輸,并能夠提供航天員出艙活動(dòng)的平臺。針對上述要求末端效應器無(wú)疑是最合適的方案。 鎖合末端效應器(簡(jiǎn)稱(chēng)末端效應器)是大型空間站機械臂的一部分,包括捕獲機構、拉緊機構和鎖合機構,主要完成對目標飛行器的捕獲、抓取及釋放等任務(wù)。末端效應器具有結構簡(jiǎn)單、兼容性好、在軌壽命長(cháng)、可靠性高和相互性好等優(yōu)點(diǎn)。 為了實(shí)現高可靠性末端效應器控制系統,提出并設計了高可靠性獨立控制系統,并且通過(guò)從軟硬件的角度提高系統的可靠性;在高可靠性獨立控制系統的基礎上,設計了合理的容錯控制策略。該系統能夠完成對其準確測試。 1 高可靠性獨立控制系統 末端效應器機械機構的運動(dòng)可以看作是一個(gè)點(diǎn)到點(diǎn)的運動(dòng),首先需要考慮在兩個(gè)位置之間的運動(dòng)軌跡,也就是運動(dòng)規劃問(wèn)題,然后根據規劃的運動(dòng)要求進(jìn)行執行器的控制,因此末端效應器的運動(dòng)控制系統包括任務(wù)的運動(dòng)規劃和驅動(dòng)機構的執行級控制。 1.1 運動(dòng)規劃 對于末端效應器的運動(dòng)控制規劃較為簡(jiǎn)單而且固定。為保證長(cháng)期穩定可靠的工作,需要減少摩擦損耗,因此要保證運動(dòng)應盡可能的平滑,也就是要求加速度要小并且變化平緩,速度變化也要平緩。在該要求下,最終的速度軌跡可以采用梯形、正弦形等形式,通過(guò)采樣得到一組合適的軌跡點(diǎn)輸入到控制輸入端即可。一般情況下,速度控制的主要功能是通過(guò)有目的地限制加速度來(lái)減少軌跡誤差。為避免驅動(dòng)軸產(chǎn)生沖擊、失步、超程和振蕩,保證運動(dòng)部件的平穩和準確定位,在啟停階段或各程序轉接時(shí),要進(jìn)行加減速控制,以使進(jìn)給速度平滑過(guò)渡。 目前運動(dòng)控制系統中常用的加減速規律包括很多,常見(jiàn)的加減速控制算法有直線(xiàn)、三角函數、指數、拋物線(xiàn)、S曲線(xiàn)加減速等算法。在本系統中采用了三角函數加減速規律,如圖1所示。由于三角函數的計算復雜,不能滿(mǎn)足數控系統實(shí)時(shí)性要求?梢允孪葘ζ溥M(jìn)行處理,將其做成查找表的形式存放于內存中。 由于三角函數加減速規律可以實(shí)現平滑運動(dòng),采用這種運動(dòng)軌跡,使得控制更加容易,并且潛在里也會(huì )提高系統的控制精度,延長(cháng)系統壽命。三角函數的最大加速度、速度等參數要結合電機的參數和負載情況進(jìn)行選擇。 1.2 驅動(dòng)機構的執行級控制設計 在確定了控制系統期望輸入以后,關(guān)鍵是驅動(dòng)機構的執行級控制問(wèn)題,也就是無(wú)刷直流電機的控制問(wèn)題。由于無(wú)刷直流電動(dòng)機通過(guò)利用電子換向器取代了機械電刷和機械換向器,保留了直流電動(dòng)機的優(yōu)點(diǎn),同時(shí)又具有交流電動(dòng)機的結構簡(jiǎn)單、運行可靠、維護方便等優(yōu)點(diǎn),并且特別適合空間環(huán)境,因此我們這里主要考慮執行單元無(wú)刷直流電動(dòng)機的控制問(wèn)題。 由于運動(dòng)主要依靠機械機構傳動(dòng),因此末端效應器控制系統性能要求主要考慮抵達位置的高精度。高精度主要指的是控制系統的穩態(tài)特性,也就是說(shuō)要求系統的穩態(tài)誤差要小,而對動(dòng)態(tài)特性要求不高。 1.2.1 控制方案 由直流電機運動(dòng)方程可知,在忽略摩擦阻尼的情況下,加速度與電動(dòng)機的轉矩成正比,而且轉矩又與電機的電流成正比,因此,要實(shí)現電機的高精度高動(dòng)態(tài)性能控制,就需要同時(shí)對電機的速度、電流及位置進(jìn)行檢測和控制。因此,本控制系統通過(guò)三閉環(huán)結構實(shí)現電機的運動(dòng)控制,如圖2所示。 當電機處于運行狀態(tài)時(shí),給定的位置信號Ua與反饋位置信號Ub的偏差經(jīng)過(guò)(位置環(huán))PID調節得到速度的參考值Vg;控制器根據測出的反饋位置信息計算出當前轉速,Vg與當前轉速的偏差進(jìn)行PI調節(速度環(huán))得到電流的給定電壓參考值Uig;電機繞組電流反饋信號經(jīng)過(guò)電流傳感器的檢測得到當前主回路的電流反饋電壓值Uif,將Uif與Uig進(jìn)行PI計算,得到的電流調節器的輸出去調節占空比,進(jìn)而控制功率開(kāi)關(guān)管的導通與關(guān)斷,從而實(shí)現對無(wú)刷直流電動(dòng)機位置、轉速、電流或轉矩的控制。 在三閉環(huán)控制系統中,電流環(huán)和速度環(huán)均為內環(huán),位置環(huán)為外環(huán)。電流環(huán)的作用是提高系統的快速性,抑制電流環(huán)內部干擾,限制最大電流保障系統安全運行,電流環(huán)采用PI調節器。速度環(huán)的作用是增加系統抗負載擾動(dòng)的能力,抑制速度波動(dòng),速度環(huán)采用PI調節器。位置環(huán)的作用是保證系統靜態(tài)精度和動(dòng)態(tài)跟蹤的性能,位置環(huán)采用PID控制。 因為末端效應器的控制主要考慮位置精度,而對動(dòng)態(tài)特性要求不高,因此本系統中采用了包含位置環(huán)在內的三閉環(huán)的控制方式。 1.2.2 中心控制器硬件實(shí)現方案 本系統的中心控制器采用的是DSP TMS320F2812芯片,此芯片內集成了A/D、PWM控制器、CAN控制器等功能模塊,使得電機的控制相對簡(jiǎn)單。另外,采用高性能DSP為控制核心的電機系統具有性能優(yōu)越、高可靠性、快速響應、體積小、重量輕等特點(diǎn)。在系統中設置了速度調節器和電流調節器,分別調節電機的轉速和電流,兩者之間實(shí)行串級連接,把速度調節器的輸出當作電流調節器的輸入,再用電流調節器的輸出去控制PWM裝置。如圖3即為基于DSP芯片TMS320F2812的實(shí)現框圖。 1.2.3 控制系統硬件各個(gè)模塊的實(shí)現方案 1)PWM控制電路實(shí)現 本系統的電機調速主要考慮采用PWM(脈寬調制)調速。調壓調速是無(wú)刷直流電機目前最常用的一種調速方式,主要是通過(guò)改變加在電機電樞繞組兩端的電壓來(lái)改變電機的轉速,這種方法通常將電機的電壓由額定電壓向下調節電樞電壓,達到使電機轉速由額定轉速變?yōu)橄蛳抡{速,這種調速方法調節的過(guò)程中損耗的能量小,且轉速過(guò)程中系統波動(dòng)比較小,靜態(tài)的穩定性較高,響應速度快。是當前無(wú)刷直流電機應用最常見(jiàn)的、運行最穩定、最有效的調速方式,它通常有PWM調節方式、旋轉變流機構調節方式以及靜止變流機構調節方式。目前無(wú)刷直流電機無(wú)級調速系統也大多都采用調壓調速中的PWM調節方式。 PWM調節方式是一種根據能量轉換等效原理,是由將固定不變的系統電壓斬截成占空比可變的PWM波,經(jīng)過(guò)改變占空比來(lái)實(shí)現電機電樞兩端平均電壓的電壓調節方式,這種調節方式的特點(diǎn)具有體積小、凋速性能好、成本低、控制方便等優(yōu)點(diǎn),與此同時(shí),它也比較容易與控制器之間構成閉環(huán)控制系統,控制方法也顯得靈活多變。因此,我們采用PWM調壓調節方式。在本系統中PWM脈沖波的產(chǎn)生是直接通過(guò)DSP的PWM口得到。 2)驅動(dòng)電路設計 對于末端效應器系統,驅動(dòng)電路部分采用專(zhuān)門(mén)的集成的驅動(dòng)模塊結合MOSFET實(shí)現。為了避免和DSP之間產(chǎn)生干擾,增強可靠性,采用光電隔離模塊和集成驅動(dòng)模塊共同構成驅動(dòng)電路來(lái)驅動(dòng)功率MOSFET管。如圖4所示,由光電隔離模塊和IR2112模塊組成的驅動(dòng)A相橋臂的連接方式。光耦部分起到隔離和電平轉換的作用。驅動(dòng)三相全橋電路需要6路PWM信號,而IR2112只能同時(shí)輸出2路PWM信號,所以驅動(dòng)電路共需要3片IR2112芯片。 3)電流檢測和速度檢測電路 電流檢測電路就是將電機的三相電流進(jìn)行數模轉換器采集,然后反饋到主控制器,與控制芯片內的速度控制器產(chǎn)生的電信號做比較,完成對電機的電流閉環(huán)控制。本控制系統中實(shí)際的電流比較小,功率也比較小,因此采用了一個(gè)旁路電阻來(lái)檢測實(shí)際電機的相電流的大小,電阻位于三相功率變換全控的電路的橋臂和地線(xiàn)之間。 速度檢測電路是控制系統中最重要的環(huán)節。速度檢測電路檢測電機的實(shí)際轉速并且將檢測的實(shí)際速度信號轉化為電信號直接傳送到控制芯片的引腳,然后在主控制器內完成對轉速的計算并且和電機的預定轉速作比較完成回路系統。 本系統利用控制器的計算處理能力,采用霍爾位置傳感器的信號來(lái)計算無(wú)刷直流電機的轉速。 2 末端效應器控制器可靠性及長(cháng)壽命設計 在第一章節中末端效應器的詳細設計中控制器的設計包括任務(wù)級執行級控制方案、具體軟硬件實(shí)現中元器件選擇及實(shí)現方案等都是以高可靠性為中心進(jìn)行分析和設計的。下面主要從軟硬件的角度考慮故障的處理方法,還有容錯控制策略的設計。 2.1 軟硬件可靠性保證 2.1.1 硬件可靠性保證 解決可靠性問(wèn)題最主要的方法是執行器故障診斷和處理。常見(jiàn)電機故障有: 1)電機過(guò)載、過(guò)流。由于系統的電流比較小,故可以采用主回路串聯(lián)采樣電阻的方法進(jìn)行過(guò)流檢測。定子電流經(jīng)過(guò)電阻之后轉變成電壓信號,在此串入小電阻,小電阻兩端的電壓經(jīng)過(guò)放大隔離后送入A/D單元,通過(guò)主控制器的軟件編程或邏輯實(shí)現對電機的過(guò)載保護。 2)電機過(guò)速。 3)驅動(dòng)器非正常復位。本系統采用了硬件冗余,設計了急停電路,使系統停止運行。 另外光電編碼器等傳感部件也可能發(fā)生故障。在系統運行時(shí)可能出現的故障有: 1)數據傳輸錯誤。診斷辦法是采用奇偶校驗法判別,然后用線(xiàn)性外推法給出當前傳感器數據; 2)數據采集錯誤。這種故障可能造成控制力矩的波動(dòng),診斷采用野點(diǎn)剔除的辦法加以剔除,然后用線(xiàn)性外推法給出當前傳感器數據。 2.1.2 軟件可靠性保證 1)系統啟動(dòng)自檢。在啟動(dòng)系統時(shí),必須檢測元器件是否正常工作。 2)系統故障報警和處理。當有故障發(fā)生時(shí),軟件能檢測出該故障,并診斷其故障類(lèi)型,從而做出必要的處理。 3)事故急停處理。當一旦有事故發(fā)生時(shí),系統應該立即關(guān)閉,力求將事故對系統的破壞降低到最低程度。 2.2 高可靠性獨立控制系統的合理容錯控制策略設計 空間站遠程遙操作機械臂SSRMS(Space Station Remote Manipulator System)、歐洲遙操作機械臂ERA(European Robotic Arm)、日本實(shí)驗艙遙操作機械臂JEMRMS(Japanese Experimental Module Remote Manipulator System)在設計和運行過(guò)程中都要求機械臂系統至少能夠容忍兩次故障的發(fā)生。這對末端效應器控制系統也提出了一個(gè)新的要求?刂葡到y的容錯設計及故障檢測與診斷是提高航天器的可靠性的有效途徑。 末端效應器控制系統除了提高單一控制系統的高可靠性之外,考慮采用控制系統的容錯也是提高可靠性的一個(gè)合理的選擇。同時(shí)對于一個(gè)精密的運動(dòng)控制系統來(lái)說(shuō),系統的容錯性是調試和運行時(shí)需要考慮的功能完整性問(wèn)題。對于控制系統的容錯設計主要考慮以下兩方面的要素: 1)需要結合具體的任務(wù),選擇合適的傳感器、執行器和控制器備份策略: 2)需要考慮與之相配合的故障診斷和診斷方法。 對于傳感器、執行器和控制器備份方案,本系統了采用類(lèi)似于ERA的關(guān)節控制系統,即采用雙繞組永磁同步電機構建相互獨立的2套驅動(dòng)子系統,但是由于2套驅動(dòng)系統工作在冷備份模式,容錯能力不高,且沒(méi)有充分利用冗余備份的傳感器資源,所以為了提高容錯能力,本系統選擇了雙繞組余度電機工作在熱備份模式。 由于末端效應器機械機構具有模型非線(xiàn)性、摩擦非線(xiàn)性和負載變動(dòng)的自適應等因素,本系統的故障檢測和故障診斷主要是基于傳感器冗余信息的故障檢測方法,主要通過(guò)位置傳感器、力傳感器的信號來(lái)推斷系統的狀態(tài),進(jìn)而進(jìn)行故障檢測。位置信息的配置主要包括電機數字霍爾傳感器、電機旋轉變壓器等多級容錯備份和故障檢測。力傳感器的故障通過(guò)計算電機位置信息和參考力進(jìn)行比較來(lái)判斷。 結合實(shí)際情況,本控制系統的電機驅動(dòng)控制部分容錯設計主要采用了雙繞組余度電機工作在熱備份模式。相應的故障檢測方法為基于傳感器冗余信息的故障檢測方法。具體的冗余切換邏輯結構如圖5所示。 3 結論 末端效應器機械機構在空間環(huán)境中穩定可靠性的工作,作為其核心的電機控制系統的長(cháng)期穩定可靠的工作就顯得尤為重要。因此文中首先考慮完成任務(wù)的運動(dòng)規劃問(wèn)題,然后考慮了控制系統方式及其軟硬件實(shí)現的具體要求。來(lái)實(shí)現高可靠性獨立控制系統的設計。并且在高可靠性獨立控制系統的基礎上,還設計了合理的容錯控制策略。此系統經(jīng)過(guò)實(shí)驗,達到了設計要求。 |