基于TMS320C6713的磁懸浮動(dòng)量輪控制系統(tǒng)的硬件設(shè)計(jì)與應(yīng)用
采用磁軸承支撐的動(dòng)量輪便是磁懸浮動(dòng)量輪,它與傳統(tǒng)動(dòng)量輪(機(jī)械軸承支撐)相比有許多優(yōu)點(diǎn),因?yàn)榇泡S承是非接觸的,沒有機(jī)械磨損,不需要潤滑系統(tǒng),因而壽命長。并且由于摩擦損耗很小,它可以在比機(jī)械軸承支撐的動(dòng)量輪更高的轉(zhuǎn)速下長期工作。由于磁軸承不容易受溫度變化的影響,使得其對機(jī)加工精度的要求比機(jī)械軸承低得多,可以降低制造成本。磁軸承還具備的一大優(yōu)點(diǎn)是能對振動(dòng)進(jìn)行主動(dòng)控制,這可以明顯提高衛(wèi)星的定位精度。由于具備種種優(yōu)點(diǎn),磁懸浮動(dòng)量輪成為替代機(jī)械軸承動(dòng)量輪的一種理想選擇。
國際上對磁懸浮動(dòng)量輪這一領(lǐng)域的研究不斷取得進(jìn)展。法國1986年發(fā)射的SPOT地球資源衛(wèi)星采用磁懸浮動(dòng)量輪進(jìn)行姿態(tài)控制,得到了清晰準(zhǔn)確的圖像,這是磁懸浮動(dòng)量輪在空間的首次應(yīng)用。在美國、歐洲和日本的許多公司和研究所都在進(jìn)行相關(guān)的研究,并已成功應(yīng)用到了各種衛(wèi)星和空間站上。在國內(nèi),清華大學(xué)、西安交通大學(xué)、北京航空航天大學(xué)也在進(jìn)行相關(guān)研究,但總體而言處于起步階段,進(jìn)一步開展這方面的研究對提高我國的航天科技水平具有很重要的意義。
1 磁懸浮動(dòng)量輪的構(gòu)成和工作原理
本文的電磁軸承技術(shù)應(yīng)用的研究對象是外轉(zhuǎn)子動(dòng)量輪,其構(gòu)成了一臺五自由度的磁懸浮動(dòng)量輪原理樣機(jī),其結(jié)構(gòu)框圖如圖1所示。
其中動(dòng)量輪輪體是一套包括電磁鐵、同步電機(jī)和轉(zhuǎn)子的機(jī)械裝置(如圖2所示)。轉(zhuǎn)子是被控對象,在電機(jī)帶動(dòng)下旋轉(zhuǎn),它的5個(gè)自由度(上下各兩個(gè)徑向,還有一個(gè)軸向)的位移信號通過電渦流傳感器變成電壓信號,傳給控制系統(tǒng);控制系統(tǒng)執(zhí)行控制算法,得出控制信號;MPW型功率放大器負(fù)責(zé)將控制系統(tǒng)傳來的十路電壓控制信號轉(zhuǎn)化為電流,流入電磁鐵的線圈,驅(qū)動(dòng)電磁鐵產(chǎn)生電磁力,將轉(zhuǎn)子懸浮于空中(其中每一對磁鐵控制一個(gè)自由度)。監(jiān)測系統(tǒng)用于監(jiān)測及在線顯示系統(tǒng)的位移和電流信號、電機(jī)驅(qū)動(dòng)電流以及動(dòng)量輪轉(zhuǎn)速等信息,并可進(jìn)行頻域分析[1]。本文研究的重點(diǎn)是控制系統(tǒng),它是整個(gè)設(shè)備的核心,在很大程度上決定著設(shè)備的性能。
2 控制系統(tǒng)的硬件設(shè)計(jì)
2.1 硬件框圖及工作原理
本文設(shè)計(jì)了基于TMS320C6713(以下簡稱6713)的便于實(shí)現(xiàn)集中控制算法的硬件平臺,在高性能CPU的基礎(chǔ)上擴(kuò)展了集成度和可編程能力更高的AD、DA等芯片,其結(jié)構(gòu)框圖如圖3所示。
TMS320C6713是目前TI公司推出的主流浮點(diǎn)型高端DSP,其浮點(diǎn)特性很好地滿足了磁軸承控制系統(tǒng)對數(shù)據(jù)計(jì)算精度和動(dòng)態(tài)范圍的要求,同時(shí)簡化了算法中存在的大量浮點(diǎn)運(yùn)算代碼并提高了算法執(zhí)行速度。該CPU為32 位,內(nèi)置八個(gè)功能單元,最高300MHZ的時(shí)鐘主頻,2400MIPS、1800MFLOPS的運(yùn)算能力,可以進(jìn)行16/32/40位的整數(shù)運(yùn)算和32/64位的浮點(diǎn)運(yùn)算。具備超長指令字功能,含多級硬件流水線,數(shù)據(jù)處理能力強(qiáng)大。具備兩級緩存,程序和數(shù)據(jù)緩存各為4KB,有192KB的映射內(nèi)存和64KB的可配置內(nèi)存。大量的片內(nèi)存儲可以很好地滿足復(fù)雜算法對存儲空間的要求,簡化了外圍電路,提高了存取速度和可靠性。其片內(nèi)的EMIF并口可以方便地與目前出現(xiàn)的所有存儲實(shí)現(xiàn)無縫連接,EDMA的存在方便了數(shù)據(jù)的存取并減小了CPU的負(fù)荷,此外具有2個(gè)32位TIMER,2個(gè)MCBSP串口,兩個(gè)MCASP,兩個(gè)I2C,一個(gè)HPI接口和可配置的IO,可方便地與外圍器件進(jìn)行通訊。
在硬件系統(tǒng)中,傳感器傳來的信號經(jīng)過抗混疊濾波后由AD進(jìn)行轉(zhuǎn)換,然后由DSP讀出;DA負(fù)責(zé)將DSP計(jì)算后寫入的數(shù)據(jù)轉(zhuǎn)換為控制信號,經(jīng)過放大濾波后,傳給功放;同時(shí)兩路轉(zhuǎn)速信號(將兩個(gè)紅外探頭置于轉(zhuǎn)子的90度角上得到兩路信號)經(jīng)過脈沖處理電路后會(huì)形成一系列脈沖,產(chǎn)生中斷,通過對這兩個(gè)中斷信號分別計(jì)數(shù),可以計(jì)算得出轉(zhuǎn)子的轉(zhuǎn)速和轉(zhuǎn)向;SDRAM負(fù)責(zé)存儲數(shù)據(jù)和結(jié)果,F(xiàn)LASH用于加載程序以使系統(tǒng)脫離仿真環(huán)境而獨(dú)立工作;串口負(fù)責(zé)DSP與PC之間的通訊。
2.2 DSP外圍器件特性及其接口設(shè)計(jì)
2.2.1 最小系統(tǒng)
DSP本身:需要注意的是DSP的大小端工作模式、復(fù)用引腳的選擇、啟動(dòng)方式等都取決于特定引腳的電平,可以通過跳線來配置;某些引腳必須按規(guī)定接為上拉或下拉,否則可能導(dǎo)致DSP不能正常工作,具體參考文獻(xiàn)[2];由于6713的外部總線工作在100MHz的時(shí)鐘頻率下,屬于高速電路,如果使用不當(dāng),會(huì)導(dǎo)致不能正常讀寫,所以需要在所有信號線的發(fā)射端接匹配電阻,以抵消信號的二次反射,從而避免過沖、振鈴等信號完整性的問題;300MHz的6713采用的是BGA封裝,雖然該封裝具有很多優(yōu)點(diǎn),但是不利于調(diào)試,最好將關(guān)鍵引腳引出(注意包地),以便于調(diào)試和糾錯(cuò)。
電源復(fù)位模塊:6713需要1.4V的內(nèi)核電壓和3.3V的IO電壓,系統(tǒng)總輸入電源為5V,所以可通過TPS54310將5V電壓轉(zhuǎn)化為1.4V電壓,用TPS75733將5V電壓轉(zhuǎn)化為3.3V電壓,同時(shí)用TPS3823作為電源監(jiān)視模塊,用以監(jiān)視電源是否工作正常,并且該片內(nèi)有硬件看門狗和手動(dòng)復(fù)位功能,這樣就可以在適當(dāng)?shù)臅r(shí)候產(chǎn)生復(fù)位信號,使DSP處于RESET狀態(tài)。
時(shí)鐘模塊:DSP內(nèi)部有PLL模塊,能夠方便地通過軟件配置來進(jìn)行倍頻和分頻,這樣就簡化了外部時(shí)鐘電路,提高了系統(tǒng)的可靠性。系統(tǒng)主要需要產(chǎn)生300MHz的內(nèi)核工作時(shí)鐘和100MHz的外圍總線工作時(shí)鐘,這樣只需簡單地在外部接一個(gè)25MHz的有源晶振即可。需要注意的是DSP的PLL模塊電源應(yīng)該接EMI濾波器,另外在配置內(nèi)部時(shí)鐘時(shí)應(yīng)該遵循一定的時(shí)序,詳見參考文獻(xiàn)[3]。
擴(kuò)展內(nèi)存:系統(tǒng)需要擴(kuò)展內(nèi)存來存儲大量數(shù)據(jù)以節(jié)省片內(nèi)內(nèi)存,綜合考慮速度、成本和容量等因素,決定采用SDRAM(同步動(dòng)態(tài)RAM),器件選擇MICRON公司的MT48LC4M32B2(1M324Banks),具有32位的數(shù)據(jù)總線,對應(yīng)16MB的尋址空間。DSP內(nèi)的EMIF模塊可與SDRAM直接進(jìn)行無縫連接,采用小端模式,并將SDRAM映射到EMIF的CE0空間。
FLASH:配置FLASH實(shí)現(xiàn)系統(tǒng)的自加載功能使系統(tǒng)脫離調(diào)試環(huán)境而獨(dú)立運(yùn)行,采用的是AMD公司的AM29LV400B(256K16-Bit),有16位的數(shù)據(jù)總線,工作于半字模式,對應(yīng)256KB的尋址空間,映射到EMIF的CE1空間。
JTAG接口:DSP具有遵循IEEE 1149.1協(xié)議的JTAG接口,可以通過仿真器與PC機(jī)相連,在TI公司提供的集成開發(fā)環(huán)境CCS下進(jìn)行仿真和調(diào)試。將JTAG模塊的TMS、 TDI、TDO和TCK這四個(gè)引腳直接引出到標(biāo)準(zhǔn)的JTAG插座上,與仿真器插頭的引腳一一對應(yīng);另外EMU0和EMU1要外接上拉電阻,使DSP工作在仿真模式下,TRST引腳接下拉電阻,PD接5V電壓。需要注意的是,JTAG座為標(biāo)準(zhǔn)的14針插座,其中沒用的第6針應(yīng)拔掉以便電纜插頭插入,這樣可以防止插反。
2.2.2 AD和DA
AD采用了12位的MAX115,每個(gè)芯片具有2Banks4Channels的采樣通道,各通道都有跟蹤保持放大器,它可以將四通道的信號同時(shí)保持住,這樣可以保證各通道用于轉(zhuǎn)換的信號在時(shí)間上的同步,實(shí)現(xiàn)了數(shù)據(jù)的同時(shí)采樣。系統(tǒng)中采用兩片AD,每片轉(zhuǎn)換兩路,采樣率最高可以達(dá)到218ksps,將兩片AD映射到EMIF的CE3空間,通過地址線和片選線譯碼產(chǎn)生每個(gè)AD的片選信號。由于AD是5V器件,而DSP是3.3V的IO電壓,所以中間需要接總線開關(guān),用于5V到3.3V的電壓轉(zhuǎn)換。轉(zhuǎn)換啟動(dòng)引腳與DSP的定時(shí)器輸出引腳相連,每個(gè)AD芯片轉(zhuǎn)換完成后都會(huì)產(chǎn)生一個(gè)中斷信號,將這兩個(gè)信號相與之后作為DSP的中斷輸入。AD的12位數(shù)據(jù)線與EMIF的對應(yīng)數(shù)據(jù)總線相連,用于數(shù)據(jù)和指令的傳輸。
DA采用了13位8通道的MAX547,可以同時(shí)輸出8通道D/A轉(zhuǎn)換信號,它與處理器的接口并行,輸出建立時(shí)間為5μs。由于系統(tǒng)需要10路輸出,所以需要采用兩片DA,這樣一共可以同時(shí)提供16路輸出信號,使用時(shí)可以分配每一片轉(zhuǎn)換5路信號。將兩片DA也映射到EMIF的CE3空間,同時(shí)通過地址線和片選線譯碼產(chǎn)生每個(gè)DA的片選信號。輸出經(jīng)過一級放大電路后,可以將電壓擴(kuò)大兩倍,同時(shí)保證輸出電流的帶負(fù)載能力。采用DSP的低13位數(shù)據(jù)線進(jìn)行數(shù)據(jù)的傳輸,同時(shí)采用低三位地址線進(jìn)行通道的選擇。DSP的D0數(shù)據(jù)線經(jīng)過脈沖擴(kuò)展后形成轉(zhuǎn)換啟動(dòng)信號連接到DA的對應(yīng)引腳。
2.2.3 其他電路
串口電路:系統(tǒng)可以通過RS232串口與PC機(jī)進(jìn)行通訊,這可以利用DSP內(nèi)部的MCBSP模塊以軟件模擬的方式來實(shí)現(xiàn),硬件上把幀同步輸入和數(shù)據(jù)接收端接在一起形成UART的輸入端,把數(shù)據(jù)發(fā)送端作為UART的輸出端,然后將UART接至MAX3232,形成了RS232串口。需要注意的是,根據(jù)MCBSP的工作特點(diǎn),需要將實(shí)際數(shù)據(jù)擴(kuò)展為16位(0用0x0000表示,1 用0xFFFF表示)。
測速電路:紅外測速信號需要經(jīng)過一定的脈沖整形電路來產(chǎn)生DSP的中斷輸入,主要是讓測速信號經(jīng)過微分電路、比較電路和與門產(chǎn)生沿陡峭的脈沖信號,再經(jīng)過單穩(wěn)觸發(fā)電路調(diào)整脈沖寬度就形成了符合要求的中斷信號。
CPLD:在系統(tǒng)中所需要實(shí)現(xiàn)的很多邏輯功能可以通過CPLD實(shí)現(xiàn),這樣可以避免去尋找專用的簡單邏輯器件,并且CPLD編程方便、功能強(qiáng)大、節(jié)省空間,可以提高系統(tǒng)的性能。在本系統(tǒng)中,CPLD采用的是5V/3.3V兼容的CY37064,主要用來實(shí)現(xiàn)如下功能:AD和DA的譯碼;復(fù)位信號的與運(yùn)算;AD中斷信號的與運(yùn)算;DA啟動(dòng)信號的脈寬擴(kuò)展;擴(kuò)展IO等。
3 硬件平臺的應(yīng)用與實(shí)驗(yàn)結(jié)果
3.1 控制算法的選取
控制算法主要采用PID、交叉反饋和數(shù)字濾波。PID是控制的基礎(chǔ),實(shí)現(xiàn)基本的懸浮,交叉反饋用來克制轉(zhuǎn)子旋轉(zhuǎn)時(shí)的進(jìn)動(dòng)和章動(dòng),同時(shí)設(shè)計(jì)一個(gè)切比雪夫二型4階帶阻濾波器來克服結(jié)構(gòu)模態(tài)的影響,該濾波器中心頻率為910Hz,陷波寬度為40Hz,陷波深度為20分貝。將連續(xù)域的傳遞函數(shù)經(jīng)過雙線性變換可得到如下公式:
y(k)中的各項(xiàng)依次為比例輸出部分、積分輸出部分、微分輸出部分和交叉反饋輸出部分。要確定上面公式中的系數(shù),需要首先確定偏置電流和系統(tǒng)的剛度、阻尼,從而得出負(fù)剛度和電流比例系數(shù),進(jìn)而得出各參數(shù),先通過仿真選定初值,然后通過實(shí)驗(yàn)反復(fù)調(diào)整參數(shù),直至得到滿意的效果為止[4]。
3.2 軟件開發(fā)與實(shí)驗(yàn)結(jié)果
在硬件平臺建立好之后,便可以通過仿真器將PC機(jī)和目標(biāo)系統(tǒng)連接起來,在CCS集成開發(fā)環(huán)境下進(jìn)行軟件的開發(fā),它支持C和匯編。經(jīng)過優(yōu)化的可執(zhí)行代碼可以下載到系統(tǒng)當(dāng)中,利用單步執(zhí)行和設(shè)置斷點(diǎn)等方法進(jìn)行功能上的調(diào)試。
磁懸浮動(dòng)量輪控制系統(tǒng)的軟件結(jié)構(gòu)流程如圖4所示。系統(tǒng)復(fù)位后程序首先進(jìn)行系統(tǒng)初始化,包括 配置PLL得到所需要的系統(tǒng)時(shí)鐘,初始化EMIF以保證SDRAM、AD和DA正常工作,初始化TIMER、IO、中斷和EDMA;然后啟動(dòng)TIMER開始工作,按一定的頻率觸發(fā)AD采樣,當(dāng)AD中斷到來時(shí),DSP就讀出數(shù)據(jù)并按一定的控制算法計(jì)算得出控制輸出,然后寫入DA緩存當(dāng)中,最后觸發(fā)DA轉(zhuǎn)換。當(dāng)下一個(gè)AD中斷到來時(shí)再重復(fù)上面的過程。同時(shí)轉(zhuǎn)速信號通過脈沖處理電路生成中斷信號,觸發(fā)DSP用于轉(zhuǎn)速處理的中斷程序,可實(shí)現(xiàn)轉(zhuǎn)子轉(zhuǎn)速和轉(zhuǎn)向的在線測量。當(dāng)PC機(jī)發(fā)出指令時(shí),則進(jìn)入相應(yīng)的中斷程序作出響應(yīng)??撮T狗電路在程序運(yùn)行不正常時(shí),可以觸發(fā)RESET信號,重新加載程序代碼,恢復(fù)程序的正常運(yùn)行。
實(shí)驗(yàn)表明,該硬件平臺使得程序執(zhí)行的時(shí)間大大縮短,從而可以將采樣率提高到以前(以TMS320C32為核心)的10倍以上,大大提高了系統(tǒng)的性能,目前動(dòng)量輪轉(zhuǎn)子可以達(dá)到12 000r/min,在工作轉(zhuǎn)速下,軸承處轉(zhuǎn)子的振動(dòng)小于10μm。
本文構(gòu)建了基于TMS320C6713的磁懸浮動(dòng)量輪控制系統(tǒng)的硬件平臺,并借助該平臺進(jìn)行了控制軟件的開發(fā),通過硬件系統(tǒng)優(yōu)良的性能很好地實(shí)現(xiàn)了外轉(zhuǎn)子動(dòng)量輪原理樣機(jī)在高速旋轉(zhuǎn)下的穩(wěn)定懸浮,基本滿足了各種性能指標(biāo),為下一步集中精力進(jìn)行控制算法的研究改進(jìn)和提高系統(tǒng)的性能提供了有力保證。
參考文獻(xiàn)
[1] 張剴.磁懸浮動(dòng)量輪系統(tǒng)研究[博士學(xué)位論文].清華大學(xué)工程物理系,2004.
[2] TMS320C6713B Floating-point Digital Signal Processor.Texas Instrument,2005.
[3] TMS320C6000 DSP 32-Bit Timer Reference Guide.TexasInstrument,2005.
[4] G.施韋策,H.布魯勒,A.特拉克斯勒著,虞烈,袁崇軍譯.主動(dòng)磁軸承基礎(chǔ)、性能及應(yīng)用.北京:新時(shí)代出版社,1997.
評論