馮賢超,趙祚喜,可欣榮,胡 煉
(1.鶴山市長安機動車檢測站 廣東 鶴山 529700;2.華南農業大學工程學院 南方農業機械與裝備關鍵技術教育部重點實驗室,廣東 廣州 510642)
汽車方向盤自由轉動量必須合適,過大會造成轉向不靈敏,過小會造成轉向過于靈敏容易造成失控。GB7258-2012《機動車運行安全技術條件》6.4規定:1)最大設計車速大于等于100 km/h的機動車應小于等于15°;2)三輪汽車應小于35°;3)其他機動車小于等于 25°[1]。目前方向盤自由轉動量測量方面主要通過編碼盤測量,如ZL-1L型設備等,這類測量儀體積大、安裝不便。文中旨在通過ADIS16300傳感器和cortex-M3處理器,設計一種輕便、高精度且低成本的汽車方向盤自由轉動量測量系統。
ADIS16300 MEMS傳感器是Analog Devices生產的三軸加速度計和單軸陀螺儀集成慣性測量元件,工作溫度范圍為-40~+85℃,工作電壓為 4.75~5.25 V。 可在±180°的全向范圍內精確測量俯仰角和滾動角。傳感器經過全面校準和測試,可保證三個軸高度對齊,并在整個運動范圍內實現0.1°的傾斜測量精度,且不受安裝方向的影響[2]。ADIS16300采用23 mm×31 mm×7.5 mm模塊封裝,結構簡單、安裝方便。
ADIS16300具有自校正功能,傳感器測量將原始信號經過校準和數字信號處理后存入輸出寄存器供外部器件經SPI接口讀取。每個采樣周期結束后,傳感器測量結果存放至輸出寄存器,并且DIO1引腳向器件外產生一個脈沖,表示一個完整的新慣性測量數據已經采集準備好,可供外部SPI主控器讀取。從SPI總線上讀取到的傳感器數據是二進制數據或二進制補碼形式的數據,需要進行解讀才能得到實際輸出數值。傳感器輸出的各個值代表的意義可在ADIS16300數據手冊中的Out Put Register Format查詢[2],并通過以下公式進行解算:

式中的DATA_Value為寄存器輸出的數據;Value為轉換后實際的測量量的值;Scale為寄存器值最小值代表的最小單位;n為對應寄存器的數據位數。
ADIS16300能夠測量包括Z軸的轉動角速度、XYZ三軸的加速度等運動參數。其測量傾角的基本原理是利用重力加速度與其在加速度傳感器測量軸上的加速度分量,通過三角函數關系,求得傳感器的傾斜角度。測量的前提條件是保證測量動作平緩,即不要讓ADIS16300受到運動加速度影響。
從圖1可以知道,當傳感器排放到如圖 1(a)所示位置時,X軸向加速度分量與重力加速度的關系為:


圖1 單軸測量方式Fig.1 Single axis measurement
式中的ax為重力加速度在X軸方向的加速度分量,1g重力加速度,由此可得出傾角為ax和重力加速度1g比值的反正弦,即:

由正弦曲線特性易知,單軸測量傾角的方法在-45°~45°之間具有良好的精度,但超過這個范圍之外的測量精度下降(正弦曲線斜率變?。覇屋S測量方式無法做到360°全范圍的傾角測量[5]。
在雙軸傾角測量方式中,采用兩個互相垂直的X/Y軸軸向加速度分量,且將傳感器保持在一個固定的平面上,如圖2(a)中位置。則根據X軸和Y軸方向的重力加速分量互相垂直的關系,得到式(4)的關系:


圖2 雙軸測量方式Fig.2 Biaxial measurement
式中的ax與ay分別為傳感器通過測量所得到的分量值,因而可以得到傳感器在XY平面的傾角為:

這樣,從式(5)得到雙軸傾角測量方式在360°范圍都可以得到比較高的測量精度 (需要根據二個測量分量確定象限),并且可以分辨全圓周內任何角度,從而解決測量過程中的翻轉問題。
如圖3(a)所示為方向盤坐標分析,因為汽車轉向系要求駕駛員在轉動方向盤時能有直觀連續的反饋和穩定的輸出,所以汽車方向盤會繞著固定角度的傳動軸Z軸轉動[7],在轉動過程中方向盤所在的XY平面與傳動軸始終保持垂直。
如圖3(b)示,根據方向盤的結構特點,方向盤自由轉動量可通過測量方向盤自由轉動過程中,到達左右極限點t1、t2時的方向盤轉動傾角 θ1和 θ2,再通過公式(6)計算得出方向盤自由轉動量θ:


圖3 方向盤自由轉動量測量分析Fig.3 Free rotation measurement analysis
系統通過ST公司的STMF103VBT6處理器與ADIS16300組建方向盤轉動量測量系統。其中STMF103VBT6是一款高性能低成本的32位cortex-M3內核微處理器,有豐富的外設功能,包括模/數轉換(DAC),串口通信(USART)、CAN總線和同步串行接口 (SPI)等[4],功能強大。
ADIS16300內置的SPI通信接口可以實現與STMF103 VBT6處理器硬件通信,硬件連接如圖4所示。

圖4 STMF103VBT6與ADIS16300的SPI總線連接圖Fig.4 The SPI bus connection diagram
方向盤自由轉動量測量系統能根據ADIS16300數據迸發模式[9],使處理器在連續的10個時鐘周期內通過ADIS16300的DOUT引腳讀取陀螺儀數據、XYZ軸數據和環境溫度等數據,并通過CAN總線通信協議把所有數據輸出上位機上顯示出來。
如圖5所示,程序啟動首先進入系統初始化,接著系統對ADIS16300寫工作指令,設置ADIS16300的工作模式,然后系統等待接收信號標志,通過SPI總線接收傳感器發出的原始數據并進行解讀出當前傾角值,最后通過CAN總線將處理后的數據發至上位機。

圖5 系統軟件流程框圖Fig.5 Flow chart the software design
選用經過標定的ZL-1L型方向盤轉動角度測量儀作為方向盤自由轉動量測量對照。實驗開始之前先對方向盤調中位,安裝好ZL-1L型設備于方向盤上,再將ZL-1L型設備與ADIS16300固定在同一平臺上,如圖6所示。

圖6 ZL-1L型設備與ADIS16300安裝實物圖Fig.6 ZL-1L and ADIS16300 installation
ADIS16300的XY平面與ZL-1L型設備的測量平面平行,ZL-1L型設備的測量轉動軸與ADIS16300的Z軸平行。使用ZL-1L型設備往左施加5個單位扭矩使得方向盤轉至左自由極限并記錄轉動角θ1,再往右施加5個單位扭矩使得方向盤轉至右自由極限并記錄轉動角θ2,按照公式(6)解算出方向盤的轉動量θ,將系統解讀的當前轉動量θ和ZL-1L型設備輸出數據的結果對比,如圖7(a)示。

圖7 方向盤轉動量測量系統輸出數據對比圖Fig.7 The measurement data comparison
從圖7(a)中可以看出,方向盤轉動量測量系統輸出的方向盤轉角測量值與ZL-1L型設備輸出轉動值趨勢基本吻合,其中通過ADIS16300求解出自由轉動量平均值為35.43°,ZL-1L型設備的均值為35.62°,但是ADIS16300輸出數據的波動較少。實驗中分別進行了多組數據的測量,普遍存在:均值和趨勢基本一致,但ZL-1L型設備輸出數據波動較大的情況。主要原因分析:ZL-1L型設備使用編碼盤作為角度測量傳感器,測量精度為±2°[8],本系統使用的ADIS16300傳感器通過測量重力加速度在XY軸分量求解角度的方式進行測量,這種方式測量精度相對較高,所以在靜態測量中結果波動相對較小。但方向盤轉動量測量系統輸出數據還是有一定的噪聲的,濾波處理可以得到更好的結果,ADIS16300內部有可編程的低通濾波器,可以方便地實現這一個功能,如圖(b)示。
本系統是在靜止狀態下測得的方向盤轉動量通過跟經標定的ZL-1L型設備進行對比,從數據上看是達到高精度測量的要求,而且結構相對更簡單,達到設計的目的。
通過ADIS16300內置的低通濾波器實現方向盤轉動量測量系統輸出數據的平滑化,數據輸出更加穩定。
[1]機動車運行安全技術條件.GB7258.[S]2012.
[2]AnalogDevices,INC.ADIS16300datasheet.(2009-04).http://www.analog.com/static/imported-files/data_sheet/Adis16300.pdf.
[3]陳永冰,鐘斌.慣性導航原理[M].北京:國防工業出版社,2007.
[4]STMicroelectronics,INC.STM32F103X6datasheet.[2004-11].http://www.st.com/stonline/products/literature/ds/13587.pdf.
[5]白占元,徐皚東.基于MEMS的傾角測量儀設計[J].儀器儀表學報,2007(8):16-18.BAI Zhan-yuan,XU Ai-dong.Design of tilt-meter based on MEMS[J].Chinese Journal of Scientific Instrument,2007(8):16-18.
[6]郝騫,馮敦超.基于MEMS傳感器技術的傾角測量儀設計[J].電子測試,2013(5):12-13.HAOQian,FENGDun-chao.Designoftiltmeasuringinstrument based on MEMS sensor technology[J].Electronic Test,2013(5):12-13.
[7]周一鳴主編.汽車拖拉機學:汽車拖拉機理論[M].北京:中國農業大學出版社,2000.
[8]淄博科創電子有限公司.ZL-1L型方向盤轉動角度測量儀說明書[S].2010.
[9]胡煉,趙祚喜.ADIS16300四自由度IMU在姿態測量中的應用[J].電子設計工程,2010(7):103-106.HU lian,ZHAO zuo-xi.4DoF IMU ADIS16300 and its application in attitude measurement[J].Electronic Design Engineering,2010(7):103-106.