基于國產FPGA的天線指向機構伺服控制器的設計

胡雪剛，王濤，張軍，張得禮，王宏濤

(1. 南京航空航天大學 機電學院，江蘇 南京 210016; 2. 上海宇航系統工程研究所, 上海 201108)

0 引言

天線指向機構的指向精度是評判天線能否進行高精度掃描與指向的重要性能指標[1]，而天線指向機構的精度又取決于其伺服系統的控制精度，因此提高伺服控制器的精度對于天線高精度掃描和指向非常重要。

目前伺服控制器多采用DSP、MCU作為主控芯片，但是由于天線指向機構的伺服控制器在工作過程中會面臨空間環境未知粒子輻射和高低溫環境等考驗，而DSP和MCU對單粒子輻射比較敏感，難以滿足空間應用可靠性需求[2]。因此空間天線指向機構伺服控制器采用FPGA作為主控芯片已成趨勢。中國空間技術研究院的劉鵬、董超等人設計了一種基于FPGA和單片機的星載定位指向控制器，以ACTEL的反熔絲FPGA作為主控芯片來驅動控制步進電機，單片機作為輔助芯片來實現控制器與UART的串口通信[3]。上海宇航系統工程研究所的侯超、鄭悅等人采用單片的ACTEL公司的反熔絲FPGA作為中繼天線驅動控制主控芯片[4]。但是這些都是以國外的FPGA作為主控芯片，近年來國際形勢的變化加大了核心器件國產化的需求，只有掌握核心科技才能不受制于人。所以，設計并驗證以國產FPGA為主控芯片的天線指向伺服控制器可以加快核心器件國產化的步伐。

本文設計了以國產FPGA為主控芯片的天線指向機構伺服控制器，采用步進電機作為驅動電機，以雙通道旋轉變壓器作為位置傳感器采集位置信息。本文提出了一種“細分控制+插值PID”的步進電機控制算法來提高天線指向機構的指向精度，以保證天線指向機構指向時的平滑。對設計的伺服控制器進行指向試驗，驗證伺服控制器的指向精度，然后進行熱循環試驗和EMC(電磁兼容性)試驗，驗證該伺服控制器在空間環境中的可靠性。

1 系統總體架構

天線指向機構伺服控制系統解析上位機發送的工作命令和參數等，按照命令中的工作模式和位置給定要求，通過控制驅動步進電機來控制天線指向機構，并獲取指向機構的位置、電流信息及其工作狀態，反饋至上位機。

天線指向機構伺服控制系統主要包括FPGA與上位機通信模塊、PROM與FPGA的配置模塊、數模轉換模塊、電平轉換模塊、電機驅動模塊以及步距角為0.9°的兩相混合式步進電機等。由于旋轉變壓器承受高、低溫，抗沖擊和振動的能力要遠遠大于光電編碼器[5]，為了提高測量的精度，采用極對數為1∶16的雙通道，粗、精速比為1∶16的多極旋轉變壓器，采集電機的位置信息[6]。其系統框圖如圖1所示。

圖1 系統架構示意圖

其工作過程如下：

1)上位機通過RS422向FPGA發送工作模式、位置給定等命令參數，FPGA通過RS422向上位機發送需要遙測的數據，例如位置、電流信息及工作狀態等；

2)FPGA根據AD128S102的時序控制AD128S102的信號，獲取AD轉換后的電流值；

3)FPGA根據AD2S80的時序控制AD2S80的信號，獲取雙通道旋轉變壓器AD轉換后的值，并根據其耦合修正算法對采集到的數據進行正確組合[7]；

4)FPGA根據采集到的位置信息，通過基于插值的PID算法實現位置閉環控制，并且依據步進電機控制原理進行控制，生成相應的控制信號，通過電平轉換輸出至MOSFET驅動芯片(IR2110)。

2 伺服控制算法

步進電機驅動器每接收到一個脈沖信號，步進電機就會轉一個固定的步距角。由于步進電機自身特性的影響，步進電機的性能達不到實際的控制要求，故本文采取步進電機細分控制以提高步進電機的分辨率[8]。但是由于步進電機存在丟步的現象，導致指向機構的指向精度達不到要求。因此本文提出了一種基于插值PID的閉環控制算法來避免電機因丟步而造成的指向誤差[9]。算法流程圖如圖2所示。

圖2 伺服控制算法結構圖

其控制策略為：首先對接收到上位機發送的給定位置進行插值計算，然后以插值計算得到的結果作為位置閉環PID每個控制周期的位置給定，進行PID位置閉環控制，得到位置閉環PID的結果；以位置閉環PID的計算結果為速度給定，進行步進電機的細分控制，并采用SPWM技術控制輸出給驅動芯片的PWM信號。

2.1 插值PID位置控制算法

天線指向機構接收上位機每2s發送的位置給定指令，PID位置閉環無法保證電機剛好在規定的時刻達到目標位置，會導致在指向過程中會出現走走停停的現象。如何保證指向機構的指向精度和平滑指向是位置閉環控制的關鍵和重點。因此本文提出了一種基于插值的PID的控制算法。

首先對上位機每隔一定時間發送的給定位置進行插值處理，計算得到每個控制周期的給定位置，從而保證電機在指向時能夠平穩光滑地運動。插值算式如下：

(1)

式中：ref(t)表示插值后計算得到的第t個控制周期的給定位置；r(k)表示上位機第k次給定的位置值；N是一個常數，表示每2s插值的次數。

得到每個控制周期的位置給定后進行位置閉環控制。在該系統中，步進電機的位置閉環為典型的絕對式的PID閉環控制算法，其離散算式如式(2)所示。

(2)

其中

e(t)=ref(t)-fb(t)

(3)

式中：fb(t)表示第t個控制周期旋轉變壓器反饋的位置值；e(t)表示第t個控制周期給定位置與反饋位置的誤差值；u(t)表示位置閉環PID第t個控制周期的輸出值，也就是速度給定；Kp、Ki、Kd分別表示比例系數、積分系數和微分系數。在得到位置閉環PID輸出結果值后，進行步進電機的細分驅動控制。

2.2 步進電機細分控制算法

由于所使用步進電機的特性，步進電機驅動器每接收到一個脈沖信號，步進電機就轉動一個固定的步距角0.9°，即此步進電機的分辨率為0.9°。但是控制精度要求為0.1°，這使得指向機構的控制精度達不到要求。可通過步進電機細分驅動控制提高電機的分辨率，細分驅動控制步進電機各相電流以階梯狀變化，通過減小各相電流的突變來減小電磁力矩的突變，減小合成磁勢的角度，從而達到細分的目的[10-12]。 為了使步進電機細分后的每一步轉動的角度保持一致，必須保證電流合成矢量的大小和旋轉角度保持不變，使用電流矢量恒幅均勻旋轉法，給A、B兩相通入相位差為π/2的正弦電流。步進電機細分控制算法框圖如圖3所示。

圖3 細分控制算法結構圖

正弦表中按照地址存放著正弦值，根據位置閉環PID輸出的結果u(t)進行正弦表地址計算，讀出該地址存放的數據，輸出至比較器的輸入端，三角波計數器生成的三角波數據輸出至比較器的另一端。將這兩端的數據經過比較器比較，得到SPWM脈沖信號。正弦表地址計算算式如下所示：

(4)

(5)

addr=∑p

(6)

式中：m表示電機每轉動一圈所需要的脈沖數；step表示細分數；α表示步進電機的步距角；p表示每個控制周期所需要的脈沖數；f表示控制頻率；addr表示計算得到的正弦表地址。首先計算出電機每轉動一周所需要的脈沖數，然后通過單位轉換計算得到每個控制周期所需要的脈沖數，并將每個控制周期所需要的脈沖數累加就得到當前控制周期的正弦表地址。得到正弦表地址后讀取正弦表數值，將正弦表數值與三角波計數器進行比較，產生對應的PWM信號。

2.3 控制算法仿真

運用Simulink對設計的控制算法進行建模仿真，并與不采取插值只采取PID的控制算法進行仿真對比。仿真結果如圖4-圖5所示。

圖4 兩相調制波仿真結果圖

圖5 系統算法仿真結果圖

圖4是A、B相SPWM調制的數值為相位差為π/2的正弦波，滿足其控制要求。圖5是系統最終仿真結果，結果顯示基于插值PID的控制算法相較于傳統的PID控制算法的電機速度平滑，并且指向精度也相對提高。

3 試驗驗證

3.1 指向精度試驗驗證

采用專用測試臺對伺服控制器進行指向測試試驗。上位機在發送跟蹤指令前先給控制器下發預置指令，使電機轉動至指向指令的初始位置。到達初始位置后開始進行指向跟蹤(測試臺每隔2s發送指向位置)。本試驗發送的指向位置是周期為2 000s、幅值為180°的正弦曲線。最終測試結果如圖6所示。試驗結果表明該系統指向跟蹤精度高，達到了0.09°的指向精度，并且滿足電機平穩跟蹤的要求。

圖6 電機指向試驗結果圖

3.2 可靠性試驗驗證

為了驗證這個基于國產FPGA的伺服控制器在空間環境中的可靠性，進行了熱循環試驗和EMC試驗。

熱循環試驗條件按照Q/RJ356-2013《衛星型譜單機試驗通用要求》在高低溫交變試驗箱中展開，如圖7所示。試驗初始溫度為22.3℃，初始相對濕度為44%RH。試驗的溫度范圍為-35℃～70℃，并且第一次和最后一次的高溫端和低溫端的持續時間至少為6h，中間循環的高溫端和低溫端的持續時間至少為2h，溫變速率為3～5℃/min。

圖7 熱循環試驗箱內狀態圖

EMC試驗條件按照Q/RJ356—2013《衛星型譜單機試驗通用要求》在EMC實驗室開展。試驗布置如圖8所示。

圖8 EMC試驗布置圖

將待測的伺服控制器放入EMC實驗室中，電源通過LISN(線路阻抗穩定網絡)給被測的伺服控制器供電，被測伺服控制器通過電纜與地測相連來觀察試驗時伺服控制器的主要功能參數。由于此伺服控制器主要采用二次電源供電，其核心電源為5V，因此對其展開了CE102(10kHz～10MHz電源線傳導發射)檢測項目，測試結果如圖9測試結果顯示，在260kHz～4.16MHz頻段有超標。該超標主要是由于該頻段與電機驅動頻率和產品內部晶振頻率的倍頻重合造成，屬于機構驅動控制類電子產品固有特性，不影響其性能。

圖9 5V正端CE102檢測圖

在進行伺服控制器熱循環試驗和EMC試驗時，對該產品的主要功能進行測試。其試驗的測試值如表1所示。

表1 伺服控制器試驗前后主要指標測試表

測試結果顯示：在進行熱循環試驗和EMC試驗時，伺服控制器的功能參數基本沒有發生變化，伺服控制器滿足空間環境的可靠性要求。

4 結語

本文針對天線指向機構，采用國產FPGA作為指向機構伺服控制器的主控芯片，基于插值的PID算法設計并實現了單片FPGA架構的天線指向機構伺服控制器，并對此伺服控制器進行了熱循環試驗驗證和EMC試驗驗證。結果表明，此基于插值PID算法、細分的SPWM技術的伺服控制器能夠精確地實現指向，并且在進行熱循環和EMC試驗時，伺服控制器的各項指標和功能均符合要求。因此，該伺服控制器滿足天線指向機構的指向精度要求和空間環境的可靠性要求。