超聲波測(cè)距的模糊控制泊車(chē)系統(tǒng)模型設(shè)計(jì)＊

千承輝，苗紅松，付玉靜，康寧

（吉林大學(xué) 儀器科學(xué)與電氣工程學(xué)院，長(zhǎng)春130022）

引 言

近年來(lái)隨著經(jīng)濟(jì)的發(fā)展，擁有汽車(chē)的家庭越來(lái)越多，對(duì)于經(jīng)驗(yàn)不足的駕駛員來(lái)講，在擁擠的停車(chē)場(chǎng)、車(chē)庫(kù)以及路邊實(shí)現(xiàn)安全泊車(chē)的問(wèn)題越來(lái)越突出。自動(dòng)泊車(chē)系統(tǒng)[1-7]的出現(xiàn)提高了泊車(chē)過(guò)程的準(zhǔn)確度。相對(duì)于國(guó)外研發(fā)的自主泊車(chē)系統(tǒng)，目前國(guó)內(nèi)關(guān)于自動(dòng)泊車(chē)系統(tǒng)的研究仍處于初級(jí)階段，僅有少數(shù)的高檔轎車(chē)上才配有自動(dòng)泊車(chē)輔助系統(tǒng)[8]。設(shè)計(jì)泊車(chē)系統(tǒng)模型對(duì)泊車(chē)控制算法進(jìn)行驗(yàn)證，可以為真實(shí)車(chē)輛研發(fā)自動(dòng)泊車(chē)系統(tǒng)提供一定理論依據(jù)，促使自動(dòng)泊車(chē)系統(tǒng)代替駕駛員觀察并判斷，實(shí)現(xiàn)自動(dòng)泊車(chē)到位，從而減少泊車(chē)事故的發(fā)生。

1 原理與算法

1.1 超聲波測(cè)距原理

超聲波是頻率高于20 000 Hz的聲波，它指向性強(qiáng)，在介質(zhì)中傳播的距離較遠(yuǎn)，因而超聲波經(jīng)常用于距離的測(cè)量。利用超聲波檢測(cè)往往比較迅速、方便、計(jì)算簡(jiǎn)單、易于做到實(shí)時(shí)控制。通過(guò)超聲波發(fā)射裝置向某一方向發(fā)射超聲波，超聲波發(fā)射的同時(shí)開(kāi)啟計(jì)時(shí)器計(jì)時(shí)，超聲波在空氣中傳播，途中碰到障礙物就立即返回來(lái)，超聲波接收器收到反射波后立即停止計(jì)時(shí)。通過(guò)超聲波在空氣中傳播的速度v和計(jì)時(shí)器所記錄的時(shí)間t，利用公式

s＝v×t/2

就可以計(jì)算出發(fā)射點(diǎn)距障礙物的距離s。

本系統(tǒng)對(duì)測(cè)量精度要求較高，由于超聲波傳播的速度受溫度變化的影響較大，所以采用溫度補(bǔ)償?shù)姆椒▽?duì)溫度進(jìn)行校正。由下面計(jì)算公式得到：

其中：τ為攝氏溫度。

系統(tǒng)使用8個(gè)超聲波裝置分別放置在模型車(chē)四周組成環(huán)境測(cè)量裝置，可以對(duì)環(huán)境中車(chē)位精確定位以及由周?chē)h(huán)境獲取車(chē)身姿態(tài)角，保證了系統(tǒng)的可靠性。

1.2 運(yùn)動(dòng)模型建模

為了更加直觀、簡(jiǎn)便地求解自動(dòng)泊車(chē)這一特殊的行車(chē)過(guò)程，對(duì)模型小車(chē)建立車(chē)輛運(yùn)動(dòng)學(xué)模型，即把小車(chē)簡(jiǎn)化成一個(gè)矩形的剛體，建立基于阿克曼轉(zhuǎn)向幾何的小車(chē)運(yùn)動(dòng)學(xué)模型[9-11]。對(duì)于本文研究的小車(chē)模型，可將其簡(jiǎn)化為兩輪車(chē)模型，以車(chē)輛前后軸中點(diǎn)為參考來(lái)描述車(chē)輛的運(yùn)動(dòng)，建立的阿克曼轉(zhuǎn)向模型如圖1所示。

圖1 阿克曼轉(zhuǎn)向模型

圖中（xf，yf）、（xr，yr）分別表示車(chē)輛前、后軸中點(diǎn)坐標(biāo)；φ表示前輪轉(zhuǎn)角；θ表示車(chē)身航向角；l表示車(chē)輛軸距；vr表示后軸中心點(diǎn)速度，化簡(jiǎn)的車(chē)輛運(yùn)動(dòng)學(xué)方程組為：

由以上運(yùn)動(dòng)學(xué)方程組分析得：在低速運(yùn)動(dòng)下，模型車(chē)的后軸中心點(diǎn)運(yùn)動(dòng)軌跡為一個(gè)定圓，且該圓半徑僅與車(chē)輛前輪轉(zhuǎn)角φ有關(guān)。

設(shè)計(jì)中根據(jù)實(shí)際車(chē)輛大小，按比例設(shè)計(jì)小車(chē)模型及泊車(chē)環(huán)境，并且在Matlab/Simulink中建立阿克曼轉(zhuǎn)向模型，為下面的模糊控制器器設(shè)計(jì)提供了良好的理論依據(jù)。

1.3 自動(dòng)泊車(chē)模糊控制器設(shè)計(jì)

模糊控制是以模糊語(yǔ)言變量、模糊集合理論及模糊推理為基礎(chǔ)的一類(lèi)計(jì)算機(jī)控制方法，適合用于數(shù)學(xué)模型復(fù)雜的系統(tǒng)。模糊控制繼承了人類(lèi)對(duì)概念模式和思維圖像的自然語(yǔ)言習(xí)慣，相比其他傳統(tǒng)的控制方法，模糊控制在自動(dòng)泊車(chē)系統(tǒng)中的應(yīng)用更加廣泛[12]。自動(dòng)泊車(chē)模糊控制器[13-16]設(shè)計(jì)包括垂直泊車(chē)模糊控制器設(shè)計(jì)、平行泊車(chē)模糊控制器設(shè)計(jì)和斜行泊車(chē)模糊控制器設(shè)計(jì)，由于三種控制器設(shè)計(jì)方式類(lèi)似，本文以垂直泊車(chē)為例討論模糊控制器設(shè)計(jì)。本設(shè)計(jì)的模糊自動(dòng)泊車(chē)系統(tǒng)控制框圖如圖2所示。

圖2 模糊自動(dòng)泊車(chē)系統(tǒng)控制框圖

其中模糊化、模糊推理、模糊判斷和模糊規(guī)則4部分構(gòu)成模糊控制器。CPU主要通過(guò)以下3個(gè)步驟實(shí)現(xiàn)模糊控制：

①首先通過(guò)超聲波陣列獲取車(chē)輛后軸中心點(diǎn)坐標(biāo)（xr，yr）和車(chē)身航向角θ，將超聲波傳感器采樣到的數(shù)據(jù)進(jìn)行模糊化。

②根據(jù)模糊控制規(guī)則，結(jié)合駕駛員的實(shí)際泊車(chē)經(jīng)驗(yàn)推理計(jì)算出模糊控制量。

③對(duì)模糊控制量進(jìn)行判決，得出確切的輸出量給轉(zhuǎn)向舵機(jī)，控制模型車(chē)前輪轉(zhuǎn)向。

通過(guò)對(duì)上述模糊控制器進(jìn)行仿真分析，在實(shí)際運(yùn)行中適當(dāng)進(jìn)行調(diào)整，反復(fù)調(diào)試最終實(shí)現(xiàn)精確泊車(chē)控制。

2 硬件設(shè)計(jì)與仿真

本設(shè)計(jì)硬件電路主要包括飛思卡爾K60最小系統(tǒng)模塊設(shè)計(jì)、超聲波電路設(shè)計(jì)、轉(zhuǎn)向電機(jī)驅(qū)動(dòng)電路設(shè)計(jì)、直流電機(jī)驅(qū)動(dòng)電路設(shè)計(jì)、語(yǔ)音模塊電路設(shè)計(jì)。硬件系統(tǒng)電路框圖如圖3所示。

車(chē)輛駛過(guò)停車(chē)位置時(shí)，超聲傳感器的信號(hào)由控制器接收，從而識(shí)別并存儲(chǔ)車(chē)位的尺度信息，建立泊車(chē)區(qū)域的地圖。啟動(dòng)泊車(chē)系統(tǒng)，核心控制器控制舵機(jī)驅(qū)動(dòng)電路驅(qū)動(dòng)轉(zhuǎn)向舵機(jī)，由雙軸陀螺儀采集舵機(jī)轉(zhuǎn)角反饋到核心控制器，形成PID閉環(huán)控制，獲得精確的前輪轉(zhuǎn)角控制量φ。直流電機(jī)驅(qū)動(dòng)電路驅(qū)動(dòng)直流電機(jī)，由編碼器獲取當(dāng)前的速度反饋給核心控制器，行車(chē)第2個(gè)PID閉環(huán)控制，使車(chē)速平穩(wěn)，系統(tǒng)更加穩(wěn)定。泊車(chē)過(guò)程中，由攝像頭獲取倒車(chē)影像存儲(chǔ)到核心控制器K60的內(nèi)部DMA控制器中，最后顯示在顯示器上。當(dāng)發(fā)現(xiàn)合適停車(chē)位和泊車(chē)結(jié)束時(shí)，控制語(yǔ)音模塊進(jìn)行語(yǔ)音提醒，使系統(tǒng)更加智能化。

2.1 直流電機(jī)驅(qū)動(dòng)電路

圖3 硬件系統(tǒng)電路框圖

直流電機(jī)驅(qū)動(dòng)電路主要用來(lái)控制直流電機(jī)的轉(zhuǎn)動(dòng)方向和轉(zhuǎn)動(dòng)速度。可以通過(guò)改變直流電機(jī)兩端的電壓來(lái)控制電機(jī)的轉(zhuǎn)向；而控制直流電機(jī)的轉(zhuǎn)速則有不同的方案，常規(guī)的方法則是采用PWM控制。驅(qū)動(dòng)電路直接選用英飛凌大功率驅(qū)動(dòng)芯片BTS7960組成的全H橋驅(qū)動(dòng)模塊。BTS7960內(nèi)含電流檢測(cè)電路、控制驅(qū)動(dòng)電路，以及1個(gè)P型和1個(gè)N型MOSFET管，可以靈活應(yīng)用于2相或3相、直流有刷或無(wú)刷電機(jī)的控制驅(qū)動(dòng)電路中，不僅可以簡(jiǎn)化電路設(shè)計(jì)，而且使得控制更加簡(jiǎn)單。電機(jī)驅(qū)動(dòng)原理圖如圖4所示。

圖4 直流電機(jī)驅(qū)動(dòng)原理圖

2.2 電源電路

電源電路的穩(wěn)定性對(duì)系統(tǒng)的穩(wěn)定性起決定性的作用，電源電路為不同的模塊電路提供不同等級(jí)的電壓。本模型車(chē)設(shè)計(jì)需要3.3 V、5 V、12 V三個(gè)等級(jí)電壓。電源由12 V鋰離子電池提供。電源電路原理圖如圖5所示。

圖5 電源電路原理圖

系統(tǒng)采用LM1117芯片對(duì)12 V電壓降壓到3.3 V，為飛思卡爾單片機(jī)供電；串聯(lián)穩(wěn)壓芯片LM2940穩(wěn)壓，輸出5 V電壓，為CMOS攝像頭、超聲波模塊和液晶屏顯示器供電。舵機(jī)驅(qū)動(dòng)采用穩(wěn)壓可調(diào)芯片LM2596-ADJ穩(wěn)壓至5 V，接入舵機(jī)驅(qū)動(dòng)模塊，以驅(qū)動(dòng)舵機(jī)轉(zhuǎn)向舵機(jī)。

3 系統(tǒng)軟件設(shè)計(jì)

自動(dòng)泊車(chē)系統(tǒng)模型，啟動(dòng)自動(dòng)泊車(chē)系統(tǒng)后，選擇垂直、平行和斜行3種泊車(chē)方式，超聲波測(cè)距得到車(chē)輛后輪軸中心坐標(biāo)（xr，yr）和前輪轉(zhuǎn)角φ以及車(chē)身航向角θ，輸入模糊控制器中控制車(chē)輛倒車(chē)運(yùn)行狀態(tài)，實(shí)現(xiàn)自動(dòng)泊車(chē)。系統(tǒng)軟件流程圖如圖6所示。

圖6 系統(tǒng)軟件流程圖

自動(dòng)泊車(chē)系統(tǒng)啟動(dòng)泊車(chē)操作，由超聲波感知周?chē)h(huán)境信息，通過(guò)模糊控制實(shí)現(xiàn)泊車(chē)入庫(kù)，圖7為自動(dòng)泊車(chē)子系統(tǒng)流程圖。

圖7 自動(dòng)泊車(chē)子系統(tǒng)流程圖

4 測(cè)試與分析

本設(shè)計(jì)建立基于超聲波測(cè)距的模糊控制泊車(chē)系統(tǒng)模型，通過(guò)超聲波測(cè)量車(chē)輛模型后輪軸中心點(diǎn)坐標(biāo)作為泊車(chē)的起始位置，在Matlab Simulink建立車(chē)輛運(yùn)動(dòng)學(xué)模型和模糊控制器，并對(duì)自動(dòng)泊車(chē)過(guò)程進(jìn)行仿真，驗(yàn)證了模糊控制器設(shè)計(jì)的合理性和本設(shè)計(jì)的準(zhǔn)確性。其中Matlab Simulink仿真結(jié)果如圖8所示。

圖8 垂直泊車(chē)Matlab Simulink仿真結(jié)果

在軟件仿真的基礎(chǔ)上進(jìn)行硬件電路設(shè)計(jì)，同時(shí)以2個(gè)同等大小模型車(chē)作為參考車(chē)，兩紙盒中間按實(shí)際車(chē)庫(kù)比例預(yù)留空車(chē)位，由搭建好的模型進(jìn)行實(shí)際模型車(chē)測(cè)試，測(cè)試結(jié)果如表1所列。

表1 垂直泊車(chē)實(shí)測(cè)結(jié)果

由測(cè)試結(jié)果可以看出，模型車(chē)航向角控制在0～32°范圍內(nèi)，小車(chē)模型均可實(shí)現(xiàn)快速自動(dòng)泊車(chē)，泊車(chē)入庫(kù)精度高，系統(tǒng)穩(wěn)定性好。當(dāng)航向角大于32°時(shí)，由于車(chē)身傾斜造成超聲波傳感器對(duì)實(shí)際距離的檢測(cè)失去一定的準(zhǔn)確性，從而使模型車(chē)對(duì)車(chē)位以及自身所處位置造成誤判斷，最終導(dǎo)致泊車(chē)失敗。在進(jìn)行平行和斜行式泊車(chē)測(cè)試時(shí)，出現(xiàn)相同的情況。對(duì)超聲波模塊以不同角度斜面進(jìn)行距離測(cè)試，由測(cè)試結(jié)果可知，當(dāng)航向角大于32°時(shí)，由于超聲波測(cè)距造成的誤差使得自動(dòng)泊車(chē)系統(tǒng)造成車(chē)位誤判斷。

結(jié) 語(yǔ)

設(shè)計(jì)的自動(dòng)泊車(chē)系統(tǒng)，不僅能夠完成模型小車(chē)自動(dòng)尋找最小空車(chē)位，采用模糊控制法實(shí)現(xiàn)3種停車(chē)位的泊車(chē)，而且采用語(yǔ)音模塊實(shí)現(xiàn)語(yǔ)音提醒，以及在車(chē)載顯示屏上顯示倒車(chē)后面的路況信息，使實(shí)驗(yàn)室泊車(chē)系統(tǒng)模型設(shè)計(jì)更加人性化、智能化。

[1]林志杰.基于空間位置重構(gòu)的自動(dòng)泊車(chē)系統(tǒng)研究[D].北京：北京工業(yè)大學(xué)，2012.

[2]蔣志文，曾柿.基于雙目視覺(jué)和路徑規(guī)劃的車(chē)輛自動(dòng)泊車(chē)系統(tǒng)[J].公路與汽運(yùn)，2008（4）：19-315.

[3]宋金澤.自主泊車(chē)系統(tǒng)關(guān)鍵技術(shù)研究 [D].長(zhǎng)沙：國(guó)防科技大學(xué)，2009.

[4]何建國(guó)，張文勝，趙根莊.智能泊車(chē)引導(dǎo)方法的研究與實(shí)現(xiàn)[J].地理空間信息，2007，5（2）：3-5.

[5]付菊芳，張小龍，東亞斌.國(guó)外汽車(chē)自動(dòng)停車(chē)系統(tǒng)的介紹與分析[J].中國(guó)科技信息，2009（2）：26-259.

[6]何峰.一種應(yīng)用于自動(dòng)泊車(chē)系統(tǒng)的車(chē)位檢測(cè)方法[J].傳感器世界，2009，3（1）：24-27.

[7]楊昔陽(yáng)，尤晴曦，李洪興.基于變論域理論的自動(dòng)倒車(chē)控制[J].北京師范大學(xué)學(xué)報(bào)：自然科學(xué)版，2005，41（4）：348-350.

[8]孫博遜.基于超聲波測(cè)距的自動(dòng)泊車(chē)輔助系統(tǒng)[D].長(zhǎng)春：長(zhǎng)春理工大學(xué)，2011.

[9]姜輝，郭孔輝.自動(dòng)平行泊車(chē)系統(tǒng)轉(zhuǎn)向控制策略的研究[D].吉林：吉林大學(xué)，2010.

[10]吳冰.自動(dòng)泊車(chē)路徑仿真和運(yùn)動(dòng)控制研究[D].合肥：合肥工業(yè)大學(xué)，2012.

[11]周健.嵌入式模糊自動(dòng)泊車(chē)系統(tǒng)的研究[D].廣州：廣東工業(yè)大學(xué)，2011.

[12]于偉，張乃堯，白帆.泊車(chē)問(wèn)題的模糊優(yōu)化控制方案[J].機(jī)電一體化，2001（5）.

[13]常江.基于遺傳算法的模糊控制器設(shè)計(jì)及應(yīng)用[D].西安：西北工業(yè)大學(xué)，2006.

[14]雷英杰，張善文，李續(xù)武，等.MATLAB遺傳算法工具箱及應(yīng)用[M].西安：西安電子科技大學(xué)出版社，2005.

[15]孟惠霞，耿俊梅.基于MATLAB的模糊控制汽車(chē)倒車(chē)仿真系統(tǒng)[J].中原工學(xué)院學(xué)報(bào)，2009，20（1）：75-77.