莊文許,馬大為,翟小晶,孫 德
(南京理工大學(xué),江蘇南京210094)
防空火箭炮、雷達(dá)、天線和機(jī)床等伺服系統(tǒng)中,角度檢測精度對伺服系統(tǒng)的控制性能起到?jīng)Q定性作用,常用的角度傳感器有旋轉(zhuǎn)變壓器、自整角機(jī)、光電碼盤和光柵等。其中,旋轉(zhuǎn)變壓器以其線性度好、性能穩(wěn)定、環(huán)境適應(yīng)性強(qiáng)以及能提供絕對角度位置信息等特點(diǎn),得到了廣泛的應(yīng)用。本文以TMS320F2812和EMP7128為主控電路,設(shè)計了基于AD2S83的旋轉(zhuǎn)變壓器角度變換模塊(以下簡稱RDC)的硬件電路與軟件程序。在交流伺服試驗平臺上,首先通過單步運(yùn)行伺服電動機(jī),驗證了所設(shè)計變換電路具有良好的變換精度和線性度;其次以一階前饋PID算法,使得伺服試驗平臺跟蹤給定的參考信號,試驗結(jié)果間接表明了變換電路具有較高的變換精度和線性度。本文的實現(xiàn)方案可以應(yīng)用到各類伺服系統(tǒng)、伺服電動機(jī)等控制系統(tǒng)中。
旋轉(zhuǎn)變壓器是一種精密控制微電機(jī),原理是當(dāng)輸入端施加給定頻率的正弦激勵電壓信號時,兩路輸出端將分別輸出正弦和余弦電壓信號,且輸出信號的幅值與轉(zhuǎn)子的角度位置是一一映射關(guān)系。圖1為RDC電路組成框圖,它主要由勵磁電路和AD2S83組成,TMS320F2812為主控芯片,通過EMP7128產(chǎn)生組合邏輯電路,以提供芯片的片選和數(shù)據(jù)鎖存等信號。
圖1 RDC變換電路組成框圖
圖2為RDC電路的原理框圖,各芯片的功能介紹如下:
圖2 RDC變換電路原理框圖
AD9833:數(shù)字可編程的DDS發(fā)生器,用于產(chǎn)生旋轉(zhuǎn)變壓器的正弦勵磁信號[1]。
AD2S83:單片集成旋轉(zhuǎn)變壓器角度/數(shù)字轉(zhuǎn)換器,通過配置芯片外圍電路的電阻和電容,直接將輸入的正弦、余弦信號轉(zhuǎn)換為角度值,并通過芯片的數(shù)據(jù)總線(可選的10位、12位、14位和16位)傳輸至主控單元[2]。
EPM7128:可編程邏輯組合單元,用于產(chǎn)生AD2S83芯片的片選信號、數(shù)據(jù)鎖存信號和數(shù)據(jù)使能信號等[3]。
TMS320F2812:RDC電路主控芯片,通過SPI模塊初始化AD9833;使用數(shù)據(jù)總線、地址總線、讀寫信號和存儲區(qū)域使能信號,通過EPM7128產(chǎn)生片選、數(shù)據(jù)所存等邏輯電平信號;讀取旋轉(zhuǎn)變壓器粗、精通道AD2S83角度轉(zhuǎn)換二進(jìn)制碼,并將粗、精通道的數(shù)據(jù)合成為高精度的角度值。
本文設(shè)計雙通道旋轉(zhuǎn)變壓器變換模塊轉(zhuǎn)換精度為16位,軟件設(shè)計主要包括EMP7128邏輯電路和粗、精通道數(shù)據(jù)合成兩部分。
TMS320F2812通過16位的數(shù)據(jù)總線讀取AD2S83的轉(zhuǎn)換數(shù)值,因此 AD2S83的 BYTE SELECT引腳直接接5 V高電平,這樣DB1~DB16直接對應(yīng)轉(zhuǎn)換數(shù)值的二進(jìn)制碼。EMP7128的軟件利用TMS320F2812的地址總線、存儲區(qū)域片選信號和讀信號,直接產(chǎn)生AD2S83的數(shù)據(jù)鎖存信號和數(shù)據(jù)使能信號,組合邏輯原理圖如圖3所示。
圖3 EMP7128組合邏輯原理圖
讀取AD2S83數(shù)據(jù)分三個步驟:(1)將INHIBIT引腳電平置低,禁止AD2S83數(shù)據(jù)鎖存器更新;(2)保持INHIBIT引腳為低電平,將ENABLE引腳電平置低,使數(shù)據(jù)從AD2S83的鎖存器傳輸?shù)綌?shù)據(jù)線上,同時讀取該數(shù)據(jù);(3)將INHIBIT引腳電平置高,使能AD2S83數(shù)據(jù)鎖存器更新。
旋轉(zhuǎn)變壓器粗、精通道數(shù)據(jù)合成的方法較多,文中旋轉(zhuǎn)變壓器的極對數(shù)為1∶32,主控芯片讀取的角度變換值為16位二進(jìn)制碼,則下文數(shù)據(jù)合成方法可使得計算量最小,合成算法簡潔。已知粗通道角度二進(jìn)制碼為RDC->Dc,精通道角度二進(jìn)制碼為RDC->Dj,設(shè)合成數(shù)據(jù)為RDC->Data,則有:
上述計算式還需根據(jù)粗、精通道角度值判斷是否需要補(bǔ)償0x800,限于篇幅,這里不再贅述。
圖4和圖5分別為旋轉(zhuǎn)變壓器和使用該旋轉(zhuǎn)變壓器作為位置傳感器的隨動實驗平臺,實驗平臺的執(zhí)行機(jī)構(gòu)為高性能交流伺服電動機(jī),電機(jī)自身可以進(jìn)行閉環(huán)調(diào)試。實驗驗證內(nèi)容包括旋轉(zhuǎn)變壓器轉(zhuǎn)換精度和線性度,以及使用一階前饋PID算法跟蹤給定曲線的控制性能。
圖4 旋轉(zhuǎn)變壓器
圖5 隨動實驗平臺
保持旋轉(zhuǎn)變壓器在多個位置處于靜止?fàn)顟B(tài),從CCS3.1中觀察粗、精通道轉(zhuǎn)換數(shù)值的波動情況,兩個通道轉(zhuǎn)換數(shù)值(16位二進(jìn)制碼)的波動情況均不超過低3位,則合成的數(shù)據(jù)精度高于16位。
隨動實驗平臺使用的減速器減速比為1∶128,設(shè)置交流伺服電動機(jī)為閉環(huán)系統(tǒng),單步運(yùn)行,使得電機(jī)每一步運(yùn)轉(zhuǎn)2圈,位置控制器記錄旋轉(zhuǎn)變壓器360°范圍內(nèi)各位置處的變換數(shù)值,得到如圖6所示的直線圖,圖中橫坐標(biāo) n是采樣點(diǎn),縱坐標(biāo)RCD→Data是位置量合成的16位數(shù)據(jù)值,經(jīng)分析得到線性度小于0.006%。
圖6 旋轉(zhuǎn)變壓器數(shù)據(jù)變換線性度曲線
如圖5所示的閉環(huán)控制系統(tǒng),伺服電動機(jī)工作在電流環(huán)和速度換模式,位置控制器完成實驗平臺的位置閉環(huán)控制。
參考輸入為振幅98°,最大跟蹤角速度70°/s,最大跟蹤角加速度50°/s2的正弦曲線。圖7為跟蹤誤差曲線放大圖,其中跟蹤誤差最大值不超過0.12°,即 2 mil。該實驗結(jié)果間接表明了RDC變換電路具有較高的變換精度和良好的線性度。
圖7 跟蹤誤差曲線放大圖
本文介紹了雙通道旋轉(zhuǎn)變壓器位置檢測系統(tǒng)的硬件設(shè)計和軟件設(shè)計過程,給出了設(shè)計的步驟和關(guān)鍵技術(shù)解決方案,并通過實驗驗證了RDC變換電路具有高于16位的變換精度和小于0.006%的線性度。經(jīng)多次實驗驗證此硬件電路原理簡單,工作穩(wěn)定;軟件程序思路簡潔,執(zhí)行穩(wěn)定、效率高,具有很好的工程應(yīng)用價值,在此基礎(chǔ)上可根據(jù)設(shè)計需求,添加檢測、存儲和聯(lián)鎖保護(hù)等電路完善系統(tǒng)電氣設(shè)計。
[1] Analog Devices公司.Low power CMOS complete DDS AD9833[M].Analog Devices,inc.,2002.
[2] Analog Devices公司.Variable resolution,resolver-to-ditital converter AD2S83 [M].Analog Devices,inc.,1998.
[3] Analog Devices公司.MAX7000A programmable logic device[M].Analog Devices,inc.,2002.
[4] TEXAS INSTRUMENTS.TMS320F28x DSP CPU and instruction set reference guide[M].Texas Instruments,2004.
[5] TEXAS INSTRUMENTS.TMS320F281x Data Sheet[M].Texas Instruments,2004.
[6] 黃科元,董恒,黃守道.旋轉(zhuǎn)變壓器在高速永磁同步電動機(jī)中的應(yīng)用[J].微特電機(jī),2008(2):10-11.