馮欣陽，李春書，唐風(fēng)敏

河北工業(yè)大學(xué) 機(jī)械工程學(xué)院，天津 300401

隨著我國汽車保有量的增加，一些問題也隨之顯現(xiàn)，泊車可用空間的減小便是其中之一。狹小車位環(huán)境下的泊車需要豐富的駕駛經(jīng)驗(yàn)及嫻熟的駕駛技術(shù)，無形之中增加了駕駛?cè)藛T的操作難度和操作體驗(yàn)。目前，智能車輛的自動泊車研究是許多研究者們關(guān)注的問題之一[1-3]。自動泊車包括環(huán)境感知、泊車控制、人機(jī)交互等技術(shù)。

泊車控制主要有兩種方法：人工智能方法和運(yùn)動狀態(tài)規(guī)劃及軌跡跟蹤。人工智能方法通過智能算法使控制器在泊車過程中模擬駕駛員的操作行為[3]。文獻(xiàn)[4-9]通過蟻群算法、神經(jīng)網(wǎng)絡(luò)、模糊控制等智能算法，實(shí)現(xiàn)泊車操作；由于實(shí)際泊車環(huán)境的復(fù)雜性，駕駛員需要面對不同的泊車環(huán)境做出不同反應(yīng)，增加了人工智能方法的實(shí)現(xiàn)難度。一些研究者提出基于路徑規(guī)劃及路徑跟蹤的泊車控制方法[10-18]。研究者們對于泊車路徑規(guī)劃的研究大多采用曲線組合或多項(xiàng)式插值的方式[11-14]。此外，有些研究者也采用貝塞爾曲線、B樣條曲線設(shè)計(jì)泊車路徑[15-16]。路徑跟蹤采用滑?？刂啤⒆赃m應(yīng)控制、模型預(yù)測控制等多種跟蹤控制方法[12-18]。

上述泊車路徑規(guī)劃的研究均是針對一次泊入到位路徑進(jìn)行設(shè)計(jì)實(shí)現(xiàn)泊車的；若車位長度較小，不能實(shí)現(xiàn)一次泊入到位，車輛需要在車位內(nèi)進(jìn)行位姿調(diào)整。為方便描述，將需要在車位內(nèi)進(jìn)行位姿調(diào)整的車位稱為小車位。目前，一些研究者已針對小車位環(huán)境自動泊車的路徑規(guī)劃進(jìn)行研究。文獻(xiàn)[19]通過建立預(yù)定義模態(tài)集，采用遍歷策略，計(jì)算最優(yōu)參數(shù)，對泊入段、調(diào)整段路徑進(jìn)行規(guī)劃；但模態(tài)集的建立需要考慮多種情況，計(jì)算量較大。文獻(xiàn)[20]通過B 樣條曲線建立泊入路徑及調(diào)整路徑；該調(diào)整路徑曲率連續(xù)，但是B樣條曲線復(fù)雜程度高，求解過程較為困難。文獻(xiàn)[21]根據(jù)車位長度及車輛當(dāng)前航向角，通過多次揉庫，實(shí)現(xiàn)狹小車位內(nèi)的姿態(tài)調(diào)整；該方法耗時(shí)長、計(jì)算成本高。文獻(xiàn)[22]通過三段式路徑規(guī)劃實(shí)現(xiàn)平行車位內(nèi)的位姿調(diào)整；調(diào)整路徑通過前進(jìn)圓弧路段實(shí)現(xiàn)位姿調(diào)整，但該方法在換向時(shí)，曲率不連續(xù)且所需車位較大。文獻(xiàn)[23]利用曲線組合設(shè)計(jì)了泊入路徑和調(diào)整路徑，采用相切圓弧實(shí)現(xiàn)車位內(nèi)的倒車位姿調(diào)整，其調(diào)整路徑存在曲率突變的不足。

為使泊車路徑曲率連續(xù)無突變且計(jì)算方便，利用回旋曲線曲率連續(xù)的特點(diǎn)，將回旋曲線、直線、圓弧曲線組合設(shè)計(jì)形成平滑的泊入段路徑和調(diào)整段路徑；在非時(shí)間參考變量的前提下結(jié)合滑?？刂圃恚O(shè)計(jì)路徑跟蹤控制器，實(shí)現(xiàn)泊車路徑的跟蹤控制。

1 平行車位泊車路徑規(guī)劃

1.1 小車位環(huán)境及路徑分析

當(dāng)車輛側(cè)向泊入平行車位時(shí)，停泊時(shí)的標(biāo)準(zhǔn)位姿通常如參考文獻(xiàn)[24]所描述的狀態(tài)，如圖1所示。ab和dc分別代表車輛前端和后端；Lf、L、Lr、Wa分別代表前懸、軸距、后懸、車寬；Lp、Wp分別代表車位的長度與寬度；Db、Dr分別代表車輛后端、右端與車位障礙物邊界之間的安全距離。

圖1 車輛泊車位姿示意圖Fig.1 Diagram of vehicle standard position and pose

如圖2 所示，建立大地坐標(biāo)系OXY，O為固定原點(diǎn)，障礙物邊界點(diǎn)A與原點(diǎn)O重合，泊車初始位姿如圖2 中I 位置所示，車輛的初始位置、初始航向角分別為C1、θ0，選擇車輛后軸的中心點(diǎn)作為路徑跟蹤的參考點(diǎn)。

圖2 小車位下的泊入路徑Fig.2 Parking path under small parking space

泊入路徑由回旋曲線C1-C2、圓弧曲線C2-C3、回旋曲線C3-C4、直線C4-C5、回旋曲線C5-C6、圓弧曲線C6-P組成；車輛的極限位置為圖2中III位置所示。

調(diào)整路徑由前進(jìn)路段和后退路段組成，前進(jìn)路段由回旋曲線P-P1、回旋曲線P1-P2、圓弧曲線P2-P3、回旋曲線P3-P4、回旋曲線P4-P5、圓弧曲線P5-P6、回旋曲線P6-P7組成；P-P1、P1-P2為兩段反向回旋曲線，P3-P4、P4-P5為兩段反向回旋曲線；后退路段由直線P7-P8組成；調(diào)整路徑如圖3所示。

圖3 小車位內(nèi)調(diào)整路徑Fig.3 Adjust path in small parking space

設(shè)Rmin為車輛最小轉(zhuǎn)彎半徑，泊車路徑的最大曲率不超過ρmax=1Rmin；在泊車過程中為避免車身與障礙物發(fā)生碰撞，需要滿足以下條件：（1）泊入階段，車輛右前頂點(diǎn)b與A點(diǎn)不發(fā)生碰撞（記為Cons G）；車輛右側(cè)bc與A點(diǎn)不發(fā)生碰撞。（2）調(diào)整階段，車輛右前頂點(diǎn)b與車位BC邊界不發(fā)生碰撞；車輛前端ab與車位AB邊界的安全距離為Ds。

1.2 泊入路徑的設(shè)計(jì)

設(shè)回旋曲線的曲率變化率為k，初始點(diǎn)為固定原點(diǎn)O，初始方位角為零，回旋曲線上曲率為ρ的i點(diǎn)坐標(biāo)及方位角αi為：

設(shè)圓弧曲線的半徑為R，圓心角為θ，起始點(diǎn)為固定原點(diǎn)O，初始方位角為零，圓弧曲線上對應(yīng)圓心角為θ的j點(diǎn)坐標(biāo)為：

xj=Rsinθ（4）

yj=R(1-cosθ) （5）

回旋曲線C1-C2曲率變化率為kC12，C1-C2曲線構(gòu)造原理如圖4 所示，由式（1）、（2）得到初始回旋曲線O-C2*，C2*處的方位角為αC2*由式（3）求得，初始曲線如I所示。將曲線O-C2*逆時(shí)針旋轉(zhuǎn)π+θ0，如位置II所示，沿向量OC1平移至O和C1重合，得到回旋曲線C1-C2，如位置III所示。

圖4 C1-C2 曲線構(gòu)造原理Fig.4 Construction principle of C1-C2 curve

圓弧曲線C2-C3的曲率為ρC23，圓心角為θC23，初始圓弧曲線O-C3*由式（4）和（5）求得，將其逆時(shí)針旋轉(zhuǎn)αC2*+θ0+π，沿向量OC2平移至O與C2重合，得到圓弧曲線C2-C3，C3點(diǎn)處的方位角為αC3=θ0+αC2*+θC23。

同理，其余回旋曲線和圓弧曲線也類似求得?；匦€C3-C4的曲率變化率為kC34，初始回旋曲線為OC3′，C3′處的方位角為αC3′。設(shè)P點(diǎn)的方位角為θ1。圓弧曲線C6-P的曲率為ρC6P，圓心角為θC6P，初始圓弧曲線為O-C6*；回旋曲線C5-C6的曲率變化率為kC56，初始回旋曲線為O-C6′，C6′處的方位角為αC6′；連接C4、C5得到直線C4-C5。

上述圓弧曲線的半徑均取Rmin，滿足θ1+θC6P+αC6′=αC3+αC3′。

泊入運(yùn)動中允許的最大車速vmax1=3 km/h，曲率變化率的最大值kmax1=wmax2，wmax代表前輪最大轉(zhuǎn)向角速度。

泊入路徑中直線C4-C5長度LC45最小為優(yōu)化目標(biāo)，泊入路徑規(guī)劃轉(zhuǎn)換為非線性規(guī)劃：式中，第一個(gè)不等式表示車輛右前頂點(diǎn)b與A點(diǎn)不發(fā)生碰撞；第二個(gè)不等式為直線C4-C5存在性條件；第三個(gè)不等式表示車輛bc側(cè)與A點(diǎn)不發(fā)生碰撞；第四個(gè)等式表示直線C4-C5分別與回旋曲線C5-C6、回旋曲線C3-C4曲線相切。

1.3 調(diào)整段路徑設(shè)計(jì)

為了方便設(shè)計(jì)，將圓弧曲線P2-P3分為P2-Q和Q-P3兩段圓弧，Q點(diǎn)切線水平，如圖3（b）所示。

回旋曲線P6-P7的曲率變化率為kP67，初始回旋曲線為O-P6*，P6*處的方位角為αP6*；圓弧曲線P5-P6的曲率為ρP56，圓心角為θP56，初始圓弧曲線為O-P5*；回旋曲線P4-P5的曲率變化率為kP45，初始回旋曲線為O-P5′，P5′處的方位角為αP5′；回旋曲線P3-P4的曲率變化率為kp34，初始回旋曲線為O-P3*，P3*處的方位角為αP3*；圓弧曲線Q-P3的圓心角為θ33，曲率為ρQP3，初始圓弧曲線為O-P3′；回旋曲線P-P1的曲率變化率為kPP1，初始回旋曲線為O-P*，P*處的方位角為αP*；回旋曲線P1-P2的曲率變化率為kP12，初始回旋曲線為O-P2*，P2*處的方位角為αP2*；圓弧曲線P2-Q的圓心角為θ32，曲率為ρP2Q，初始圓弧曲線為O-P2′。

連接P7-P8，P8點(diǎn)為圖1所示參考點(diǎn)的位置。

圓弧曲線P5-P6的半徑取為Rmin。在調(diào)整路徑中，為保證車輛能夠跟隨路徑，允許的最大車度vmax2=0.75 km/h，P6-P7選擇曲率變化率的最大值kmax2=2wmax。將P與P7點(diǎn)的橫向距離LXPP7最小作為優(yōu)化目標(biāo)，調(diào)整路徑規(guī)劃轉(zhuǎn)換為非線性規(guī)劃：

式中，第一個(gè)等式限定P點(diǎn)的位置關(guān)系；第二個(gè)不等式表示圓弧路徑P2-P3存在性條件；第三個(gè)不等式表示車輛b點(diǎn)與障礙物BC側(cè)不發(fā)生碰撞；第四個(gè)不等式表示車輛ab側(cè)與障礙物AB側(cè)不發(fā)生碰撞。

2 小車位下的泊車路徑的跟蹤控制

在泊車過程中車輛以低速行駛，根據(jù)阿克曼轉(zhuǎn)向原理，車輛的運(yùn)動學(xué)模型為：

式中，(x,y)代表參考點(diǎn)坐標(biāo)，v代表車速，φ代表車輛航向角，δ代表車輛的前輪轉(zhuǎn)向角。

傳統(tǒng)路徑跟蹤的方法是將路徑視作時(shí)間參考函數(shù)，若車輛跟蹤過程中出現(xiàn)誤差，這種誤差會隨著時(shí)間逐漸增加，甚至?xí)苯訉?dǎo)致車輛失去跟蹤能力[25]。引入f=-x做為非時(shí)間參考量，車輛的運(yùn)動學(xué)方程可表示為：

圖5 路徑跟蹤偏差示意圖Fig.5 Diagram of path tracking deviation

結(jié)合式（8）、（9）、（10），基于非時(shí)間參考變量的跟蹤偏差為：

3 仿真分析

車輛的基本參數(shù)如表1所示。

表1 車輛基本參數(shù)Table 1 Basic vehicle parameters

泊車路徑跟蹤效果如圖6所示。泊車過程中，汽車外輪廓與障礙物邊界之間的相對位置如圖7所示。

圖7 汽車外輪廓包絡(luò)圖Fig.7 Envelope diagram of automobile outline

由圖6、7 可知，車輛行駛路徑與規(guī)劃路徑基本重合，汽車外輪廓的包絡(luò)在行駛過程中未與周邊障礙物產(chǎn)生碰撞，滿足車輛避障約束及泊車要求等。

圖6 路徑跟蹤效果圖Fig.6 Diagram of path tracking

泊車過程中的縱向誤差如圖8所示。圖8（a）、（b）、（c）分別表示泊入路徑、前進(jìn)調(diào)整路段和后退路段的縱向誤差。

圖8 路徑跟蹤過程中的縱向誤差Fig.8 Longitudinal error in path tracking

由圖8可知，泊入路段中的最大縱向誤差為0.005 4 m；調(diào)整路徑中的前進(jìn)路段的最大縱向誤差為0.002 2 m，后退路段最大縱向誤差為0.002 1 m，泊車終止點(diǎn)的縱向誤差為0.002 1 m。

泊車過程中的航向誤差如圖9所示。圖9（a）、（b）、（c）分別代表泊入路段、前進(jìn)調(diào)整路段和后退調(diào)整路段的航向誤差。

由圖9可知，泊入路徑中的最大航向誤差為0.114 6°；調(diào)整路徑中的前進(jìn)路段中的最大航向誤差為0.401 1°，后退路段最大航向誤差為0.383 9°，泊車終止點(diǎn)的航向角誤差為0.383 9°。

圖9 路徑跟蹤過程中的航向誤差Fig.9 Course angle error in path tracking

仿真過程中車輛的實(shí)際前輪轉(zhuǎn)角如圖10所示。圖10（a）、（b）、（c）分別為泊入路段、前進(jìn)調(diào)整路段、后退調(diào)整路段在不同函數(shù)作用下的前輪轉(zhuǎn)角。

圖10 不同函數(shù)作用下的前輪轉(zhuǎn)角Fig.10 Front wheel rotation angle under different functions

由圖10知，車輛在路徑跟隨過程中，前輪轉(zhuǎn)角無突變，車輛行駛平滑；連續(xù)函數(shù)作用下的滑模控制器相比符號函數(shù)作用下的滑?？刂破鬏^大的抑制了高頻抖振。

由圖6～10可知，在滑?？刂破鞯淖饔孟?，車輛與周圍障礙物未發(fā)生碰撞，最大縱向誤差為0.005 4 m，最大航向誤差為0.401 1°，跟蹤誤差較??；全程前輪轉(zhuǎn)角變化平滑，抖振抑制效果良好。

4 結(jié)論

對于小車位環(huán)境泊車難的問題，設(shè)計(jì)了泊入路徑和調(diào)整路徑，將回旋曲線、直線、圓弧曲線進(jìn)行組合規(guī)劃，實(shí)現(xiàn)了不同曲率路徑之間的平滑過渡，該規(guī)劃方法具有計(jì)算簡便、曲率無突變的優(yōu)點(diǎn)?；诜菚r(shí)間參考誤差設(shè)計(jì)滑?？刂破鳎瑢⒅笖?shù)趨近率中的符號函數(shù)替換為連續(xù)函數(shù)，改善了泊車過程中的高頻抖振問題。仿真結(jié)果表明，該路徑規(guī)劃方法滿足小車位泊車的要求，前輪轉(zhuǎn)角無突變、跟蹤誤差小，較好地解決了小車位泊車難、位姿調(diào)整難的問題。