飛思卡爾智能車舵機和測速的控制設計與實現(xiàn)

舵機由舵盤、位置反饋電位計、減速齒輪組、直流動電機和控制電路組成，內部位置反饋減速齒輪組由直流電動機驅動，其輸出軸帶動一個具有線性比例特性的位置反饋電位器作為位置檢測。當電位器轉角線性地轉換為電壓并反饋給控制電路時，控制電路將反饋信號與輸入的控制脈沖信號相比較，產(chǎn)生糾正脈沖，控制并驅動直流電機正向或反向轉動，使減速齒輪組輸出的位置與期望值相符。從而達到舵機精確控制轉向角度的目的。舵機工作原理框圖如圖3所示。

2．2 舵機的安裝與調節(jié)
舵機的控制脈寬與轉角在-45°～+45°范圍內線性變化。對于對速度有一定要求的智能車，舵機的響應速度和舵機的轉向傳動比直接影響車模能否以最佳速度順利通過彎道。車模在賽道上高速行駛，特別是對于前瞻性不夠遠的紅外光電檢測智能車，舵機的響應速度及其轉向傳動比將直接影響車模行駛的穩(wěn)定性，因此必須細心調試，逐一解決。由于舵機從執(zhí)行轉動指令到響應輸出需占用一定的時間，因而產(chǎn)生舵機實時控制的滯后。雖然車模在進入彎道時能夠檢測到黑色路線的偏轉方向，但由于舵機的滯后性，使得車模在轉彎過程中時常偏離跑道，且速度越快，偏離越遠，極大限制車模在連續(xù)彎道上行駛的最大時速，使得車模全程賽道速度很難進一步提高。為了減小舵機響應時間，在遵守比賽規(guī)則不允許改造舵機結構的前提下，利用杠桿原理，采用加長舵機力臂的方案來彌補這一缺陷，加長舵機力臂示意圖如圖4所示。

圖4中，R為舵機力臂；θ為舵機轉向角度；F為轉向所需外力；α為外力同力臂的夾角。在舵機輸出盤上增加長方形杠桿，在杠桿的末端固定轉向傳動連桿，其表達式為：

加長力臂后欲使前輪轉動相同角度時，在舵機角速度ω相同的條件下舵機力臂加長后增大了線速度v，最終使得舵機的轉向角度θ減小。舵機輸出轉角θ減小，舵機的響應時間t也會變短。同時由式(1)可推出線速度口增大后，前輪轉向所需的時間t相應也會變短，其表達式為：t=ds／dv (2)
此外，當舵機連桿水平且與舵機力臂垂直時，得到力矩M，可由式(3)表示：M=FRsinα (3)
說明當舵機連桿和舵機力臂垂直時α=900°，此時sinα得到最大值。在舵機力臂R一定和外力F相同條件下，舵機產(chǎn)生的力矩M最大，實現(xiàn)前輪轉向的時間最短。