融合模糊與PID算法的自主巡邏車(chē)協(xié)調(diào)轉(zhuǎn)向控制

，，

（中國(guó)民航大學(xué)機(jī)器人研究所，天津 300300）

1 引言

車(chē)輛轉(zhuǎn)向控制的研究主要涉及車(chē)輛跟隨、車(chē)輛換道等內(nèi)容［1］。無(wú)人車(chē)轉(zhuǎn)向控制即根據(jù)車(chē)載傳感器獲取車(chē)體運(yùn)行狀態(tài)信息以及道路信息產(chǎn)生控制指令，自動(dòng)實(shí)現(xiàn)車(chē)體轉(zhuǎn)向。但由于車(chē)輛和道路的參數(shù)變化，以及轉(zhuǎn)向運(yùn)動(dòng)系統(tǒng)固有的非線性特性，使得轉(zhuǎn)向控制器的設(shè)計(jì)是一個(gè)復(fù)雜問(wèn)題。

目前對(duì)于無(wú)人車(chē)轉(zhuǎn)向控制問(wèn)題的研究受到國(guó)內(nèi)外許多科研機(jī)構(gòu)的重視。文獻(xiàn)［2］針對(duì)車(chē)輛的非線性結(jié)構(gòu)和參數(shù)不確定性等特性，采用模糊-滑模變結(jié)構(gòu)方法設(shè)計(jì)了縱向控制器；文獻(xiàn)［3-4］采用自適應(yīng)滑模變結(jié)構(gòu)控制算法設(shè)計(jì)了車(chē)的轉(zhuǎn)向控制器，并通過(guò)仿真試驗(yàn)驗(yàn)證了該方法的有效性。文獻(xiàn)［5］根據(jù)換道軌跡確定期望的橫擺角和橫擺角速度，利用檢測(cè)到的車(chē)輛橫擺角速度信息，設(shè)計(jì)控制規(guī)律，使車(chē)輛跟蹤期望橫擺角和橫擺角速度，間接實(shí)現(xiàn)對(duì)換道軌跡的跟蹤控制。文獻(xiàn)［6］采用滑模變結(jié)構(gòu)控制方法設(shè)計(jì)了耦合控制器，控制器要求系統(tǒng)參數(shù)的不確定性和外界擾動(dòng)滿足匹配條件，但車(chē)輛系統(tǒng)是非匹配不確定性非線性系統(tǒng)。文獻(xiàn)［7］以車(chē)輛縱向速度、轉(zhuǎn)向速度和擺角速度為狀態(tài)變量建立車(chē)輛轉(zhuǎn)向耦合動(dòng)力學(xué)模型，采用滑模控制、動(dòng)態(tài)表面控制方法研究車(chē)輛跟隨和車(chē)道保持耦合控制。文獻(xiàn)［8］是利用直接的橫擺力矩控制，導(dǎo)致車(chē)輛橫擺角速度穩(wěn)態(tài)值降低。

眾多學(xué)者對(duì)車(chē)體轉(zhuǎn)向控制研究，基本采用PID控制，并以理論仿真進(jìn)行分析，在實(shí)際應(yīng)用中需要不斷改進(jìn)控制算法進(jìn)一步提高控制效果。本文在分析自主巡邏車(chē)車(chē)體轉(zhuǎn)向動(dòng)力學(xué)模型的基礎(chǔ)上，推導(dǎo)出方向盤(pán)轉(zhuǎn)角與速度之間的約束關(guān)系。結(jié)合車(chē)體行進(jìn)時(shí)不同階段的控制要求，綜合車(chē)體轉(zhuǎn)向相關(guān)各參數(shù)變化特點(diǎn)，選擇應(yīng)用模糊控制以及PID控制算法，協(xié)調(diào)控制車(chē)體的車(chē)速、方向盤(pán)轉(zhuǎn)角和方向盤(pán)轉(zhuǎn)速，實(shí)現(xiàn)自主巡邏車(chē)協(xié)調(diào)轉(zhuǎn)向控制。

2 自主巡邏車(chē)轉(zhuǎn)向模型分析

2.1 自主巡邏車(chē)轉(zhuǎn)向動(dòng)力學(xué)模型

自主巡邏車(chē)系統(tǒng)存在嚴(yán)重的參數(shù)不確定性、強(qiáng)耦合性。根據(jù)對(duì)車(chē)體動(dòng)力學(xué)模型的分析，綜合考慮各個(gè)子系統(tǒng)之間的相互聯(lián)系，作以下簡(jiǎn)化：研究?jī)?nèi)容僅考慮車(chē)輛的縱向、轉(zhuǎn)向及橫擺運(yùn)動(dòng)，忽略車(chē)輛的側(cè)傾、垂直方向運(yùn)動(dòng)以及左右輪胎側(cè)偏特性的差異，車(chē)體左右對(duì)稱。假設(shè)車(chē)輪始終與地面接觸，忽略輪胎剛度和阻尼特性，其非線性特性由輪胎模型描述。最后，不考慮轉(zhuǎn)向系統(tǒng)力學(xué)特性，方向盤(pán)轉(zhuǎn)角與前輪轉(zhuǎn)角只存在傳動(dòng)比關(guān)系，左右輪轉(zhuǎn)角相同。車(chē)體動(dòng)力模型簡(jiǎn)化如圖1所示。

圖1 自主巡邏車(chē)動(dòng)力學(xué)模型Fig.1 Kinetics model of autonomous patrol car

模型中CG為車(chē)輛質(zhì)心，β為質(zhì)心側(cè)偏角，即車(chē)輛行駛速度和縱軸夾角，vx為車(chē)體縱向速度；vy為橫向速度；γ為橫擺角速度；模型的動(dòng)力學(xué)關(guān)系可描述為

式中：m為整車(chē)質(zhì)量；IZ為車(chē)輛繞Z軸的轉(zhuǎn)動(dòng)慣量；Fx1,Fx2,Fx3,Fx4為輪胎縱向力；Fy1,Fy2,Fy3,Fy4為輪胎側(cè)偏力；lf為前軸與車(chē)輛質(zhì)心的距離；lr為后軸與車(chē)輛質(zhì)心的距離；δ為前輪轉(zhuǎn)角。

同時(shí)由圖1的幾何關(guān)系可得到前后輪側(cè)偏角分別為

其中

式中：ki為各個(gè)輪胎側(cè)偏剛度，i=1，2，3，4；θi為輪胎的側(cè)偏角，i=1，2，3，4；β為質(zhì)心側(cè)偏角。

這里僅考慮小轉(zhuǎn)角工況，則sinδ=δ,cosδ=1，F(xiàn)x1δ為二階微分項(xiàng)。

整理式（1）～式（5）并寫(xiě)成車(chē)輛動(dòng)力學(xué)模型狀態(tài)的空間方程：

2.2 自主巡邏車(chē)轉(zhuǎn)向控制策略分析

影響自主巡邏車(chē)車(chē)體穩(wěn)定性轉(zhuǎn)向的參量有3個(gè)：路面附著系數(shù)，轉(zhuǎn)向輸入角度和車(chē)速［13］。在轉(zhuǎn)向過(guò)程中，路面附著系數(shù)和轉(zhuǎn)向輸入角度不是可控變量。在轉(zhuǎn)向半徑一定情況下，當(dāng)轉(zhuǎn)角相等時(shí)，隨車(chē)速的升高，轉(zhuǎn)向力矩逐漸增大，在回正的情況下，隨車(chē)速的增加，回正殘留角減?。?4］。由式（6）得車(chē)體速度v與轉(zhuǎn)向半徑R關(guān)系為

穩(wěn)定性系數(shù)K=m(k3lr-k1lf)/k1k3l2，由理想的線性車(chē)輛模型可知，車(chē)體的轉(zhuǎn)動(dòng)角度為質(zhì)心側(cè)偏角與橫擺角之和，即：

當(dāng)質(zhì)心側(cè)偏角較小忽略不計(jì)，則橫擺角速度決定了車(chē)體的運(yùn)動(dòng)狀態(tài)。即

由于路面附著系數(shù)不足以提供足夠輪胎力，期望橫擺角速度受到地面附著系數(shù)的限制?？紤]到地面附著能力的限制，設(shè)置橫擺角速度的上限為

式中：μ為輪胎和路面間的滑動(dòng)系數(shù)。

同時(shí)不考慮車(chē)輪轉(zhuǎn)向后傾、內(nèi)傾及轉(zhuǎn)向梯形的影響，方向盤(pán)轉(zhuǎn)角與車(chē)輪前輪轉(zhuǎn)角近似成線性關(guān)系：

式中：μ為方向盤(pán)角速度；θi為方向盤(pán)轉(zhuǎn)角；λ為方向盤(pán)轉(zhuǎn)角到車(chē)輪前輪轉(zhuǎn)角的機(jī)械等效傳動(dòng)比。為保持車(chē)體穩(wěn)定性，防止出現(xiàn)側(cè)滑現(xiàn)象，由式（9）～式（11）得到車(chē)速與方向盤(pán)轉(zhuǎn)角之間約束關(guān)系：

綜上所述，在車(chē)體轉(zhuǎn)向控制策略中，根據(jù)車(chē)速與方向盤(pán)轉(zhuǎn)角之間的約束關(guān)系，要求在車(chē)體轉(zhuǎn)向過(guò)程中，協(xié)調(diào)控制車(chē)體速度、前輪轉(zhuǎn)角、方向盤(pán)轉(zhuǎn)角3個(gè)變量，保證自主巡邏車(chē)穩(wěn)定地轉(zhuǎn)過(guò)期望角度。

3 自主巡邏車(chē)轉(zhuǎn)向控制器設(shè)計(jì)

根據(jù)現(xiàn)有的車(chē)體控制理論和方法，利用控制前輪轉(zhuǎn)角來(lái)改變作用在車(chē)輪上的側(cè)偏力和縱向力的大小及方向，達(dá)到控制車(chē)體橫擺角速度及質(zhì)心側(cè)偏角的目的，進(jìn)而控制車(chē)體轉(zhuǎn)角。車(chē)體轉(zhuǎn)向控制系統(tǒng)（見(jiàn)圖2）輸入量為車(chē)體期望角度，轉(zhuǎn)向過(guò)程中通過(guò)控制前輪轉(zhuǎn)角、方向盤(pán)轉(zhuǎn)角、車(chē)速等變量，以實(shí)現(xiàn)車(chē)體穩(wěn)定轉(zhuǎn)向，轉(zhuǎn)過(guò)期望角度。

圖2 自主巡邏車(chē)轉(zhuǎn)向控制系統(tǒng)Fig.2 Steering control system of autonomous patrol car

自主巡邏車(chē)車(chē)體轉(zhuǎn)向協(xié)調(diào)控制中，由于模糊控制能夠較好適應(yīng)工況非線性系統(tǒng)的控制，設(shè)計(jì)的模糊控制器根據(jù)目標(biāo)轉(zhuǎn)動(dòng)角度差值和差值變化率，對(duì)前輪轉(zhuǎn)角進(jìn)行控制。方向盤(pán)轉(zhuǎn)角控制中，結(jié)合方向盤(pán)轉(zhuǎn)角與車(chē)速的約束關(guān)系，根據(jù)PID控制的特點(diǎn)，利用增量式PID控制算法。

3.1 模糊化接口

自主巡邏車(chē)實(shí)驗(yàn)中轉(zhuǎn)動(dòng)角度范圍為（-180°，180°），車(chē)體的前輪轉(zhuǎn)角的最大角度為30°，由于試驗(yàn)中在短時(shí)間內(nèi)羅盤(pán)角度有跳躍，數(shù)值采用在上1 min中轉(zhuǎn)過(guò)的角度與現(xiàn)1 min中轉(zhuǎn)過(guò)的角度之間差值的平均值，其最大值為50(°)/s。在車(chē)體轉(zhuǎn)動(dòng)控制中，規(guī)定順時(shí)針轉(zhuǎn)動(dòng)，轉(zhuǎn)角增大，逆時(shí)針轉(zhuǎn)動(dòng)，轉(zhuǎn)角減小。為了進(jìn)行模糊化處理，必須將輸入變量從基本論域轉(zhuǎn)換到相應(yīng)的模糊集論域。

設(shè)輸入變量E1的基本論域?yàn)椋?180°，180°］，輸入變量的模糊集論域?yàn)閧-6，-5，…，0，…，5，6}，即可以給出精確量模糊化的量化因子：ke1=6/180=1/30。E2的基本論域?yàn)椋?50(°)/s，50(°)/s］，為了使計(jì)算方便，模糊集論域同上，其量化因子ke2=6/50=0.12。把輸入變量乘以量化因子，就能實(shí)現(xiàn)輸入變量從基本論域到模糊集論域的轉(zhuǎn)換。

根據(jù)輸入變量的模糊集論域設(shè)定為{-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6}，把在這區(qū)間的連續(xù)量模糊化為：{NB，NM，NS，ZO，PS，PB，PM}，分別表示負(fù)大，負(fù)中，負(fù)小，零，正小，正中，正大，對(duì)應(yīng)著7個(gè)模糊子集，如表1所示。表1中的數(shù)值表示［-6，+6］之間13個(gè)元素在模糊集中的隸屬度。

表1 模糊集論域隸屬度Tab.1 The fuzzy setsmember ship

3.2 模糊規(guī)則庫(kù)

根據(jù)模糊控制器的控制規(guī)則，E1，E2各有7個(gè)模糊變量，可給出一組模糊規(guī)則：

這樣就產(chǎn)生了49條模糊規(guī)則，如表2所示。

表2 模糊控制規(guī)則表Tab.2 Fuzzy control rule

3.3 模糊推理

推理機(jī)在模糊控制器中的功能是：根據(jù)輸入的模糊量和規(guī)則庫(kù)完成模糊推理，并求解模糊關(guān)系方程，從而獲得模糊控制量。控制量的模糊集U由模糊推理綜合算法獲得：

式中：R為模糊關(guān)系矩陣。

3.4 解模糊化接口

通過(guò)推理機(jī)進(jìn)行模糊決策所得到的輸出是模糊量，被控對(duì)象前輪轉(zhuǎn)角只能接受一個(gè)清晰控制量，因此要進(jìn)行控制必須經(jīng)過(guò)清晰化接口將模糊量轉(zhuǎn)換為精確量。其中U為［-30，-25，-20，-15，-10，-5，0，5，10，15，20，25，30］，比例因子為5，其隸屬度對(duì)應(yīng)表1，本文采用系數(shù)加權(quán)平均法進(jìn)行解模糊化運(yùn)算：

式中：u為解模糊化后的控制量輸出值；Ui為控制變量；μi為相應(yīng)控制變量的隸屬度，i=（1,2,…,13）。

3.5 方向盤(pán)轉(zhuǎn)角PID控制

在方向盤(pán)轉(zhuǎn)角的控制中，為了提高控制精度，避免超調(diào)，采用數(shù)字增量式PID控制。數(shù)字增量式PID方程如下：式中：Kp為PI調(diào)節(jié)時(shí)的比例系數(shù)；Ki為調(diào)節(jié)時(shí)的積分系數(shù)；Kd為調(diào)節(jié)時(shí)的微分系數(shù)；e(k)為給定值與反饋值的偏差分別為上次偏差和上上次偏差。

模糊控制器輸出前輪轉(zhuǎn)角后，根據(jù)前輪轉(zhuǎn)角與方向盤(pán)轉(zhuǎn)角之間傳動(dòng)比，以及方向盤(pán)轉(zhuǎn)角與車(chē)體速度的約束關(guān)系，結(jié)合方向盤(pán)轉(zhuǎn)角反饋值，得到方向盤(pán)轉(zhuǎn)角控制器的輸入量，進(jìn)而控制方向盤(pán)轉(zhuǎn)速。系統(tǒng)通過(guò)實(shí)時(shí)檢測(cè)方向盤(pán)角位移控制器的輸出，當(dāng)轉(zhuǎn)向角度偏差較大時(shí)，加大P參數(shù)。當(dāng)轉(zhuǎn)向角度轉(zhuǎn)角差值較小時(shí)，方向盤(pán)角位移的控制量較小，此時(shí)方向盤(pán)已經(jīng)到達(dá)某個(gè)位置，改變方向盤(pán)轉(zhuǎn)速方向，開(kāi)始回正。則重新給定角位移環(huán)的PID參數(shù)，具體的做法為增大P參數(shù)，加快方向盤(pán)回正速度，適當(dāng)?shù)恼{(diào)節(jié)I參數(shù)，減小穩(wěn)態(tài)誤差使方向盤(pán)精確回正。

由方向盤(pán)轉(zhuǎn)角控制器輸出方向盤(pán)轉(zhuǎn)速控制量，在轉(zhuǎn)向電機(jī)的控制板集成了LM629運(yùn)動(dòng)控制芯片，該芯片內(nèi)置一個(gè)PID控制器，通過(guò)選擇速度模式，對(duì)方向盤(pán)轉(zhuǎn)速進(jìn)行精確的伺服控制。

4 實(shí)驗(yàn)分析

論文提出的控制算法在裝有電子羅盤(pán)，激光等傳感器的自主巡邏車(chē)上進(jìn)行實(shí)驗(yàn)。實(shí)驗(yàn)時(shí)初始化啟動(dòng)速度，車(chē)體原地靜止啟動(dòng)，待速度穩(wěn)定，給定轉(zhuǎn)向角度。實(shí)際轉(zhuǎn)向控制中自主巡邏車(chē)最大車(chē)速為3 m/s，方向盤(pán)最大轉(zhuǎn)速為0.5 r/s，方向盤(pán)最大轉(zhuǎn)角為1.5 r，因此試驗(yàn)中對(duì)車(chē)速1 m/s與2 m/s進(jìn)行試驗(yàn)對(duì)比。實(shí)驗(yàn)中對(duì)不同的轉(zhuǎn)向角度以及不同車(chē)速進(jìn)行試驗(yàn)驗(yàn)證。

4.1 自主巡邏車(chē)60°轉(zhuǎn)向?qū)嶒?yàn)

設(shè)定初始車(chē)速為1 m/s，穩(wěn)定后，輸入轉(zhuǎn)向指令：轉(zhuǎn)向角度60°。其車(chē)體車(chē)速、車(chē)體轉(zhuǎn)向角度、期望方向盤(pán)轉(zhuǎn)角和方向盤(pán)轉(zhuǎn)角的變化曲線如圖3所示。

圖3 車(chē)速1.0 m/s的自主巡邏車(chē)60°轉(zhuǎn)向?qū)嶒?yàn)Fig.3 Autonomous patrol car turning 60°experiment at speed of 1.0 m/s

由圖3所示開(kāi)始階段，角度差值較大，由模糊控制器計(jì)算得到的前輪轉(zhuǎn)角值較大，經(jīng)過(guò)計(jì)算得到期望方向盤(pán)轉(zhuǎn)角值的大小，并通過(guò)方向盤(pán)轉(zhuǎn)角控制器，通過(guò)計(jì)算得到期望方向盤(pán)轉(zhuǎn)速，進(jìn)而控制轉(zhuǎn)向電機(jī)，改變方向盤(pán)角速度大小。所以開(kāi)始階段，方向盤(pán)轉(zhuǎn)速保持最大，方向盤(pán)轉(zhuǎn)角不斷增加。當(dāng)轉(zhuǎn)過(guò)角度30°，而且轉(zhuǎn)角角度方向?yàn)檎?，此時(shí)方向盤(pán)角速度減小，并開(kāi)始回正，角速度開(kāi)始反向增大，減小方向盤(pán)轉(zhuǎn)角。當(dāng)轉(zhuǎn)向角度達(dá)到48°時(shí)，轉(zhuǎn)角角度差值變小，此時(shí)方向盤(pán)角速度開(kāi)始減小，同時(shí)由模糊控制不斷修正，最終完成轉(zhuǎn)向，轉(zhuǎn)向用時(shí)2 300 ms，實(shí)際轉(zhuǎn)向角度為59.88°，實(shí)驗(yàn)表明，當(dāng)進(jìn)行小角度轉(zhuǎn)向時(shí)，轉(zhuǎn)向時(shí)間相對(duì)較短，轉(zhuǎn)向精度較高。

4.2 自主巡邏車(chē)90°轉(zhuǎn)向?qū)嶒?yàn)

1）設(shè)定初始車(chē)速為1 m/s，穩(wěn)定后，輸入轉(zhuǎn)向指令：轉(zhuǎn)向角度90°。其車(chē)體車(chē)速、車(chē)體轉(zhuǎn)向角度、期望方向盤(pán)轉(zhuǎn)角和方向盤(pán)轉(zhuǎn)角的變化曲線如圖4所示。

圖4 車(chē)速1.0 m/s的自主巡邏車(chē)90°轉(zhuǎn)向?qū)嶒?yàn)Fig.4 Autonomous patrol car turning 90°experiment at speed of 1.0 m/s

圖4過(guò)程與轉(zhuǎn)向角度60°的實(shí)驗(yàn)過(guò)程相似，較方向盤(pán)轉(zhuǎn)角60°時(shí)實(shí)驗(yàn)回正時(shí)間較早，轉(zhuǎn)向用時(shí)2 800 ms，實(shí)際轉(zhuǎn)過(guò)角度為90.78°。

2）設(shè)定初始車(chē)速為2.0 m/s，穩(wěn)定后，輸入轉(zhuǎn)向指令：轉(zhuǎn)向角度90°。其車(chē)體車(chē)速、車(chē)體轉(zhuǎn)向角度、期望方向盤(pán)轉(zhuǎn)角和方向盤(pán)轉(zhuǎn)角的變化曲線如圖5所示。

在90°轉(zhuǎn)向?qū)嶒?yàn)中1 m/s與2.0 m/s兩者實(shí)驗(yàn)相比較，其中2.0 m/s的實(shí)驗(yàn)中，由于速度的限制，方向盤(pán)最大轉(zhuǎn)角為1.2 r/s，進(jìn)而致使方向盤(pán)轉(zhuǎn)速的最大值持續(xù)時(shí)間比較短，轉(zhuǎn)向耗時(shí)較長(zhǎng)。轉(zhuǎn)向用時(shí)3 300 ms，最終車(chē)體轉(zhuǎn)角88.78°。

圖5 車(chē)速2.0 m/s的自主巡邏車(chē)90°轉(zhuǎn)向?qū)嶒?yàn)Fig.5 Autonomous patrol car turning 90°experiment at speed of 2.0 m/s

4.3 自主巡邏車(chē)120°轉(zhuǎn)向?qū)嶒?yàn)

設(shè)定初始車(chē)速為1 m/s，穩(wěn)定后，輸入轉(zhuǎn)向指令：轉(zhuǎn)向角度120°。其車(chē)體車(chē)速、車(chē)體轉(zhuǎn)向角度、期望方向盤(pán)轉(zhuǎn)角和方向盤(pán)轉(zhuǎn)角的變化曲線如圖6所示。

圖6 車(chē)速1.0 m/s的自主巡邏車(chē)120°轉(zhuǎn)向?qū)嶒?yàn)Fig.6 Autonomous patrol car turning 120°experiment at speed of 1.0 m/s

圖6實(shí)驗(yàn)表明，隨著轉(zhuǎn)向角度的增大，方向盤(pán)轉(zhuǎn)角逐漸達(dá)到最大值，以及在最大值的保持時(shí)間也會(huì)增大，這樣就可以保證轉(zhuǎn)向的快速性，待方向盤(pán)達(dá)到回正條件時(shí)，方向盤(pán)開(kāi)始反方向運(yùn)行進(jìn)行迅速回正，且在將要達(dá)到給定轉(zhuǎn)角時(shí)，方向盤(pán)運(yùn)行速度穩(wěn)定，符合人工駕駛經(jīng)驗(yàn)?zāi)Ｐ停D(zhuǎn)向用時(shí)4 200 ms，羅盤(pán)測(cè)得的實(shí)際轉(zhuǎn)向角度為119.87°。

由實(shí)驗(yàn)圖3～圖6所示數(shù)據(jù)表明，在自主巡邏車(chē)轉(zhuǎn)向過(guò)程中，方向盤(pán)轉(zhuǎn)角以及方向盤(pán)轉(zhuǎn)速根據(jù)轉(zhuǎn)動(dòng)角度差值的變化，隨時(shí)改變；另一方面表明在車(chē)速較大時(shí)，由于車(chē)速與方向盤(pán)轉(zhuǎn)角之間的約束關(guān)系，控制方向盤(pán)轉(zhuǎn)角的大小。實(shí)驗(yàn)結(jié)果表明所設(shè)計(jì)的控制器能根據(jù)轉(zhuǎn)向過(guò)程隨時(shí)調(diào)整車(chē)速、方向盤(pán)轉(zhuǎn)速等，有效控制自主巡邏車(chē)車(chē)體轉(zhuǎn)向，使之穩(wěn)定、精確轉(zhuǎn)過(guò)期望的角度。

5 結(jié)論

本文將模糊控制理論與PID控制算法相融合，應(yīng)用到自主巡邏車(chē)車(chē)體的轉(zhuǎn)向控制中。分析了車(chē)體的動(dòng)力學(xué)模型，推導(dǎo)出方向盤(pán)轉(zhuǎn)角與行進(jìn)速度之間關(guān)系；融合模糊控制算法以及PID控制算法，設(shè)計(jì)了自主巡邏車(chē)轉(zhuǎn)向控制系統(tǒng)，期望轉(zhuǎn)向角度作為控制系統(tǒng)輸入量，在轉(zhuǎn)向控制過(guò)程中，對(duì)方向盤(pán)轉(zhuǎn)角、方向盤(pán)轉(zhuǎn)速、車(chē)速進(jìn)行協(xié)調(diào)控制。最后轉(zhuǎn)向?qū)嶒?yàn)結(jié)果驗(yàn)證了模糊與PID控制算法能有效實(shí)現(xiàn)自主巡邏車(chē)的協(xié)調(diào)轉(zhuǎn)向控制，滿足轉(zhuǎn)向過(guò)程中穩(wěn)定性與精確性的要求。

［1］陳斌，魏朗.高速公路意外事件影響下的車(chē)輛跟馳模型［J］.交通運(yùn)輸工程學(xué)報(bào)，2006，6（3）：103-108.

［2］Cremean L B，F(xiàn)oote T B，Glluala J H.Alice：An Informationrich Autonomous Vehicle for High-speed Desert Navigation［J］.Journal of Field Robotics，2006，23（10）：777-810.

［3］王榮本，馬雷.高速車(chē)輛變結(jié)構(gòu)轉(zhuǎn)向控制器切換超平面選取方法［J］.機(jī)械工程學(xué)報(bào)，2004，40（10）：83-86.

［4］Hang J M，Ren D B.Lateral Control of Vehicle for Lane Keeping in Intelligent Transportation Systems［C］//IEEE International Conference on Intelligent Human-machine Systems and Cybernetics，Hangzhou，China，2009：446-450.

［5］Pogluc，Ozguneru，Redmilka.Auto-mated Lane Change Controller Design［J］.IEEE Transactions on Ntelligent Transportation Systems，2003，4（1）：13-22.

［6］任殿波，張景明，崔勝明.自動(dòng)化公路系統(tǒng)車(chē)隊(duì)換道變結(jié)構(gòu)控制［J］.哈爾濱工業(yè)大學(xué)學(xué)報(bào)，2009，41（11）：110-113.

［7］李以農(nóng)，楊柳，鄭玲，等.基于滑?？刂频能?chē)輛縱轉(zhuǎn)向耦合控制［J］.中國(guó)機(jī)械工程，2007，18（7）：866-870.

［8］Rajamani R.Vehicle Dynamics and Control［M］.USA：Springer.2006.

［9］蓋玉先，郭慶悌，宋健，等.汽車(chē)動(dòng)力學(xué)穩(wěn)定性的研究［J］.哈爾濱工業(yè)大學(xué)學(xué)報(bào)，2006，38（12）：2112-2115.

［10］Rajamani R，Zhu C，Alexander L.Lateral of a Backward Driven Front-steering Vehicle［J］.Control Engineering Practice，2003，11（5）：531-540.

［11］Enache N M，Mammar S，Netto M.Driver Steering Assistance for Lane-departure Avoidance Based on Hybrid Automata and Compositelyapunov Function［J］.IEEE Transactions on Intelligent Transportation Systems，2010，11（1）：28-39.

［12］Tanhs，Guldnerj，Chenc.Lane Changing with Look-down Referencesystems on Automated Highways［J］.Control Engineering Practice，2000，8（9）：1033-1043.

［13］李紅志，李亮，楊財(cái)，等.車(chē)輛轉(zhuǎn)向過(guò)程穩(wěn)定性分析與控制［J］.清 華 大 學(xué) 學(xué) 報(bào) ：自 然 科 學(xué) 版 ，2010，50（8）：1282-1285.

［14］劉照，楊家軍，廖道訓(xùn).車(chē)速對(duì)汽車(chē)轉(zhuǎn)向力矩的影響分析［J］.中國(guó)機(jī)械工程，2005，16（8）：748-751.