摘 要

通過對足球機器人運動學模型的分析，考慮到系統的時變、非線性和幹擾大等特點，以全向移動機器人為研究平台，提出一種将模糊控制與傳統的PID控制相結合的方法，應用到足球機器人的運動控制系統中。針對足球機器人運動控制中的重點問題，着重提出了基于模糊控制的動态調整PID控制器的3個參數kp、ki、kd的設計方法。實驗表明，該控制器能較好地改善控制系統對輪速的控制效果。

1 前 言

模糊控制技術，已經成為智能控制技術的一個重要分支，它是一種高級算法策略和新穎的技術。自從1974年英國的馬丹尼（E.H.Mandani）工程師首先根據模糊集合理論組成的模糊控制器用于蒸汽發動機的控制以後，在其發展曆程的30多年中，模糊控制技術得到了廣泛而快速的發展。現在，模糊控制已廣泛地應用于冶金與化工過程控制、工業自動化、家用電器智能化、儀器儀表自動化、計算機及電子技術應用等領域。尤其在交通路口控制、機器人、機械手控制、航天飛行控制、汽車控制、電梯控制、核反應堆及家用電器控制等方面，表現其很強的應用價值。并且目前已有了專用的模糊芯片和模糊計算機的産品，可供選用。我國對模糊控制器開始研究是在1979年，并且已經在模糊控制器的定義、性能、算法、魯棒性、電路實現方法、穩定性、規則自調整等方面取得了大量的成果。著名科學家錢學森指出，模糊數學理論及其應用，關系到我國二十一世紀的國力和命運。

2.2 運動學分析

在建立機器人的運動模型前，先做以下假設：

（1）小車在一個理想的平面上運動，地面的不規則可以忽略。

（2）小車是一個剛體，形變可以忽略。

（3）輪子和地面之間滿足純滾動的條件，沒有相對滑動。全方位移動機器人由4個全向輪作為驅動輪，它們之間間隔90°均勻分布，如圖1所示。其中，xw-yw為絕對坐标系，xm-ym為固連在機器人車體上的相對坐标系，其坐标原點與機器人中心重合。θ為xw與xm的夾角，δ為輪子與ym的夾角，L為機器人中心到輪子中心的距離，vi為第i個輪子沿驅動方向的速度。

可求出運動學方程如式（1）所示：

因為輪子為對稱分布，常數δ為45°，故得到全向移動機器人的運動模型：

V=Ps

其中，v=[v1v2v3v4]T為輪子的速度，s=為機器人整體期望速度，P為轉換矩陣。

這樣，就可以将機器人整體期望速度，解算為到4個輪子分别的速度，把數據傳送到控制器中，就可完成對機器人的控制。

3 基于模糊PID的運動控制器設計

目前，常規PID控制器已被廣泛的應用于自動化領域。但常規PID控制器不具備在線整定控制參數kp、ki、kd的功能，不能滿足系統在不同偏差對e以及偏差值的變化率ec對PID參數的自整定要求，因而不适用于非線性系統控制。

文中結合本運動控制系統的實際運行條件，設計采用模糊PID控制方法來實現快速移動機器人車輪轉速大範圍誤差調節，将模糊控制和PID控制結合起來構成參數模糊自整定PID算法用于伺服電機的控制，使控制器既具有模糊控制靈活而适應性強的優點，又具有PID控制精度高的特點，使運動控制系統兼顧了實時性高、魯棒性強及穩定性等設計要點，并可通過模糊控制規則庫的擴充，為該運動控制系統方便添加其他功能。

3.1 參數模糊自整定PID的結構

模糊PID控制系統結構如圖2所示，系統的輸入為控制器給定輪速，反饋值為電機光電碼盤反饋數字量，Δkp、Δki、Δkd為修正參數。

3.2 速度控制輸入輸出變量模糊化

在此速度控制器中的輸入為實際轉速與設定轉速的偏差值e,以及偏差值的變化率ec,輸出量為PID參數的修正量Δkp、Δki、Δkd.它們的語言變量、基本論域、模糊子集、模糊論域及量化因子。

模糊變量E和EC以及輸出量ΔKP、ΔKI、ΔKD的語言變量和論域确定後，必須對模糊語言變量确定其隸屬度。常用的隸屬函數有B樣條基函數、高斯隸屬函數、三角隸屬函數等，考慮到設計簡便及實時性的要求，本文中采用三角隸屬函數。

3.3 參數自整定規則

模糊控制設計的核心是總結工程設計人員的技術知識和實際操作經驗，建立合适的模糊規則表，得到針對kp，ki，kd這3個參數分别整定的模糊控制表。根據kp，ki，kd這3個參數分别的作用，可制定模糊控制規則，以kp為例，列規則如表2，ki，kd可類似推出。

PID參數的模糊自整定是找出PID三個參數Kp、Ki、Kd與e和ec之間的模糊關系，在運行中通過不斷的監測e和ec，根據模糊控制原理對三個參數進行在線的整定。

PID參數的設定是靠經驗及工藝的熟悉,參考測量值與設定值曲線,從而調整Kp、Ki和Kd的大小。模糊控制規則是用于修正PID參數的，模糊控制規則根據過程的階躍響應情況來考慮求取。規則如下所示：

（1）預選擇一個足夠短的采樣周期讓系統工作;

（2）僅加入比例控制環節,直到系統對輸入的階躍響應出現臨界振蕩,記下這時的比例放大系數和臨界振蕩周期;

（3）根據下面的具體規則修改PID控制器參數，直至滿意為止。

根據上面所述的模糊控制規則，采用如下的PID參數(如表1所示)的調節規則，如表2、表3、表4所示。

4 輸出量解模糊

依據速度模糊控制參數整定規則确定出輸出量後，得到的隻是一個模糊集合，在實際應用中，必須用一個精确量控制被控對象，在模糊集合中，取一個最能代表這個模糊集合的單值過程稱為解模糊裁決。

常用的解模糊算法有最大隸屬度法、加權平均法等，根據實際情況，采用加權平均法進行解模糊。模糊PID控制程序流程如圖3所示。

5 實驗結果

為驗證參數模糊自整定PID控制器的有效性，文中對直流電機分别做了常規PID控制和模糊PID控制實驗。實驗中給定輪速為50r/min。相比常規PID控制算法，采用參數模糊自整定PID算法能夠明顯降低超調量，加快響應速度，改善控制系統對輪速的控制效果。

6 結 論

機器人運動控制系統是整個Robocup機器人系統的執行機構，在場上的表現直接影響了整個足球機器人系統。文中以足球機器人為平台，考慮到系統的時滞性和非線性，采用模糊控制與PID控制相結合的方式，并在自行研制的足球機器人上進行了速度控制的實驗研究。結果表明，該方法彌補了常規PID控制應用在機器人運動速度控制時超調量大，響應時間長的缺點，可以取得理想的效果。

更多精彩资讯请关注tft每日頭條，我们将持续为您更新最新资讯!