前饋-改進(jìn)PID算法在智能車控制上的應(yīng)用

圖3 微分先行PID控制結(jié)構(gòu)圖
3 前饋控制的應(yīng)用
由于智能車的跑道寬度有限制，所以在經(jīng)過急轉(zhuǎn)彎的時(shí)候，如果速度和方向控制不及時(shí)，智能車就可能沖出跑道。由于前饋控制是開環(huán)控制，所以前饋控制的響應(yīng)速度很快。將前饋控制引入到智能車的控制中，能夠提高舵機(jī)和伺服電機(jī)的反應(yīng)速度，改善智能車系統(tǒng)的動(dòng)態(tài)性能。
3.1 智能車控制系統(tǒng)結(jié)構(gòu)
智能車的控制主要體現(xiàn)在兩個(gè)方面：一方面是方向的控制，也就是對(duì)舵機(jī)的控制；另一方面是對(duì)速度的控制，也就是對(duì)伺服電機(jī)的控制。舵機(jī)的數(shù)學(xué)模型較為簡(jiǎn)單，具有很好的線性特征，只采用前饋控制；智能車的速度控制相對(duì)復(fù)雜一些，速度模型無法準(zhǔn)確建立，采用前饋-改進(jìn)PID算法進(jìn)行控制。智能車的控制系統(tǒng)結(jié)構(gòu)如圖4所示。
圖4中， 和 分別是舵機(jī)和伺服電機(jī)數(shù)學(xué)模型。從圖中可以看出，智能車的方向控制和速度控制是相互獨(dú)立的，而且它們都是由路線偏差決定的。舵機(jī)轉(zhuǎn)角與路線偏差之間的對(duì)應(yīng)關(guān)系是根據(jù)舵機(jī)的數(shù)學(xué)模型得到的，在速度控制回路中，既包括反饋回路，又包括前饋環(huán)節(jié)，伺服電機(jī)的控制量是在前饋補(bǔ)償基礎(chǔ)上，再由增量式PID算法計(jì)算得到。

圖4 智能車的控制系統(tǒng)結(jié)構(gòu)
3.2 在方向控制中的應(yīng)用
智能車對(duì)方向的控制有兩點(diǎn)要求：在直道上，方向保持穩(wěn)定；在轉(zhuǎn)彎處，需要方向變化準(zhǔn)確而且迅速。只有這樣，才能保證智能車在跑道上高速、穩(wěn)定地運(yùn)行。為了提高方向控制的魯棒性，本文還對(duì)路線偏差進(jìn)行了模糊化處理。圖5是智能車方向模糊前饋控制的結(jié)構(gòu)圖，圖中和分別是直道和彎道兩種情況下的前饋控制函數(shù)。

圖5 智能車方向控制系統(tǒng)結(jié)構(gòu)圖
3.3 在速度控制中的應(yīng)用
為了使智能車在直道上以較快速度運(yùn)行，在轉(zhuǎn)彎時(shí)，防止智能車沖出跑道，則必須將智能車的速度降低，這就要求智能車的速度控制系統(tǒng)具有很好的加減速性能。當(dāng)智能車經(jīng)過連續(xù)轉(zhuǎn)彎的跑道時(shí)，路線偏差的頻繁變化會(huì)造成速度設(shè)定的頻繁變化，這會(huì)引起速度控制系統(tǒng)的振蕩，并且微分環(huán)節(jié)對(duì)誤差突變干擾很敏感，容易造成系統(tǒng)的不穩(wěn)定。為了解決上述存在的問題，本文對(duì)數(shù)字PID算法進(jìn)行了改進(jìn)，將不完全微分和微分先行引入到PID算法中，大大改善了速度控制系統(tǒng)的動(dòng)態(tài)性能。

圖6 智能車速度控制系統(tǒng)結(jié)構(gòu)圖