基于模糊控制的自動泊車軌跡研究及仿真

李社蕾，張 瀟，周望月

(三亞學院 理工學院，海南 三亞 572022)

基于模糊控制的自動泊車軌跡研究及仿真

李社蕾，張 瀟，周望月

(三亞學院 理工學院，海南 三亞 572022)

平行泊車技術對駕駛人員來說是眾多駕駛技術中比較難掌握的一種，因為在泊車的過程中，一方面駕駛員的視線會受到一定程度的遮擋，另一方面，在倒車過程中駕駛員既要注意規避車輛后方的障礙物，同時又要注意車的左右兩邊不能蹭到障礙物，這對駕駛員，尤其是那些駕駛技術并不熟練的駕駛員來說，確實有一定的難度。研究了輔助平行泊車的路徑規劃問題，引導車輛從設定位置，根據指定的點和線的位置，改變方向盤的轉向無碰撞地泊車入位。針對車輛的平行泊車路徑規劃問題，借助于駕校教練的泊車經驗，提出了一種基于模糊控制的三段式的路徑規劃方法，進一步平滑化了泊車路徑。仿真結果驗證了該方法的有效性和實用性，為自動泊車路徑的規劃提供了參考。

平行泊車；模糊控制；路徑規劃；仿真

0 引 言

對于駕駛員來說，平行泊車技術是眾多駕駛技術中比較難掌握的一種。因為在泊車的過程中，一方面駕駛員的視線會受到一定程度的遮擋，另一方面，在倒車過程中駕駛員既要注意規避車輛后方的障礙物，同時又要注意車的左右兩邊不能蹭到障礙物，這對駕駛員，尤其是那些駕駛技術并不熟練的駕駛員來說，確實有一定的難度。但對于從來沒有操作過車的學員，在駕校根據教練講授的方法，給出的一些點和線，在點和線的位置做出相應的控制，經過幾個小時的訓練之后，只要車速控制好就能實現正確泊車，并且順利通過駕駛員考試。

借助于駕校教練的泊車經驗，事先將車停在指定位置，開始泊車。泊車過程分為，方向盤打滿右，回正和方向盤打滿左三個階段，其間根據一些點和線的位置來確定方向盤的轉向，然后加入模糊控制，實現平行泊車進入車位。

1 汽車動力學模型

汽車的轉向是由地面的側向力提供的向心力，只有當四個輪子的軸線交于一點時，才能保證各輪純滾動而不滑動。汽車設計時,為了避免汽車轉向時產生的路面對汽車行駛的附加阻力和輪胎的過快磨損,要求車輛的轉向系統能保證在汽車轉向時,所有汽車均作純滾動運動[1]。此交點O稱為轉向中心。方向盤轉角確定時車輛的轉彎半徑是不變的，因此只要知道車身的位置和車身的偏角，車輛的運動軌跡也就確定了[2]。車身上任意一點的軌跡均為一個標準圓,即后輪中心點的運行軌跡也是一個標準圓。

研究車輛行駛過程中的運動軌跡，建立車輛泊車過程的動力學模型[3-4]，車輛運動學模型如圖1所示。

圖1 車輛運動學模型

其中，(xr,yr)為后輪軸中心點的坐標；v為前軸中心點速度;l為前后輪軸距，即車輛前后輪軸中心點連線之間的距離;w為車身寬度；φ為前輪的Ackerman轉向角；θ為車輛中心軸與水平方向的夾角,即車身與x軸方向的夾角。在圖1所示的坐標系中，車輛的運動軌跡可以用(xr,yr,θ)表示，直接控制輸出量為φ。完成平行泊車時應有φ=0(或接近零度角)[5-8]。

由后軸中心點坐標(xr,yr),車輛車身四個頂點的坐標為[9-12]：

(1)

(2)

(3)

(4)

文中選擇一款轎車整車參數建立了汽車模型,該款車的部分參數為:車長4.3m,車寬1.735m,軸距2.465m,后懸0.944m,最小轉彎半徑5.2m。實際仿真過程中，取車長4.3m,車寬1.74m,軸距2.5m,后懸0.944m,最小轉彎半徑5.2m。

2 入庫過程路徑規劃

根據教練的經驗，平行泊車的步驟如下：

(1)將車停在車位和下一車位的后邊線對齊，與其外邊線的距離為0.5m左右。

(2)方向盤右打死，行駛到左側后視鏡看到泊車位的右后角位置；此時，由圖2可知：

(5)

(6)

其中,車位寬2.5m,車與車位間距0.5m,車寬1.74m,a=車位長(7m)+后懸長(0.944m)=7.944m；R為后軸外半徑。

由式(5)和式(6)可求得θ=36.316 8°。

(3)方向盤回正，行駛到左后車輪接近車位的外邊線。

(4)方向盤左打死，至車身與兩側邊線平行，回正車輪，停車。

整個泊車過程如圖2～4所示。

圖2 左側后視鏡看到泊車位的右后角位置

圖3 行駛到左后輪壓線的位置

3 平行泊車模糊控制器的設計

綜合控制精度和響應速度兩方面考慮,在保證控制精度的前提下[13-14],選取后輪中心點的坐標xr,yr以及θ為模糊控制器的輸入,deta_theta為模糊控制器的輸出量。設定輸入量x和y的模糊集合數都為4,S

圖4 方向盤左打死入庫回正

(小)、LB(較大)、B(大)、VB(非常大)；設定輸入量θ的模糊集合數為3,N(負)、Z(零)、P(正)；設定輸出量deta_theta的模糊集合數為7,NB(負大)、NM(負中)、NS(負小)、Z(零)、PS(正小)、PM(正中)、PB(正大)。x的范圍為[0,800]，y的范圍為[0，400]，θ的范圍為[-45°,45°]，輸出變量deta_theta的范圍為[-45°,45°]。

文中采用的隸屬度函數如圖5所示。

(a)輸入量y的隸屬度函數

(b)輸入量θ的隸屬度函數

(c)輸入量x的隸屬度函數

(d)輸出量deta_theta的隸屬度函數

表1是在總結教練的平行泊車經驗的基礎上建立的模糊規則(分析汽車在泊車位右側的情況)。當汽車x和y都為VB，還沒有進入停車位，如果θ為零，則保持車身方向不變，繼續到車，如果θ為負，則快速順時針轉動方向盤，如果θ為正，則穩定方向盤，繼續倒車；當x和y為B時，如果θ角為正，快速逆時針轉動方向盤，如果為θ零，則穩定方向盤，繼續倒車，如果θ角為負，快速順時針轉動方向盤；當x和y為LB，如果θ為零，快速逆時針轉動方向盤，如果θ為正，快速逆時針轉動方向盤，如果θ為負，則穩定方向盤，繼續倒車；當x和y為S時，如果θ為正，快速逆時針轉動方向盤，如果θ為負，則快速順時針轉動方向盤，如果θ為零，回正車輪停車，泊車成功。

表1 平行泊車模糊控制器的模糊規則集

4 仿真結果

車型選擇小轎車,車位長度為7m,車位寬度為2.5m,對車輛平行泊車的過程進行仿真。待泊車輛的車寬為1.74m,車長為4.3m,最小轉彎半徑為5.2m,車的起始位置與車位外邊線平行,距離用D1表示,車尾與前一車位的后邊線距離用D2表示(超過為正，未達到為負)。

根據汽車的運動學模型，在Matlab中搭建停車位、汽車等仿真環境，將模糊控制器引入該系統，模擬汽車以5km/h的車速的平行泊車過程。仿真結果如圖6所示。

圖6 泊車過程仿真

從圖6可以看到,在模糊控制下,如果將初始位置調整到距車位距離0.5～1.5m，車尾和下一車位的后邊線的前0.8m和后0.8m的范圍內，汽車都可以無摩擦地實現良好泊車，并擺正車身。經過對圖6分析可以發現，當D2為零時，D1越大，路面要求越寬；當D2為正且較大時，D1小于1m容易與車位內邊線摩擦；當D2為負且較大時，D1過小，容易與車位后邊線摩擦。

5 結束語

基于三段式泊車方法，進行輔助平行泊車路徑的規劃。從理論上驗證了方案的可行性，并加入模糊控制算法。仿真結果表明：汽車初始位置在一定范圍內，車位的長度大于車長的1.39倍，均可以實現無摩擦的良好泊車，可以擴展到不同車型和車位的情況，為智能泊車系統的開發提供了參考，同時為駕駛員控制泊車過程提供了理論依據。

[1] 陳家瑞.汽車構造下冊[M].第3版.北京：機械工業出版社，2009：248-249.

[2] 張 野，陳 慧，程昆朋.基于兩步法的平行泊車分段路徑規劃算法[J].計算機仿真，2013,30(6)：169-173.

[3] 林蓁蓁，李 慶，梁艷菊，等.一種基于路徑規劃的自動平行泊車算法[J].計算機應用研究,2012,29(5)：1713-1715.

[4] 劉 姣，葛召炎，謝 靜，等.停車場泊車問題的研究與仿真[J].計算機仿真,2011,28(7)：340-344.

[5] 曲 龍.基于MATLAB的自動泊車系統仿真研究[D].沈陽：沈陽理工大學，2013.

[6]ParomtchikIE,LaugierC.Autonomousparallelparkingofnonholonomicvehicle[C]//ProceedingsoftheIEEEintelligentvehiclesymposium.[s.l.]:IEEE,1996:3117-3122.

[7] 張 勤,曲寧璽,李 艷,等.自動泊車軌跡生成方法的研究[J].計算機仿真，2010，27(10):148-151.

[8]KimD，ChungW,ParkS．Practicalmotionplanningforcar-parkingcontrolinnarrowenvironment[J]．IETControlTheory&Applications，2010，4(1):129-139．

[9] 侯曉陽.基于路徑規劃的平行泊車系統研究[D].北京：清華大學，2015.

[10] 孫 思.自動垂直泊車系統轉向控制策略的研究[D].北京：清華大學，2015.

[11] 宋金澤.自主泊車系統關鍵技術研究[D].長沙:國防科學技術大學,2009.

[12] 張嘯塵.基于計算機視覺的車位檢測與倒車輔助算法的研究與實現[D].沈陽：東北大學，2011.

[13] 秦緒情.自動平行泊車系統定車速模糊控制算法研究[D].長春:吉林大學,2007.

[14] 郭孔輝，姜 輝，張建偉，等.基于模糊邏輯的自動平行泊車轉向控制器[J].吉林大學學報:工學版，2009,39(S2)：236-240.

Simulation and Study of Automatic Parallel Parking Path Based on Fuzzy Control

LI She-lei，ZHANG Xiao，ZHOU Wang-yue

(Polytechnical School of Sanya College,Sanya 572022,China)

Parallel parking skill for driver is difficult to master.Because in the process of parking,the driver’s line of sight will be blocked by a certain degree.On the other hand,in the process of reversing,the driver should not only pay attention to avoid the obstacles in the rear of the vehicle,and at the same time,attention should be paid to the right and left sides of the car can’t touch the obstacles.The drivers,especially those unskilled,do have some difficulty.The path planning problem of auxiliary parallel parking is studied,which is to guide the vehicle from the set position,according to the location of specified point and line,turning the steering wheel and parking into the place without collision.With the help of parking experience for the driving coaches,a three-step path planning method is proposed based on fuzzy control,further smoothing the parking path.The simulation results demonstrate the validity and practicality of the proposed method,and provide a reference for the automatic parking path planning.

parallel parking;fuzzy control;path planning;simulation

2015-10-26

2016-03-03

時間：2017-01-10

海南省大學生創新創業訓練計劃項目(201513892009)

李社蕾(1979-)，女，講師，碩士研究生，研究方向為智能算法。

http://www.cnki.net/kcms/detail/61.1450.TP.20170110.1010.034.html

TP391.9

A

1673-629X(2017)02-0163-04

10.3969/j.issn.1673-629X.2017.02.037