智能小車的設計與制作

1、    智能小車的設計與制作    張凱杰【摘 要】智能小車以freescale半導體公司生產(chǎn)的16位hcs12單片機為核心控制器，采用紅外式光電管對比賽賽道進行掃描和檢測，提取出賽道上黑線位置的信息。同時，智能小車通過測速裝置獲取當前速度，并利用pid反饋對舵機進行調(diào)節(jié)，最終使小車達到可以自動尋跡的效果，提高小車的行駛速度和穩(wěn)定性?！娟P 鍵 詞】智能車，hcs12單片機， pid控制f407.471a1672-5158（2013）07-0205-02一 前言智能運輸系統(tǒng)作為未來交通發(fā)展趨勢之一，為解決城市交通擁擠和堵塞問題提供了有效途徑。從八十年代以來

2、，美國、日本、歐洲等發(fā)達國家和地區(qū)競相投入巨額資金和大量人力，開始大規(guī)模的進行交通運輸智能化的研究，取得了許多重要成果。而作為智能車路系統(tǒng)（intelligent vehiclehighway systems，簡稱ivhs）的重要一部份，智能車在世界各國的研究也隨著計算機技術、網(wǎng)絡技術、通訊技術的飛速發(fā)展而不斷深入。本文以“飛思卡爾”杯全國大學生智能汽車競賽為背景，對智能車控制系統(tǒng)進行了深入的討論，以作者參與制作的智能模型車為例簡要介紹了智能模型車的設計制作全過程，主要涉及到機械電子、傳感器技術、驅(qū)動控制技術、自動控制、人工智能等多個領域的研究及技術融合。本設計通過采用hcs12單片機為控制核

3、心，實現(xiàn)對小車的智能控制。該控制系統(tǒng)不僅在現(xiàn)代汽車產(chǎn)業(yè)中有很大使用價值，在智能機器人領域亦有很大用途，尤其是當今時代機器人研究方面具有很好的發(fā)展前景，故本設計與實際聯(lián)系緊密，具有重要的現(xiàn)實意義。二 總體設計分析（1） 設計要求：在本次競賽中，要求所設計的小車具有自動尋跡的功能，能在指跑道上高速，穩(wěn)定地運行。跑道為黑白兩色。其背景色為白色，跑道中央有一條黑線作為小車行進的依據(jù)。很明顯，我們要設計的小車是要能沿黑線的正常行駛，并在此基礎上，盡量提高小車行駛速度。（2）傳感器部分：在傳感器方案的選擇中， 智能小車采用光電傳感器來采集路面信息。使用紅外傳感器最大的優(yōu)點就是結(jié)構簡明，實現(xiàn)方便，成本低廉，

4、免去了繁復的圖像處理工作，反應靈敏，響應時間低，便于近距離路面情況的檢測。但紅外傳感器的缺點是，它所獲取的信息是不完全的，只能對路面情況作簡單的黑白判別，檢測距離有限，而且容易受到諸多擾動的影響，抗干擾能力較差，背景光源，器件之間的差異，傳感器高度位置的差異等都將對其造成干擾。在本次比賽中，賽道只有黑白兩種顏色，小車只要能區(qū)分黑白兩色就可以。采集到準確的路面信息。經(jīng)過綜合考慮，在本項目中采用紅外光電傳感器作為信息采集元件。（3） 控制算法部分：在小車的運行中，主要有方向和速度的控制，即舵機和電機的控制，這兩個控制是系統(tǒng)軟件的核心操作，對小車的性能有著決定性的作用。對舵機的控制，要達到的目的就是

5、：在任何情況下，總能給舵機一個合適的偏移量，保證小車能始終連貫地沿黑線以最少距離行駛。小車在比賽中采用了pid控制技術。pid控制在比例控制的基礎上加入了積分和微分控制，可以抑制振蕩，加快收斂速度，調(diào)節(jié)適當?shù)膮?shù)可以有效地解決方案一的不足。不過，p，i，d三個參數(shù)的設定較難，需要不斷進行調(diào)試，憑經(jīng)驗來設定，因此其適應性較差。在我們的選擇中，根據(jù)比賽規(guī)則，賽道模型與相關參數(shù)已給定，即小車運行的環(huán)境基本上已經(jīng)確定，可通過不斷調(diào)試來獲得最優(yōu)的參數(shù)。因此我們選用的是pid算法來對舵機進行控制。對驅(qū)動電機的控制（即速度控制），要達到的目的就是在行駛過程中，小車要有最有效的加速和減速機制。高效的加速算法使

6、小車能在直道上高速行駛，而快速減速則保證了小車運行的穩(wěn)定，流暢。為了精確控制速度，時時對速度進行監(jiān)控，我們還引入了閉環(huán)控制的思想，在硬件設計，增加了速度傳感器實時采集速度信息。（4） 車模外觀（見圖1）三 硬件設計（1）電源管理電路：系統(tǒng)由6節(jié)1.2v鎳鎘充電電池組成電池組。穩(wěn)定的電源是整個系統(tǒng)的關鍵，所以在電源設計的時候必須考慮穩(wěn)壓芯片的效率以及各個模塊之間的影響，采取必要的隔離措施處理互相干擾。本系統(tǒng)采用了2片5v穩(wěn)壓芯片l m2575分別給系統(tǒng)芯片和紅外探測器供電。一片6 v穩(wěn)壓芯片l m1117給舵機供電，7.2 v電源可以直接給電機供電。（2）紅外探測電路：10對反射式紅外傳感器探測

7、到的信息直接輸入到mc9 s12d g128b的10個a/d 通道。該紅外測試電路的有效測試距離可達20cm。小車在運動中不斷的掃描跑道，當發(fā)射管d1掃描到黑線的時候 ，發(fā)出的信號幾乎全被黑線吸收，幾乎沒有反射信號，接收管 d2接收不到信號，此時d2不導通 ，輸出端輸出高電平發(fā)光管d3不發(fā)光；當發(fā)射管 d1 掃描到白色跑道的時候，發(fā)出的信號幾乎全被反射回來，接收管 d2接收到發(fā)射管d1發(fā)射出經(jīng)反射物反射的信號，輸出端out（l m576 的第8腳） 輸出低電平使發(fā)光管d3發(fā)光 。通過發(fā)光二極管的熄滅可以確定小車是否在跑道上，為調(diào)試帶來很大的方便 。本電路的最大持點是紅外線發(fā)射部分不設專門的信號

8、發(fā)生電路，而是直接從接收部分的檢測電路lm576的5 腳引入信號，這樣既簡化了線路和調(diào)試工作 ，又防止了周圍環(huán)境變化和元件參數(shù)變化對收發(fā)頻率造成的差異 ，實現(xiàn)了紅外線發(fā)射與接收工作頻率的同步自動跟蹤，使電路的穩(wěn)定性和抗干擾能力大大加強 。 輸出信號通過數(shù)字濾波后進入mcu中的14路a/d通道采集路況信息。在實際的測試中，可以在獨立的的紅外接收管上安裝黑色套管可以完全避免相鄰發(fā)光管的影響 。由于紅外探測部分耗電量比較大 ，可以利用紅外接收管響應速度快的特點，讓紅外發(fā)射管只在檢測瞬間發(fā)射紅外線即可 。 紅外發(fā)射管工作在周期窄脈沖方式下，大大降低了平均工作電流，從而降低了整個發(fā)射電路的電量消耗。（3

9、）電機驅(qū)動電路：（見圖2）電路圖我們（見圖3）可以看出，它具有兩個半橋構成：由于在實際的比賽過程中，我們已經(jīng)利用剎車裝置進行減速，并不需要通過給電機加反向電壓來減速（在調(diào)試過程中，曾經(jīng)試過用這種的方法進行減速，但是弊大于利，有時會由于電機反轉(zhuǎn)，出現(xiàn)倒車現(xiàn)象）因此，可以只使用其半橋，并將兩個半橋并聯(lián)，以增大其驅(qū)動能力。（4）傳感器電路：接收發(fā)射部份（見圖4）傳感器由兩部份構成，一部份為發(fā)射部份，一部分為接收部份。發(fā)射部份由一個振蕩管（j1_1）發(fā)出180khz頻率的振蕩波后，經(jīng)三級管（q1_1npn）放大，激光管（d1_1）放射。接收部份由一個相匹配180khz的接收管（j1_2）接收返回的光強

10、，經(jīng)過電容（c1_1）濾波后直接接入單片機用以判別電壓高低。由于接收的波屬于較高頻段的波，因此電容（c1_1）是必須的，否則的話電磁干擾會非常的嚴重，指示燈（d1_1）會常亮，實際過程中要不斷試電容（c1_1）的大小，選擇合適的值以使接收管正常工作?？刂撇糠荩海ㄒ妶D5）由于采用了數(shù)字傳感器的防干擾算法，因此必須分時控制傳感器的開斷，實際中我們使用74ls138作為控制器，由主控模塊的3根線來控制傳感器的開斷。（5）pcb設計圖：傳感器pcb圖；（見圖6） 主控板pcb圖：（見圖7）四 軟件設計（1）開發(fā)環(huán)境介紹：本系統(tǒng)使用了 metrowerks 公司提供的 codewarrior for h

11、cs12教學用版本，它是面向以 hc12 或 s12 為 cpu 的單片機嵌入式應用開發(fā)的軟件包，包括集成開發(fā)環(huán)境 ide、處理專家?guī)欤酒抡?、c 交叉編譯器、匯編器、鏈接器以及 bdm 調(diào)試器。（2）軟件結(jié)構軟件主要包括：路徑識別、方向控制、速度測量、速度控制等四個模塊。軟件流程可分為以下幾部分：初始化、得到 ad 轉(zhuǎn)換數(shù)據(jù)并轉(zhuǎn)換為角度偏差、根據(jù)角度偏差控制舵機、根據(jù)角度偏差和當前速度控制電機轉(zhuǎn)速和制動。軟件結(jié)構框圖見圖8。（3）pid控制：pid控制器是控制系統(tǒng)中技術比較成熟，而且應用最廣泛的一種控制器。它的結(jié)構簡單，參數(shù)容易調(diào)整，因此在工業(yè)的各個領域中都有應用。pid最先出現(xiàn)在模擬控

12、制系統(tǒng)中，傳統(tǒng)的模擬pid控制器是通過硬件（電子元件、氣動和液壓元件）來實現(xiàn)它的功能的。隨著計算機的出現(xiàn)，把它移植到計算機控制系統(tǒng)中來，將原來的硬件實現(xiàn)的功能用軟件代替，從而形成數(shù)字pid控制器，其算法則稱為數(shù)字pid算法。數(shù)字pid控制器具有非常強的靈活性，可以根據(jù)試驗和經(jīng)驗在線調(diào)整參數(shù)，因此可以得到更好的控制性能。由于幾乎所有的單片機都擁有硬件pwm，因此基于軟件pid和硬件pwm技術的直流電機測控技術正向數(shù)字化、高可靠性發(fā)展，本文所述的舵機控制就是采用該控制方法。數(shù)字pid分為位置式控制算法和增量式控制算法。為了降低計算量及得到穩(wěn)定的結(jié)果，舵機控制采用增量式控制算法。其公式如下： uk=

13、kp*ek-ek-1+ki*ek+kd*ek-2ek-1+ek-2輸出增量uk只與本次偏差ek、上次偏差ek上上次偏差ek-2有關，因此cpu只要知道每一時刻的ek、ek-1、ek-2的值就能執(zhí)行pid算式，并輸出舵機控制量，從而有效地控制舵機的轉(zhuǎn)向。由于pid控制器是用軟件來實現(xiàn)的，靈活性很大，因此能夠根據(jù)具體要求相應地改進部分pid控制算法。在電動機控制系統(tǒng)中，控制量的輸出值要受到元器件或執(zhí)行機構性能的約束（如電源電壓的限制、放大器飽和等），因此它的變化應在有限的范圍內(nèi)，如果控制量的計算結(jié)果超出該范圍，那么實際執(zhí)行的控制量就不再是計算值了，產(chǎn)生的結(jié)果與預期的不相符，稱為飽和效應。pid控制

14、中的積分環(huán)節(jié)目的是消除靜態(tài)誤差，提高控制精度。但當電動機的啟動或停車時，短時間內(nèi)系統(tǒng)輸出很大的偏差，會使積分積累很大，從而引起強烈的積分飽和效應，這將會造成系統(tǒng)振蕩，調(diào)節(jié)時間延長等不利結(jié)果。在本文所述的智能車中，為了避免出現(xiàn)積分飽和現(xiàn)象，對pid控制器的積分環(huán)節(jié)做了兩個改進：積分分離法和遇限削弱積分法。積分分離法的思路是：當被控量與給定值的偏差較大時，去掉積分，以避免積分飽和效應的產(chǎn)生；當被控量與給定值比較接近時。重新引入積分，發(fā)揮積分的作用，消除靜態(tài)誤差，從而既保證了控制的精度又避免了振蕩的產(chǎn)生。本文所述的具體實現(xiàn)是：人為引入一個量x=24.44，x值的確定大約為智能車的三個光電對管對應反饋

15、值的偏差，即當偏差小于24.44則引入積分環(huán)節(jié)，當偏差大于等于24.44則去掉積分環(huán)節(jié)。為此在積分項中乘以一個人為引入的系數(shù)b.其公式如下：b=1，ek< p>b=0， ekx， x=24.44引入b后，可建立公式：uk=kp*ek-ek-1+b*ki*ek+kd*ek-2ek-1+ek-2遇限削弱積分法的思路是：一旦控制量仉進入飽和區(qū)，便停止進行增大積分項的運算，而只進行使積分減少（即所謂削弱）的運算。具體過程是：在根據(jù)pid算式計算uk前，先判斷前一次的控制量uk-1是否到達極限范圍，如果到達極限說明已經(jīng)進入飽和區(qū)，這時再根據(jù)偏差的正負，來判斷控制量是使系統(tǒng)加大超調(diào)還是減小超調(diào)

16、，如果是減小超調(diào)，則保留積分項，否則取消積分項。遇限削弱法在進入極限范圍后，有條件的去繼續(xù)積分或取消積分，從而避免控制量長時間停留在飽和區(qū)。本系統(tǒng)的具體實現(xiàn)是：在積分項中再人為引入一個系數(shù)c當判斷后需要保留積分項則c=1；否則c=0。那么最終的舵機pid控制算式如下：uk=kp*ek-ek-1+b*c*ki*ek+kd*ek-2ek-1+ek-2間接pid驅(qū)動電機控制算法簡介：智能車模型的驅(qū)動電機是直流電機，同樣可以直接用pid控制算法，但是利用pid算法需要有系統(tǒng)的直接反饋值，如舵機算法中的反饋值通過光電傳感檢測獲得，而驅(qū)動電機要想直接獲得反饋值必須在硬件上設計車速傳感器，這必然給硬件選擇、

17、硬件設計、pcb板設計、軟件實現(xiàn)帶來比較大的工作量；同時加上車速傳感器之后智能車的重量也會增加，這樣會增加驅(qū)動電機的負載，耗電速度快；同時智能車過重也會給舵機的轉(zhuǎn)向帶來負面影響，因為連接舵機和連桿的硬件是塑料做的東西，而且是兩三個塑料卡在一起的，當智能車要轉(zhuǎn)彎時，舵機轉(zhuǎn)動的力是一定的，如果車身太重的話那么舵機轉(zhuǎn)彎的力就會帶不動前輪，而使這些力消耗在這幾塊塑料上，時間長了這些力就會使塑料變形，破壞車的硬件結(jié)構，影響車的性能，給車的行駛帶來不穩(wěn)定性和不可靠性。然而加上車速傳感器之后又能給驅(qū)動電機帶來直接的控制，能比較有效、及時地改變驅(qū)動電機的轉(zhuǎn)速，為智能車行駛提供比較好的參考。本文所述的驅(qū)動電機間

18、接pid控制算法的思想是：把舵機的pid控制算法的輸出控制量當作驅(qū)動電機的控制算法的輸入量，經(jīng)過一定的算法之后，輸出量做為驅(qū)動電機的輸出控制量，從而實現(xiàn)驅(qū)動電機的間接pid控制算法。舵機的輸出控制量為uk的公式為：uk=uk+uk-1其中uk玩為舵機輸出控制量的增量，uk-1為舵機前一次的輸出控制量。把uk作為驅(qū)動電機的輸入量。設驅(qū)動電機的輸出控制量為m， 其公式如下：m=（sv-brv4）*uk+br4+sv， uk0m=（sv-blv4）*uk+bl4+sv， uk>0常量c為當智能車在直線上行駛時驅(qū)動電機的控制量，常量brv4為當智能車在最大右轉(zhuǎn)行駛時驅(qū)動電機的控制量。常量br4為當智能車在最大右轉(zhuǎn)行駛時舵機的理論控制值，常量blv4為當智能車在最大左轉(zhuǎn)行駛時驅(qū)動電機的控制量，常量bl4為當智能車在最大左轉(zhuǎn)行駛時機的理論