金 南,程遠增,孫書鷹
(軍械工程學院 電子與光學工程系,河北 石家莊050003)
基于磁柵位移傳感器的角度測量系統(tǒng)設(shè)計
金 南,程遠增,孫書鷹
(軍械工程學院 電子與光學工程系,河北 石家莊050003)
為了提高轉(zhuǎn)臺伺服系統(tǒng)精度、抗干擾能力和提高可靠性,設(shè)計了一種基于磁柵位移傳感器的角度測量裝置。該裝置以嵌入式微處理器STM32F103為核心構(gòu)建,設(shè)計采用磁柵位移傳感器,這種傳感器能將位移信號轉(zhuǎn)化為兩路具有相位差的脈沖信號,將脈沖信號傳輸至STM32F103進行計數(shù)。最終將對位移的測量轉(zhuǎn)化為對角度的測量,通過串口傳送到上位機給出結(jié)果顯示。實驗結(jié)果表明該裝置具有較高的可靠性和測量精度。
STM32;磁柵尺;角度測量;信號采集
角度的測量是伺服轉(zhuǎn)臺系統(tǒng)的一個重要組成部分,目前廣泛應用的角度測量傳感器一般有光電編碼器[1]、光柵傳感器[2]、正余弦旋轉(zhuǎn)變壓器[3]等。光柵式傳感器大量程測量精度僅低于激光干涉?zhèn)鞲衅?,光柵測量技術(shù)成熟,精度和分辨率較高,應用較廣泛。但由于機械振動易使光柵尺破碎,光柵尺抗沖擊性、抗振性能不高,光器件的使用壽命短,結(jié)構(gòu)定位組裝復雜,成本較高,而正余弦變壓器雖然構(gòu)造簡單,但是容易損壞不易維修。
文中基于STM32微控制器,應用磁柵位移傳感器設(shè)計了一種角度測量裝置[4],并且給出其硬件電路設(shè)計了及軟件模塊,最后通過實驗對其測量精度和可靠性進行了驗證。
1.1 角度測量系統(tǒng)總體設(shè)計
角度測量系統(tǒng)硬件電路以ARM處理器為核心,由系統(tǒng)電源電路,傳感器電路,通訊接口電路和主控芯片電路等5部分組成,本系統(tǒng)的硬件總體結(jié)構(gòu)如圖1所示。
圖1 硬件原理框圖
1.2 STM32F103微控制器
本系統(tǒng)是高精度的位移測量傳感器的信號處理系統(tǒng),由于ST提供了完整的開發(fā)工具和庫函數(shù),使得用戶方便的訪問STM32的標準外設(shè)。因而在本設(shè)計中選擇意法半導體ST公司推出的STM32F103微控制器[5]。STM32系列的微控制器是由意法半導體公司生產(chǎn)的基于ARM Cortex-M3內(nèi)核的微控制器,具有高性能、低成本、低功耗等特點。工作頻率可達70MHz,內(nèi)置高速存儲器(128 kB Flash,20 kB SRAM),擁有豐富的增強I/O端口 (大部分I/O端口可5V兼容)和USART、SPI、I2S、ADC、DAC等眾多外設(shè)功能,提供84個中斷、16級可配置優(yōu)先級,并且可在-40~105℃的溫度下工作。
1.3 磁柵位移傳感器的工作原理
磁柵位移傳感器是一種可將位移轉(zhuǎn)換為數(shù)字脈沖的傳感器[9-12],這種傳感器由磁柵尺、磁頭組成。當磁頭在尺上面發(fā)生位置變化時,編碼器產(chǎn)生周期性的增量脈沖,因此,實現(xiàn)對脈沖的計數(shù)就可以完成對位移的測量。編碼器可輸出A,B,Z 3個信號,其中A,B兩路信號為相位相差90°的方波信號,Z相為每轉(zhuǎn)一圈的標志信號,每圈只產(chǎn)生一個脈沖,信號波形圖如圖2所示。
圖2 信號波形圖
由波形圖可以看出,在一個周期內(nèi),相位相差90°的AB兩路信號可以有4種電平組合,分別是下圖的4種組合狀態(tài)。當磁頭正向移動時,狀態(tài)變化為10>11>01>00,反向移動時,狀態(tài)變化為01>11>10>00,并且以此周期性循環(huán),可以看到,無論在正向還是在反向移動的情況下,對于任意一個狀態(tài),它的前一個或后一個狀態(tài)是唯一確定的。例如狀態(tài)11,在正向移動時,前一個狀態(tài)是10,后一個狀態(tài)是01,而在反向移動式,前一個狀態(tài)是01,后一個狀態(tài)是10。因此,可根據(jù)A、B相組合電平的變化來判斷磁頭的移動方向和四倍頻的細分計數(shù)。
1.4 差分信號轉(zhuǎn)換電路
在系統(tǒng)實驗中,由于要采用磁柵尺作為位移傳感器,而磁柵尺傳感器輸出的是差分信號,因而我們在信號處理系統(tǒng)中集成了差分信號轉(zhuǎn)換電路[6],將磁柵尺輸出的差分信號進行轉(zhuǎn)換后送入下位機,由處理器芯片讀取脈沖信號進行計數(shù)得到的數(shù)據(jù)通過RS232通訊接口送給上位機進行處理顯示。轉(zhuǎn)換電路如圖3所示。
圖3 差分信號轉(zhuǎn)換電路
本設(shè)計中采用 MAX3095作為傳感器差分信號轉(zhuǎn)換芯片,MAX3095是美國美信公司生產(chǎn)的四通道RS422/RS485發(fā)送器,其采用單5 V電源供電,支持熱插拔,具有ESD保護電路,因而能很好的實現(xiàn)光柵輸入的差分信號的轉(zhuǎn)換,本模塊具體電路原理如圖所示。經(jīng)過磁柵輸入的3對差分信號(六路)經(jīng)過阻抗匹配電路后分別送入 MAX3095芯片的3個通道,經(jīng)過芯片接收轉(zhuǎn)換后,轉(zhuǎn)變成處理器能夠識別的TTL信號送入STM32進行后續(xù)處理。
1.5 RS232串口電路
STM32F103芯片內(nèi)部集成有 3個 USART,因此本系統(tǒng)與上位機通訊通過RS-232串行接口來實現(xiàn)[13-14],其結(jié)構(gòu)簡單,使用方便。本設(shè)計選用 美信公司的MAX3232串口驅(qū)動芯片,該芯片是美信公司專門為電腦的RS-232標準接口設(shè)計的單電源電平轉(zhuǎn)換芯片,使用+5 V單電源供電,具有片載電荷泵升壓、電壓極性反轉(zhuǎn)能力和功耗低等特點。內(nèi)部集成2個RS-232驅(qū)動器和2個RS-232接收器。具體電路如圖4所示。
圖4 串口電路
在本方案中,編碼器 A、B相的信號輸入到STM32微控制器引腳,由兩信號的上升和下降邊沿分別觸發(fā)中斷請求,調(diào)用GPIO_ReadInputDataBit函數(shù)來讀取引腳的輸入值,高電平是1,低電平是0,從而得到A、B相信號組合的編碼值,并根據(jù)現(xiàn)組合編碼值的前一個狀態(tài)來判斷編碼器是正轉(zhuǎn)還是反轉(zhuǎn),正轉(zhuǎn)則計數(shù)加1,反轉(zhuǎn)則計數(shù)減1。例如,現(xiàn)得到組合狀態(tài)值11,如果前一狀態(tài)是10,則編碼器正轉(zhuǎn),計數(shù)加1,如果是01,則相反。通過軟件實現(xiàn)編碼器信號的倍頻鑒相和判斷計數(shù),最后完成角度換算。當前狀態(tài)為11的程序流程如圖5所示。
圖5 程序流程
利用STM32較高的性能,實現(xiàn)軟件四倍頻鑒相計數(shù),不但簡化了電路結(jié)構(gòu),而且使系統(tǒng)開發(fā)方便、快捷、更具靈活性。在編碼器相對運動一圈產(chǎn)生的15 865個脈沖周期里,總共產(chǎn)生63 460個周期性分頻編碼,由此可知,角度變化量Δα與計數(shù)值n的關(guān)系:
Δα=n×(6 000/63 460),單位為密位。角度在信號處理中需要使用Z相脈沖信號,在Z相脈沖產(chǎn)生中斷時,角度計數(shù)清零,從而實現(xiàn)0密位的校正。
根據(jù)上述方案,完成硬件電路設(shè)計和相關(guān)軟件的調(diào)試。實驗將磁柵尺在一個圓環(huán)上繞滿一圈并固定在電機的旋轉(zhuǎn)軸上,將磁頭固定在圓環(huán)上方,最后對角度測量裝置進行角度測量調(diào)試,并利用C++ builder[15]編寫了上位機程序顯示調(diào)試結(jié)果,上位機顯示的測量結(jié)果如圖6所示。從圖中的結(jié)果可以看出本裝置測量精度可以達到0.01密位,并且隨著圓環(huán)的直徑增大,精度將會越大
圖6 實驗結(jié)果
文中設(shè)計了一種基于磁柵位移傳感器的高精度角度測量系統(tǒng),詳細介紹了系統(tǒng)的測量原理,給出了總體設(shè)計電路圖,并通過實驗表明該角度測量系統(tǒng)具有響應速度快、測量精度高等優(yōu)點,具有很高的研究意義和市場價值。
[1]司海立,程武山.磁柵位移傳感器在步進電機控制系統(tǒng)中的應用[J].工業(yè)儀表與自動化裝置,2009(2):55-57.
[2]楊興,胡建明,戴特力.光纖光柵傳感器的原理及應用研究[J].重慶師范大學學報,2009(26):101-105.
[3]楊勇.正余弦旋轉(zhuǎn)變壓器研究[J].湖南農(nóng)機,2014(9):51-54.
[4]舒望.基于光電編碼器的旋轉(zhuǎn)角度測量裝置的研究與設(shè)計[J].儀表技術(shù),2015(7):31-33.
[5]譚淑梅.簡析STM32單片機原理及硬件電路設(shè)計[J].大慶師范學院學報,2014(6):21-23.
[6]任君,徐超,李周奎,等.高清視頻VGA模擬差分信號的遠距離傳輸系統(tǒng)設(shè)計[J].光學技術(shù),2013(5):433-437.
[7]陶小春.磁柵位置檢測系統(tǒng)工作原理及結(jié)構(gòu)特點[J].煤礦機械,1998(3):33-34.
[8]姚慶安,鄭虹,等.基于FPGA和霍爾效應的高精度數(shù)字式角度測量系統(tǒng)[J].計算機測量與控制,2014(10):3144-3146.
[9]季漢川,楊文煥.一種新型霍爾角度傳感器的設(shè)計與分析[J].儀表技術(shù)與傳感器,2012(8):7-11.
[10]袁廣俊.位移變化量檢測在殼體焊縫自動定位中的應用[J].自動化系統(tǒng)與裝置,2015(7):105-107.
[11]葉愷.磁柵尺的建模與應用研究[D].武漢:武漢理工大學,2013.
[12]王曉剛,孟立新,石博程.基于磁柵尺的無實際轉(zhuǎn)軸傾斜臺轉(zhuǎn)角反饋測量[J].機械制造,2011(7):91-93.
[13]鄧宏貴,吳讓亮,施佳佳.數(shù)字角度傳感器在建筑角度測量儀中應用[J].傳感器技術(shù)學報,2010(8): 1206-1210.
[14]徐建華,楊瑞峰.基于AD2S83的角位移測量模塊設(shè)計[J].微計算機信息,2008(7):183-184.
[15]劉龍,郝萌,吳慶星,等.C++builder編程實現(xiàn)IXS系列X射線光機的控制[J].電腦知識與技術(shù),2015(11):60-62.
Design of angle measurement system based on magnetic grid displacement sensor
JIN Nan,CHENG Yuan-zeng,SUN Shu-ying
(Department of Electrical and Optical Engineering,Ordnance Engineering College,Shijiazhuang 050003,China)
A kind of angle measuring device based on magnetic grid displacement sensor is designed in order to improve the precision,the anti-interference ability and the reliability of servo system.This device is constructed with STM32F103 as its core and it adopts magnetic grid displacement sensor,which converts the displacement signal into two pulse signals with a phase difference.Pulse signal will be transferred to STM32F103 to count.Finally,the measurement of displacement is transformed into the angle,which will be displayed on computer by SCI.The experimental results show that this device has high reliability and measuring accuracy.
STM32;magnetic grid;angle measuring;signal acquisition
TN431.2
:A
:1674-6236(2017)08-0191-03
2016-04-12稿件編號:201604115
金 南(1991—),男,江蘇淮安人,碩士研究生。研究方向:控制科學與工程。