一種基于FPGA的BiSS編碼器解碼器設(shè)計
作者簡介:李紹軍(1989—),男,碩士,工程師,研究方向?yàn)楣怆娫婆_伺服控制。
本文引用地址:http://cafeforensic.com/article/202109/428017.htm0 引言
BiSS 協(xié)議是一種時鐘頻率高達(dá)10 MHz 的串行通信協(xié)議,物理上采用RS422 差分總線方式,使用BiSS 通信協(xié)議的光電編碼器具有數(shù)據(jù)線占用少、抗干擾性強(qiáng)、通信速率快等優(yōu)點(diǎn),在機(jī)器人、數(shù)控機(jī)床、雷達(dá)轉(zhuǎn)臺等領(lǐng)域應(yīng)用廣泛[1-2]。一些新型微控制器已經(jīng)具備了物理上支持BiSS 通信協(xié)議的外設(shè)接口,如Infineon 公司的XMC4000 系列使用SPI 接口可完成BiSS 協(xié)議解碼功能[3],但當(dāng)進(jìn)行伺服電機(jī)控制時需要CPU 在執(zhí)行FOC 算法的基礎(chǔ)上實(shí)時通過較復(fù)雜的軟件實(shí)現(xiàn)BiSS 協(xié)議解碼,增加了CPU的負(fù)擔(dān);TI 公司的TMS320F3837x 系列使用CLB 模塊配合SPI 外設(shè)接口實(shí)現(xiàn)對BiSS 協(xié)議的解碼[4],可以減輕CPU 的負(fù)擔(dān),但CLB 外設(shè)數(shù)量有限。且這些方式均難以達(dá)到BiSS 協(xié)議最高時鐘頻率,綜合比較使用FPGA 解碼可降低CPU 負(fù)擔(dān)同時可充分發(fā)揮BiSS 協(xié)議時鐘頻率高的優(yōu)點(diǎn)。文中針對BiSS 協(xié)議數(shù)據(jù)幀格式,設(shè)計了BiSS 協(xié)議解碼器狀態(tài)機(jī)和CRC 校驗(yàn)器,并使用Moldisim 對校驗(yàn)過程進(jìn)行仿真,FPGA 將解碼數(shù)據(jù)發(fā)送給DSP,通過驅(qū)動永磁同步電機(jī)對該設(shè)計的解碼效果進(jìn)行了驗(yàn)證。
1 解碼器硬件設(shè)計
1.1 BiSS協(xié)議分析
旋轉(zhuǎn)編碼器是伺服電機(jī)常用的一種位置傳感器,常見外部接口形式有RS422、SSI、BiSS 等。使用RS422或者SSI 接口時時鐘頻率一般低于1 MHz,且受限于總線協(xié)議單幀傳輸位數(shù)限制,當(dāng)需要傳輸?shù)奈恢脭?shù)據(jù)位數(shù)較多時會導(dǎo)致編碼器位置采樣頻率偏低。另一種常見位置傳感器是旋轉(zhuǎn)變壓器,隨著技術(shù)的不斷發(fā)展,當(dāng)前旋轉(zhuǎn)編碼器更容易實(shí)現(xiàn)比旋轉(zhuǎn)變壓器更高的分辨率,而BiSS 協(xié)議由于時鐘頻率高,傳輸位數(shù)多,可以輕松實(shí)現(xiàn)對位置數(shù)據(jù)20 kHz 的采樣頻率,因此使用BiSS 協(xié)議的旋轉(zhuǎn)編碼器十分適用于動態(tài)性能要求高的伺服控制領(lǐng)域。BiSS 協(xié)議最初由德國IC-Haus 公司提出,是一種較為新型的開放式同步串行通信總線協(xié)議,在提出后很快開發(fā)出BiSS-B 協(xié)議并得到廣泛應(yīng)用,后由于海德漢公司對BiSS-B 協(xié)議的專利訴求,導(dǎo)致很多編碼器廠商聯(lián)合開發(fā)出BiSS-C 協(xié)議[5-6]。根據(jù)工作模式,BiSS 協(xié)議可分為傳感器模式和寄存器模式,寄存器模式便于使用者掌握更多編碼器狀態(tài)信息,傳感器模式與寄存器模式相比傳輸信息少,因此具有更高的位置采樣頻率。圖1 所示為亨士樂公司BiSS-B 協(xié)議編碼器時序和雷尼紹公司BiSS-C 協(xié)議編碼器時序?qū)Ρ葓D,見文獻(xiàn)[7-8]。由圖中可見,BiSS-B 和BiSS-C 協(xié)議高度相似,均由2 條信號線構(gòu)成,其中一條為時鐘線,另一條為數(shù)據(jù)線。數(shù)據(jù)線上均有Ack 位、Start 位、位置數(shù)據(jù)位、error 位、Warn 位、CRC 校驗(yàn)位和Timeout 位;不同點(diǎn)在于BiSS-C 協(xié)議在Start 位和位置數(shù)據(jù)位間還有額外的1 bit 0 位。
文中就BiSS-B 協(xié)議的旋轉(zhuǎn)編碼器傳感器模式展開討論。
1.2 硬件電路設(shè)計
電機(jī)控制模塊采用DSP+FPGA 雙控制器方式,F(xiàn)PGA 負(fù)責(zé)采集與永磁同步電機(jī)同軸安裝的BiSS 編碼器位置數(shù)據(jù),提供給DSP 用于FOC 算法計算。FPGA通過內(nèi)部定時器定時執(zhí)行BiSS 數(shù)據(jù)解碼周期,每個周期內(nèi)BiSS 時序解碼模塊產(chǎn)生BiSS 總線MA 時鐘,直到該幀數(shù)據(jù)時序完成,同時接收BiSS 總線SLO 數(shù)據(jù)線數(shù)據(jù),根據(jù)BiSS 時序定義從中提取出有用的位置、錯誤位、警告位、CRC 校驗(yàn)位數(shù)據(jù)段送至CRC 校驗(yàn)?zāi)K進(jìn)行處理,根據(jù)BiSS 編碼器的時序長度可以靈活調(diào)整定時器采樣頻率,以實(shí)現(xiàn)最大采樣頻率。CRC 校驗(yàn)?zāi)K按照協(xié)議規(guī)定的校驗(yàn)規(guī)則計算出收到有效數(shù)據(jù)位所對應(yīng)的CRC 校驗(yàn)碼,并與收到數(shù)據(jù)中的CRC 校驗(yàn)位段進(jìn)行對比,若兩者一致則判斷該幀數(shù)據(jù)校驗(yàn)正確,為有效數(shù)據(jù),并將經(jīng)過校驗(yàn)的正確數(shù)據(jù)存入FPGA 內(nèi)RAM 單元,DSP 通過XINTF 接口定時從FPGA 內(nèi)部RAM 讀取解析到的編碼器位置數(shù)據(jù),完成BiSS-B 協(xié)議編碼器數(shù)據(jù)解碼;若兩者不一致則判斷校驗(yàn)錯誤,將該幀數(shù)據(jù)丟棄,并對錯誤次數(shù)進(jìn)行計數(shù),連續(xù)數(shù)次檢驗(yàn)到錯誤數(shù)據(jù)則發(fā)出報警信號觸發(fā)DSP 啟動保護(hù)措施,防止電機(jī)飛車。硬件電路框圖如圖2 所示。
BiSS-B 協(xié)議編碼器物理接口為RS422 電平標(biāo)準(zhǔn),使用TI 公司的高速全雙工RS485 收發(fā)器SN65HVD77將FPGA 的MA 時鐘信號和SLO 數(shù)據(jù)信號將電平轉(zhuǎn)換為兩組差分信號線,連接至BiSS 協(xié)議編碼器。該收發(fā)器支持信號傳輸速率>50 Mbit/s,可涵蓋BiSS 協(xié)議最高傳輸速率。接口電路圖如圖3 所示。
圖3 接口電路圖
解碼器軟件設(shè)計
軟件設(shè)計主要涉及通過FPGA 完成對BiSS-B 協(xié)議數(shù)據(jù)幀的解碼以及對解碼結(jié)果的校驗(yàn),以下從狀態(tài)機(jī)設(shè)計和CRC 校驗(yàn)器設(shè)計兩方面進(jìn)行介紹。文中編碼器使用亨士樂公司的AD36-1213AF.0RBI 型多圈絕對式編碼器。
2.1 狀態(tài)機(jī)設(shè)計
BiSS-B 協(xié)議時序具有數(shù)據(jù)幀長度不固定、數(shù)據(jù)幀信息復(fù)雜的特點(diǎn),狀態(tài)機(jī)是FPGA 設(shè)計中常用的一種設(shè)計方法,基于狀態(tài)機(jī)的設(shè)計可大大提高設(shè)計的靈活性和通用性,因此文中設(shè)計了基于狀態(tài)機(jī)的BiSS-B 協(xié)議時
序解碼模塊。根據(jù)圖1 中BiSS-B 協(xié)議時序,F(xiàn)PGA 作為主設(shè)備,BiSS 編碼器作為從設(shè)備,F(xiàn)PGA 解碼模塊初始狀態(tài)為超時狀態(tài),應(yīng)將時鐘線MA 狀態(tài)拉高,并確認(rèn)數(shù)據(jù)線SLO 狀態(tài)為常高。當(dāng)超時狀態(tài)準(zhǔn)備就緒后,通過將時鐘線MA 狀態(tài)拉低1 個時鐘啟動1 次BiSS 協(xié)議編碼器數(shù)據(jù)轉(zhuǎn)換,并將狀態(tài)機(jī)狀態(tài)切換為空閑狀態(tài),等待數(shù)據(jù)線SLO 上從設(shè)備應(yīng)答響應(yīng)。正常情況下從設(shè)備將數(shù)據(jù)線SLO 狀態(tài)拉低一段時間,狀態(tài)機(jī)將轉(zhuǎn)入應(yīng)答狀態(tài)。待從設(shè)備將數(shù)據(jù)線SLO 狀態(tài)再次拉高時,狀態(tài)機(jī)轉(zhuǎn)入開始狀態(tài),并檢測SLO 高狀態(tài)時長,若時長為1 個MA 時鐘則轉(zhuǎn)入讀取狀態(tài),否則將回到初始超時狀態(tài)。在讀取狀態(tài)中,將對數(shù)據(jù)線SLO 上的數(shù)據(jù)進(jìn)行讀取,直到數(shù)據(jù)位數(shù)達(dá)到時序協(xié)議中規(guī)定的位數(shù),然后將時鐘線MA狀態(tài)拉高轉(zhuǎn)入超時狀態(tài),等待開始下一次循環(huán)。整個流程如圖4 所示。
2.2 CRC校驗(yàn)?zāi)K設(shè)計
CRC 校驗(yàn)全稱為循環(huán)冗余校驗(yàn),是一種常用于檢測通信協(xié)議或存儲設(shè)備中原始數(shù)據(jù)是否發(fā)生數(shù)據(jù)位意外變動的錯誤檢測算法[9]。其基本思想是對實(shí)際有用數(shù)據(jù)位按照一定的計算方法提取出對應(yīng)的唯一一組特征值,將特征值附加在有用數(shù)據(jù)后發(fā)送至數(shù)據(jù)接收端,接收端將讀取到的數(shù)據(jù)按照同樣的計算方法得到一組特征值,若兩組特征值一致則表示讀取數(shù)據(jù)有效。
文中BiSS-B 協(xié)議編碼器產(chǎn)品手冊規(guī)定CRC 校驗(yàn)采用CRC-6 校驗(yàn)算法,其等效多項(xiàng)式為:
X6+X+1 (1)
可以利用一組移位寄存器和異或門電路來進(jìn)行等效電路計算CRC-6 算法校驗(yàn)結(jié)果,其硬件等效電路如圖5 所示,C5-C0 對應(yīng)6 位移位寄存器從高至低的每位。
CRC 校驗(yàn)?zāi)K輸入數(shù)據(jù)從最高位開始逐位與CRC校驗(yàn)結(jié)果字段最高位bit5 進(jìn)行異或運(yùn)算,異或結(jié)果作為CRC 校驗(yàn)結(jié)果字段的最低位bit0,并同時與bit0 異或,其結(jié)果作為bit1,其他bit 位依次為低1 bit 位移位結(jié)果。按照上述方式,應(yīng)對AD36-1213AF.0RBI 型編碼器的位置數(shù)據(jù)位、error 位、Warn 位和CRC 校驗(yàn)位進(jìn)行CRC 校驗(yàn),并將校驗(yàn)結(jié)果與CRC 校驗(yàn)位進(jìn)行對比。使用Modelsim 對CRC 校驗(yàn)?zāi)K設(shè)計的合理性進(jìn)行驗(yàn)證。驗(yàn)證結(jié)果如圖6 所示。在圖6 中,I_Rx_Data 為33 位經(jīng)BiSS 時序解碼模塊提取的數(shù)據(jù),CRC_Result 為CRC 校驗(yàn)結(jié)果,連續(xù)3組CRC 校驗(yàn)結(jié)果和對應(yīng)的三組輸入數(shù)據(jù)末6 位CRC 位一致,表明CRC 校驗(yàn)正確。
圖6 Modelsim CRC校驗(yàn)結(jié)果圖
3 實(shí)驗(yàn)驗(yàn)證
以EP4CE30 型FPGA 和TMS320F28335 型DSP 構(gòu)成的硬件電路為基礎(chǔ),對BiSS-B 編碼器數(shù)據(jù)進(jìn)行了采集解析,圖7 所示為FPGA 端BiSS-B 編碼器數(shù)據(jù)時序監(jiān)測結(jié)果,通道1 為MA 時鐘線波形,頻率為5 MHz,通道2 為SLO 數(shù)據(jù)線波形,由圖中可見完成1 次數(shù)據(jù)解析時間約30 μs,可滿足至少20 kHz 的編碼器數(shù)據(jù)采樣速率。
圖7 BiSS-B編碼器波形圖
電機(jī)驅(qū)動模塊速度環(huán)給定轉(zhuǎn)速為1 000 r/m,連續(xù)采樣多個周期的AD36-1213AF.0RBI 型編碼器未經(jīng)濾波處理的原始數(shù)據(jù)并解析出對應(yīng)單圈和多圈位置數(shù)據(jù),如圖8 所示。
圖8 BiSS-B編碼器單圈/多圈數(shù)據(jù)圖
編碼器單圈/ 多圈數(shù)據(jù)值分布情況如表1 為所示。依據(jù)多個連續(xù)周期里編碼器數(shù)據(jù)計算出的平均轉(zhuǎn)速與給定轉(zhuǎn)速差異較小,可知編碼器數(shù)據(jù)值采樣正確,一致性較好。
表1 編碼器單圈/多圈值
采集速度環(huán)反饋轉(zhuǎn)速響應(yīng)曲線,如圖9 所示。由圖中可見,使用BiSS 編碼器作為位置傳感器時電機(jī)速度環(huán)響應(yīng)較快,超調(diào)量小于8%,穩(wěn)態(tài)誤差小于0.6%,具有較好的動態(tài)和穩(wěn)態(tài)性能。驗(yàn)證了該BiSS 解碼器設(shè)計的合理性。
圖9 電機(jī)速度響應(yīng)曲線圖
4 結(jié)束語
通過對BiSS 協(xié)議的分析基礎(chǔ)上,文中提出了BiSS協(xié)議編碼器解碼方案,通過實(shí)物試驗(yàn)驗(yàn)證了該方案的合理性,具有解析準(zhǔn)確、采樣速度快的特點(diǎn),對不同的BiSS 協(xié)議具有適用性,適合應(yīng)用于BiSS 協(xié)議編碼器數(shù)據(jù)解析場合中。
參考文獻(xiàn):
[1] 王列虎,皮佑國.基于BISS協(xié)議的編碼器接口技術(shù)研究及應(yīng)用[J].機(jī)床與液壓,2011,39(8):121.
[2] 王希遠(yuǎn),成榮,朱煜,等.基于FPGA的BiSS-C協(xié)議編碼器接口技術(shù)研究及解碼實(shí)現(xiàn)[J].液晶與顯示,2016,31(4):386.
[3] 孫彥超.基于XMC4500的PMSM控制系統(tǒng)的設(shè)計[D].沈陽:沈陽航空航天大學(xué),2016.
[4] Texas Instruments Incorporated.TMS320F2837xD Dual-Core Defiino Microcontrollers Technical Reference Manual[R/OL].https://www.ti.com.cn/product/cn/TMS320F28379D?keyMatch=TMS320F2837&tisearch=Search-CNeverything.
[5] 商懷昊,韓基鵬,肖鵬,等.基于BiSS-C協(xié)議的編碼器的接口技術(shù)研究及其在伺服驅(qū)動系統(tǒng)中的應(yīng)用[J].工業(yè)技術(shù)創(chuàng)新,2014,1(2):211.
[6] 霍海龍.基于BiSS協(xié)議的編碼器及其在伺服驅(qū)動系統(tǒng)中的應(yīng)用[J].電氣自動化,2011,33(3):12.
[7] HENGSTLER.Technical Manual SSI_BiSS_ACURO_en[R/OL].http://hengstler.com.cn/product/AD36.
[8] RENISHAW.biss_encoder_9709-9007-03-b(zh)[R/OL].https://www.renishaw.com.cn/zh/resolute-encoderseries--37823
[9] 朱正鵬,朱旭鋒,李賓,等.一種位寬可變的CRC校驗(yàn)算法及硬件實(shí)現(xiàn)[J].航天控制,2019,37(2):42.
(本文來源于《電子產(chǎn)品世界》雜志2021年8月期)
評論