宋少鵬
(鄭州飛機(jī)裝備有限責(zé)任公司預(yù)研室,河南 鄭州 450005)
在一個(gè)位置控制系統(tǒng)中,需要兩臺(tái)電機(jī)同步工作。由于電機(jī)在設(shè)計(jì)制造過程中有一定的誤差累積,因此其轉(zhuǎn)速有一定的誤差,因此兩臺(tái)電機(jī)協(xié)同工作時(shí),累積的誤差反映到實(shí)際工況中,會(huì)導(dǎo)致位置誤差過大,以至于影響系統(tǒng)正常工作,因此需要根據(jù)誤差情況對(duì)電機(jī)進(jìn)行實(shí)時(shí)調(diào)整,使其滿足系統(tǒng)性能需求。
本文介紹了一種基于DSP的電機(jī)同步控制系統(tǒng),電機(jī)輸出軸通過減速器連接到編碼器,編碼器實(shí)時(shí)采集電機(jī)的位置信息,DSP根據(jù)兩臺(tái)電機(jī)位置誤差對(duì)電機(jī)的轉(zhuǎn)速進(jìn)行調(diào)整,使其滿足系統(tǒng)要求。
整個(gè)控制系統(tǒng)主要由DSP控制板和編碼器組成。DSP控制板主要由電源電路、DSP基本電路和CAN總線接口電路組成。
電源電路將外界提供電源轉(zhuǎn)換為系統(tǒng)所需的電源,如圖1所示。系統(tǒng)提供28V直流電源,經(jīng)SFJLC-46181-3AW濾波供編碼器和進(jìn)一步轉(zhuǎn)化,TDPAA28S5W10是隔離的DC-DC變換器,將28V轉(zhuǎn)化為5V供系統(tǒng)電路和CAN總線使用,TPS767D318把5V電源轉(zhuǎn)化為3.3V供DSPI/O使用,轉(zhuǎn)化為1.8V供DSP內(nèi)核使用[1-2]。
圖1 電源變換電路
DSP基本電路如圖2所示,采用SMJ320F2812HFGM150作為處理核心。SMJ320F2812HFGM150是高性能的32位定點(diǎn)數(shù)字信號(hào)處理器,主時(shí)鐘最高工作頻率可達(dá)150MHz,單周期指令執(zhí)行時(shí)間6.67ns。該電路集成了多種先進(jìn)的外設(shè),為電機(jī)及其他運(yùn)動(dòng)控制領(lǐng)域的應(yīng)用提供了良好的平臺(tái)。
圖2 DSP基本電路
CAN總線接口電路如圖3所示,主要由總線控制器電路、收發(fā)器電路、隔離電路、外圍電路等組成。
CAN總線控制器采用SJA1000芯片,其內(nèi)部分為接口管理模塊、發(fā)送緩沖器、接收緩沖器、驗(yàn)收濾波器、位流處理器、位時(shí)序邏輯、錯(cuò)誤管理邏輯等子模塊。通過各模塊的配合實(shí)現(xiàn)在CPU和外圍CAN網(wǎng)絡(luò)之間控制的功能,實(shí)現(xiàn)物理層和數(shù)據(jù)鏈路層的功能。
CAN總線收發(fā)器采用PCA82C250,作為CAN協(xié)議控制器和物理總線之間的接口,實(shí)現(xiàn)CAN總線控制器不同終端的通信,提供對(duì)總線的差分接收功能和差分發(fā)送功能。
電路進(jìn)行抗干擾設(shè)計(jì),SJA1000和PCA82C250之間采用6N137高速光耦實(shí)現(xiàn)信號(hào)的隔離。CANH和CANL之間采用CMW3216繞線片式共模電感進(jìn)行隔離,在適當(dāng)位置加匹配電阻和電容[3]。
圖3 CAN總線接口電路
本系統(tǒng)采用德國倍加福公司生產(chǎn)的CSM36M-F4AB DA0BN-1213型編碼器,如圖4所示。這是一款采用電磁式碼盤掃描技術(shù)的絕對(duì)值編碼器。不受對(duì)光電掃描不利因素(沖擊、振動(dòng)、灰塵、濕氣等)的影響,體積小,產(chǎn)品性價(jià)比高。
絕對(duì)值編碼器為每個(gè)軸的位置提供一個(gè)獨(dú)一無二的編碼位置值,這款絕對(duì)值編碼器通過CAN總線接口與主機(jī)進(jìn)行通信,傳輸速率最大為1MBit/s,分辨率單圈13位,圈數(shù)12位,完全滿足系統(tǒng)要求。
圖4 CSM36M-F4ABDA0BN-1213型編碼器
DSP軟件設(shè)計(jì)包括初始化程序、CAN總線通訊程序、數(shù)據(jù)計(jì)算處理程序、電機(jī)控制程序。
主程序流程圖如圖5所示。
圖5 主程序流程圖
其中CAN總線通訊程序主要由初始化函數(shù)、發(fā)送函數(shù)和接收函數(shù)組成,流程圖如圖6所示。其中發(fā)送函數(shù)為寫主動(dòng)發(fā)送函數(shù),接收函數(shù)采用中斷接收[4]。
①進(jìn)入復(fù)位模式,進(jìn)行配置。②配置時(shí)鐘分頻寄存器,決定Peil模式還是Basic模式。③配置總線定時(shí)寄存器,確定波特率。④配置中斷使能寄存器,決定使用哪幾個(gè)中斷。⑤配置輸出控制寄存器。⑥配置驗(yàn)收碼和屏蔽碼,決定接收哪一類節(jié)點(diǎn)的數(shù)據(jù)。⑦退出復(fù)位模式,進(jìn)入正常工作模式。
①查詢狀態(tài)寄存器,判斷是否正在接收,是否正在發(fā)送,是否數(shù)據(jù)緩沖區(qū)被鎖。②配置發(fā)送緩沖區(qū)。③配置命令寄存器,啟動(dòng)發(fā)送。
圖6 CAN總線通訊程序流程圖
①采用中斷接收,關(guān)CPU中斷。②判斷是不是接收中斷。③判斷是遠(yuǎn)程幀還是數(shù)據(jù)幀。④讀取數(shù)據(jù)。⑤開中斷。
本系統(tǒng)通過實(shí)時(shí)監(jiān)測電機(jī)的運(yùn)行狀態(tài),不斷修正兩個(gè)電機(jī)的運(yùn)行速度,經(jīng)過驗(yàn)證,整個(gè)系統(tǒng)的控制精度達(dá)到0.5mm,而且此控制系統(tǒng)工作穩(wěn)定,抗干擾能力強(qiáng),完全能滿足性能要求。
[1]尹明,王杰.基于CAN總線嵌入式數(shù)字控制系統(tǒng)的設(shè)計(jì)[J].制造業(yè)自動(dòng)化,2010(2):12-15.
[2]曾敏,楊九銘,張泉宏.基于DSP的直流變頻控制系統(tǒng)研究[J].電力電子技術(shù),2005(6):56-59.
[3]蘇奎峰,呂強(qiáng),耿慶鋒.TMS320F2812原理與開發(fā)[M].北京:電子工業(yè)出版社,2006.
[4]王瑾.基于DSP和CAN總線的步進(jìn)電機(jī)控制系統(tǒng)研究[J].電子測量技術(shù),2009(1):68-72.