自主式水下航行器舵機控制系統(tǒng)采樣校正

王 茜1, 嚴衛(wèi)生1, 2, 馮 凱1

?

自主式水下航行器舵機控制系統(tǒng)采樣校正

王 茜, 嚴衛(wèi)生, 馮 凱

(1. 西北工業(yè)大學航海學院, 陜西西安, 710072; 2. 水下信息處理與控制國家級重點實驗室, 陜西西安, 710072)

目前, 采用模擬電路處理數(shù)字轉(zhuǎn)換(A/D)采樣的誤差校正問題已比較成熟, 但這種方法實施起來相對困難, 且對于數(shù)字校正方面未有過實際驗證?；诖? 針對自主式水下航行器(AUV)舵機控制系統(tǒng)的采樣問題, 以AUV舵機控制系統(tǒng)為研究對象, 結(jié)合TMS320F2812芯片A/D采樣模塊的特性, 分析了采樣偏差產(chǎn)生的原因、過程及結(jié)果, 闡述了采樣-校正的原理, 并重點提出了圖形法和公式法2種誤差校正方法。其中, 圖形法比較分析了實際脈沖寬度調(diào)制(PWM)占空比與采樣理論值的差異, 并以圖形處理的方式進行校正; 公式法將理論公式與實際輸出相比較, 得出校正公式。試驗結(jié)果表明, 經(jīng)過內(nèi)部數(shù)字校正后的舵機控制系統(tǒng)具有良好的位置跟蹤性能, 控制精度完全滿足穩(wěn)態(tài)誤差設計要求。

自主式水下航行器; 舵機控制; 采樣; 誤差校正

0 引言

近年來, 自主水下航行器(autonomous underwater vehicle, AUV)已成為未來海洋開發(fā)利用和國家安全保障的重要工具, 在軍事和民用領(lǐng)域受到越來越廣泛的關(guān)注, 具有很大的科研和實用價值。

舵機控制系統(tǒng)是AUV控制系統(tǒng)的重要組成部分, 其本質(zhì)上是一個位置伺服系統(tǒng), 位置反饋的精確度決定著整個AUV舵機控制系統(tǒng)性能的好壞。舵機位置反饋以電壓信號為輸入, 包括反饋信號的模擬電路處理和數(shù)字信號處理(digital signal processing, DSP)的模擬到數(shù)字轉(zhuǎn)換(analog to digital, A/D)采樣2部分。文獻[3]采用高級精簡指令集機器(advanced RISC machines, ARM)內(nèi)核的LPC2119嵌入式微處理器為主控制器, 設計了舵機控制器。文獻[4]介紹了一種新的舵機控制系統(tǒng), 以控制器局域網(wǎng)絡(controller area network, CAN)總線為通信方式, 采用外圍硬件計數(shù)器產(chǎn)生脈沖寬度調(diào)制(pulse width modulation, PWM)控制信號。文獻[5]設計了一種基于AT89S52單片機的舵機控制系統(tǒng)。文獻[6]~文獻[8]也從不同方面對舵機控制系統(tǒng)進行了研究, 但是, 當前針對舵機控制系統(tǒng)采樣校正過程的研究很少。

本文以一種新型AUV舵機控制系統(tǒng)為研究對象, 運用TMS320F2812的模數(shù)變換器(analog to digital converter, ADC)模塊對采樣過程中遇到的采樣有效范圍、采樣真實曲線斜率和初值偏差等實際工程問題進行了深入研究。此舵機控制系統(tǒng)主要由CAN總線通信電路、舵機位置采樣信號處理電路、電機控制電路等外圍擴展電路構(gòu)成, 通過位置反饋組成閉環(huán)控制系統(tǒng), 達到精確控制舵機位置的目的。

1 舵機控制系統(tǒng)工作原理

整個AUV舵機控制系統(tǒng)的工作過程如下: 控制管理中心發(fā)出打舵指令(舵角的度數(shù), 其范圍為±15°), 經(jīng)CAN總線傳輸?shù)紻SP, DSP的A/D采樣模塊對模擬電路濾波、縮小后的位置反饋信號進行接收處理, 并與打舵指令數(shù)據(jù)進行比較產(chǎn)生偏差信號, 該信號經(jīng)比例積分(proportion-integral, PI)計算后產(chǎn)生適當?shù)腜WM信號, 最后經(jīng)過相應的隔離和邏輯處理電路, 將PWM信號施加到智能功率模塊(intelligent power module, IPM)搭建的H橋上, 進而完成對電機轉(zhuǎn)動位置的控制, 即完成對舵機舵角位置的控制。

2 A/D采樣及校正

2.1 A/D采樣過程

舵機控制系統(tǒng)中, DSP的A/D采樣是由DSP內(nèi)部的ADC采樣模塊來完成。該DSP的ADC模塊是一個12位16通道的模/數(shù)轉(zhuǎn)換器, 16個通道被分為2個8通道, 不僅可以實現(xiàn)對每個通道的順序采樣, 而且可以實現(xiàn)對2個通道的并發(fā)采樣, 但是必須分時進行數(shù)字量的轉(zhuǎn)換。ADC模塊的性能好壞具體表現(xiàn)在其所能提供的最大通道數(shù)、最小轉(zhuǎn)換速度、采樣的精度等方面, 而采樣的精度取決于DSP的A/D采樣的位數(shù)以及DSP的工作電壓。

DSP的ADC模塊有16個模擬量輸入通道, 模擬輸入電壓為0～3V, ADC工作在25 MHz時最高轉(zhuǎn)換速率為ADCLK或12.5 MHz。本系統(tǒng)舵機位置信號經(jīng)過運放處理后, 由±12V轉(zhuǎn)換為0～3V, 故完全可以滿足本系統(tǒng)設計要求。由于此ADC可以直接對0～3V電壓范圍采樣, 也可以經(jīng)過信號調(diào)理后對峰峰值不超過3V的雙極性模擬信號進行采樣。舵機位置信號的轉(zhuǎn)換結(jié)果將存儲到結(jié)果寄存器ADCRESULT中。

轉(zhuǎn)換后的理論數(shù)字量表示為

2.2 誤差校正原理

實際工作中, DSP內(nèi)部ADC轉(zhuǎn)換器存在各種誤差, 本文主要考慮失調(diào)誤差和增益誤差。

增益誤差和失調(diào)誤差的ADC轉(zhuǎn)換器的轉(zhuǎn)換方程

理想情況下, ADC模塊轉(zhuǎn)換方程

式中:為ADC采樣端口輸入電壓數(shù)值, 具體值為輸入電壓×4 095/3 V;為輸出計數(shù)值;為理想增益1.0000。

根據(jù)文獻[9], ADC的輸入電壓與輸出數(shù)值的理想曲線是一條經(jīng)過原點, 斜率為1的直線, 而實際曲線存在縱軸偏移量和斜率誤差(如圖1)。圖中, 增益誤差為輸出直線的斜率, 比理想斜率稍大; 失調(diào)誤差為輸出直線的截距, 理想情況下截距為0, 實際情況下為, 且大于0。

2.3 誤差校正參數(shù)計算

實際試驗中, 分別取-12 V, 0 V, 5 V作為電壓輸入值, 模擬舵機位置反饋信號的電壓。經(jīng)過模擬電路信號處理后, 在DSP的采樣輸入端口測量電壓值分別為-0.000 5 V, 1.483 V, 2.110 5 V。根據(jù)這3個不同的給定輸入電壓, 分別采集11組數(shù)據(jù)并計算其平均值, 如表1所示。

表1 3組實際測量值

由表1數(shù)據(jù)計算得到這條折線的2個實際增益值(斜率)和實際偏移量(截距)分別是=1.044,=14.07;=1.028,=46.46。

有了以上2組數(shù)據(jù), 便可對采樣的實際曲線進行分析。首先將2種斜率的采樣直線圖和理想曲線在圖2中畫出。圖2中, 起點到第1個星形點的直線及其延長線為和得到的直線; 由1個星形點為起點與另1個星形點相連的直線, 為和得到的直線; 理想狀態(tài)曲線是1條過零點的直線。由圖2可看到, 理想狀態(tài)和實際情況的存在偏差, 且偏差不是很大。隨著電壓的增加, 三者的偏差越來越大, 并在曲線的終端達到最大。終端部分的局部放大圖如圖3所示。

當達電壓最大時, 3條曲線的值分別為4 289, 4 255和4 094。實際曲線與理想曲線相差61, 化為角度偏差為0.447°, 大大超過了0.1°~0.2°的穩(wěn)態(tài)誤差設計要求, 更不用說控制系統(tǒng)本身設計可能存在的穩(wěn)態(tài)誤差。因此, 無論從理論上還是從實際中都需要對上述誤差進行糾正, 以符合控制過程對穩(wěn)態(tài)誤差的要求。

經(jīng)過研究并結(jié)合以上實測處理的3個數(shù)據(jù)點, 運用最簡單, 最實用的最小二乘法擬合了1條一次曲線。曲線如圖4所示。

由最小二乘法得到該直線的和的值分別為:=1.040 4,=15.094 0。

2.4 誤差校正方法

利用3組輸入輸出值求得了ADC模塊的校正增益和校正失調(diào), 然后再利用這2個值對采樣通道的轉(zhuǎn)換數(shù)據(jù)進行補償, 從而提高了ADC模塊轉(zhuǎn)換的準確度。具體計算方法有2種。

2.4.1 圖形法

在圖5中, 假設DSP結(jié)果寄存器中采得的數(shù)值為4095, 沿該點(3921, 4095)作垂直于軸的豎線, 與理想曲線(虛線)相交于點(3921, 3924), 則3924即為真實值。在實際模擬電路中, DSP采樣端的電壓計算為(3924/4095)*3=2.874V, 對應的舵角度數(shù)為13.75°。

這種方法較為直觀, 可作為分析處理的首選方法, 但是此方法不適合在線實時處理數(shù)據(jù)。

2.4.2 公式法

公式法計算過程簡便, 且能實現(xiàn)實時處理, 其主要推導過程如下。

由式(4)得

(5)

由式(5)得

由以上各式得

(7)

運用該公式進行編程過程中要注意各個參數(shù)的類型, 特別是浮點型和整型數(shù)據(jù)的區(qū)別, 否則容易丟失精度, 造成數(shù)據(jù)偏差和錯誤。

2.5 應用場景分析

在以上討論過程中不難發(fā)現(xiàn), DSP本身自帶的采樣存在著一些問題。

由圖5可知, 當采樣結(jié)果達到最大值4095時, 其真實值僅為3 924, 即DSP采樣端電壓為2.84V, 不能達到最大的3V, 所以采樣的有效區(qū)間為[0, 2.84]V, 對應本工程中的角度可控范圍為[-15, 13.75]°。這也是本文擬合曲線選取的3個點沒有采用12 V的原因。在實際工程設計中, 要特別注意這樣的問題, 給相關(guān)的控制量留下足夠的閾值。

3 舵機控制試驗結(jié)果

采用采樣校正后的數(shù)據(jù), 經(jīng)過相關(guān)的控制算法計算, 在最終調(diào)試中得到了良好的控制效果, 舵機控制系統(tǒng)的實際響應曲線如圖6所示。

由圖6看出, 舵機控制的實際響應時間為0.11 s, 控制精度完全滿足穩(wěn)態(tài)誤差[0.1, 0.2]°的設計要求。

4 結(jié)束語

本文以在實際工程過程中遇到的問題為出發(fā)點, 討論了AUV舵機控制系統(tǒng)的采樣校正問題。試驗結(jié)果表明, TMS320F2812控制芯片經(jīng)過內(nèi)部的數(shù)字校正后, 舵機控制系統(tǒng)具有良好的位置跟蹤性能, 且起動快速、穩(wěn)定。此校正方法的控制參數(shù)易于調(diào)整, 具有更好的實用性, 提高了系統(tǒng)的準確性和實時性。

[1] Marani G, Choi S, Yuh J. Underwater Autonomous Manipulation for Intervention Missions AUVs[J]. Ocean Engineering, 2009, 36(1): 15-23.

[2] Jun B, Park J, Lee F, et al. Development of the AUV ‘ISiMI’ and a Free Running Test in an Ocean Engineering Basin[J]. Ocean Engineering, 2009, 36(1): 2-14.

[3] 董荔寧, 嚴衛(wèi)生, 楊立. 基于ARM的自主水下航行器舵控制系統(tǒng)設計[J]. 微電機, 2006, 39(6): 71-73.Dong Li-ning, Yan Wei-sheng, Yang Li. The Deign of the Servo Controller of AUV Based on ARM[J]. Micromotors, 2006, 39(6): 71-73.

[4] 繩濤. 基于CAN總線的舵機控制系統(tǒng)設計[J]. 現(xiàn)代電子技術(shù), 2004, 24(191): 62-64.Sheng Tao. Control System Design Based on CAN Bus for Servo Motors[J]. Modern Electronics Technique, 2004, 24 (191): 62-64.

[5] 遠飛. 基于AT89S52單片機的舵機控制系統(tǒng)設計[J].電子元器件應用, 2011, 13(12): 26-28.

[6] 韓慶瑤, 洪草根, 朱曉光, 等. 基于AVR單片機的多舵機控制系統(tǒng)設計及仿真[J]. 計算機測量與控制, 2011, 19(2): 332-334, 349.Han Qing-yao, Hong Cao-gen, Zhu Xiao-guang, et al. Design and Simulation Of Multi-Servo Motor Control System Based on AVR Single Chip Microcomputer[J]. Computer Measurement & Control, 2011, 19(2): 332-334, 349.

[7] 張蓓蕾, 夏偉杰, 周建江. 基于RTX的舵機控制系統(tǒng)研制[J]. 電子科技, 2011, 24(11): 77-79.Zhang Bei-lei, Xia Wei-jie, Zhou Jian-jiang. Development of Control System for Steering Gear Based on RTX[J]. Electr- onic Science and Technology, 2011, 24(11): 77-79.

[8] 王迪, 嚴衛(wèi)生, 付江鋒. 模糊控制在AUV舵機控制系統(tǒng)中的應用[J]. 火力與指揮控制, 2009, 34(12): 163-165.Wang Di, Yan Wei-sheng, Fu Jiang-feng. Fuzzy-PID Control for the Rudder Control System of AUV[J]. Fire Control and Command Control, 2009, 34(12): 163-165.

[9] 孫麗明. TMS320F2812原理及其C語言程序開發(fā)[M]. 北京: 清華大學出版社, 2008.

(責任編輯: 楊力軍)

Sampling Correction of Steering Gear Control System for Autonomous Underwater Vehicle

WANG Qian, YAN Wei-sheng, FENG Kai

(College of Marine Engineering, Northwestern Polytechnical University, Xi′an 710072, China)

The error correction for analog-to-digital(A/D) sampling by analog circuit processing is relatively mature. But it is relatively difficult to be implemented. And the digital correction has not been actually verified. In this paper, aiming at the sampling problem of steering gear control system for an autonomous underwater vehicle(AUV), the reason, process and result of generating sampling deviation are analyzed by considering the characteristics of the A/D sampling module on a TMS320F2812 chip, and the principles of sampling correction are described. Accordingly, graphic method and formula method are proposed for the error correction. In graphic method, the difference between duty cycle of actual pulse width modulation(PWM) and theoretical sampling value are compared for error correction through a graphical way. In formula method the theoretical formula is compared with actual output to get correction formula. Experimental results show that the steering gear control system achieves a good position tracking performance through internal digital correction, and the control precision fully meets the design requirement of steady-state error.

autonomous underwater vehicle(AUV); steering gear control; sampling; error correction

TJ630.33; TP215

A

1673-1948(2013)03-0197-05

2012-12-27;

2013-01-31.

國家自然科學基金(509090082).

王 茜(1988-), 女, 碩士, 研究方向為計算機控制、智能控制、網(wǎng)絡控制、容錯控制.