基于模糊控制的智能競速車(chē)舵機轉向系統設計
(2) 舵機的控制
本系統采用的控制信號為周期13ms的脈沖信號,改變脈沖寬度就可以改變舵機的方向,另外脈沖寬度和轉角成線(xiàn)性關(guān)系[14-16],其計算公式為:
a=(l-1.5)×90° (1)
其中a是舵機的轉角,單位是度;l是脈沖寬度,單位是毫秒。其轉角和脈沖寬度的對應關(guān)系如圖2所示。

圖2 舵機的控制
在硬件實(shí)現上,利用了一路16位的pwm來(lái)驅動(dòng)舵機轉向。
模糊控制方案的設計
模糊控制器有三個(gè)功能模塊:模糊化,模糊推理,清晰化,如圖3所示。

圖3 模糊控制器
模糊子集和隸屬函數的建立紅外接收管編碼如圖4所示。

圖4 紅外接受管編碼
本系統模糊控制器采用常規模糊控制器,其輸入量為當前位置偏差e,輸出量為舵機控制信號u。
位置偏差e是光電傳感器反饋回的實(shí)際位置與智能車(chē)中軸線(xiàn)的偏差。e為零時(shí),智能車(chē)未偏離路徑;e為正數時(shí),智能車(chē)向左偏離路徑;e為負數時(shí),智能車(chē)向右偏離路徑。其偏離范圍e(論域,單位為cm)為[-9,9],將論域離散化為整數集e={-9,-6,-3,0,3,6,9},則量化因子k=n/x=1.0。
將位置偏差e的值模糊化。設模糊子集e={nb,nm,ns,ze,ps,pm,pb},其中,nb:[-9,-6],表示左偏特大;nm:[-9,-3],表示左偏較大;ns:[-6,0],表示左偏較??;ze:[-3,3],表示正中;ps:[0,6],表示右偏較??;pm:[3,9],表示右偏較大;pb:[6,9],表示右偏特大。
e的隸屬函數為三角形函數分布,如圖5所示。

圖5 e的隸屬度函數
pid控制器相關(guān)文章:pid控制器原理
評論