利用單片機PWM信號進(jìn)行舵機控制

　　基于單片機的舵機控制方法具有簡(jiǎn)單、精度高、成本低、體積小的特點(diǎn)，并可根據不同的舵機數量加以靈活應用。

　　在機器人機電控制系統中，舵機控制效果是性能的重要影響因素。舵機可以在微機電系統和航模中作為基本的輸出執行機構，其簡(jiǎn)單的控制和輸出使得單片機系統非常容易與之接口。

　　舵機是一種位置伺服的驅動(dòng)器，適用于那些需要角度不斷變化并可以保持的控制系統。其工作原理是：控制信號由接收機的通道進(jìn)入信號調制芯片，獲得直流偏置電壓。它內部有一個(gè)基準電路，產(chǎn)生周期為20ms，寬度為1.5ms的基準信號，將獲得的直流偏置電壓與電位器的電壓比較，獲得電壓差輸出。最后，電壓差的正負輸出到電機驅動(dòng)芯片決定電機的正反轉。當電機轉速一定時(shí)，通過(guò)級聯(lián)減速齒輪帶動(dòng)電位器旋轉，使得電壓差為0，電機停止轉動(dòng)。

　　舵機的控制信號是PWM信號，利用占空比的變化改變舵機的位置。一般舵機的控制要求如圖1所示。

　　單片機實(shí)現舵機轉角控制

　　可以使用FPGA、模擬電路、單片機來(lái)產(chǎn)生舵機的控制信號，但FPGA成本高且電路復雜。對于脈寬調制信號的脈寬變換，常用的一種方法是采用調制信號獲取有源濾波后的直流電壓，但是需要50Hz(周期是20ms)的信號，這對運放器件的選擇有較高要求，從電路體積和功耗考慮也不易采用。5mV以上的控制電壓的變化就會(huì )引起舵機的抖動(dòng)，對于機載的測控系統而言，電源和其他器件的信號噪聲都遠大于5mV，所以濾波電路的精度難以達到舵機的控制精度要求。

   也可以用單片機作為舵機的控制單元，使PWM信號的脈沖寬度實(shí)現微秒級的變化，從而提高舵機的轉角精度。單片機完成控制算法，再將計算結果轉化為PWM信號輸出到舵機，由于單片機系統是一個(gè)數字系統，其控制信號的變化完全依靠硬件計數，所以受外界干擾較小，整個(gè)系統工作可靠。

　　單片機系統實(shí)現對舵機輸出轉角的控制，必須首先完成兩個(gè)任務(wù)：首先是產(chǎn)生基本的PWM周期信號，本設計是產(chǎn)生20ms的周期信號；其次是脈寬的調整，即單片機模擬PWM信號的輸出，并且調整占空比。

　　當系統中只需要實(shí)現一個(gè)舵機的控制，采用的控制方式是改變單片機的一個(gè)定時(shí)器中斷的初值，將20ms分為兩次中斷執行，一次短定時(shí)中斷和一次長(cháng)定時(shí)中斷。這樣既節省了硬件電路，也減少了軟件開(kāi)銷(xiāo)，控制系統工作效率和控制精度都很高。

　　具體的設計過(guò)程：例如想讓舵機轉向左極限的角度，它的正脈沖為2ms，則負脈沖為20ms-2ms=18ms，所以開(kāi)始時(shí)在控制口發(fā)送高電平，然后設置定時(shí)器在2ms后發(fā)生中斷，中斷發(fā)生后，在中斷程序里將控制口改為低電平，并將中斷時(shí)間改為18ms，再過(guò)18ms進(jìn)入下一次定時(shí)中斷，再將控制口改為高電平，并將定時(shí)器初值改為2ms，等待下次中斷到來(lái)，如此往復實(shí)現PWM信號輸出到舵機。用修改定時(shí)器中斷初值的方法巧妙形成了脈沖信號，調整時(shí)間段的寬度便可使伺服機靈活運動(dòng)。

　　為保證軟件在定時(shí)中斷里采集其他信號，并且使發(fā)生PWM信號的程序不影響中斷程序的運行(如果這些程序所占用時(shí)間過(guò)長(cháng)，有可能會(huì )發(fā)生中斷程序還未結束，下次中斷又到來(lái)的后果)，所以需要將采集信號的函數放在長(cháng)定時(shí)中斷過(guò)程中執行，也就是說(shuō)每經(jīng)過(guò)兩次中斷執行一次這些程序，執行的周期還是20ms。軟件流程如圖2所示。

　　如果系統中需要控制幾個(gè)舵機的準確轉動(dòng)，可以用單片機和計數器進(jìn)行脈沖計數產(chǎn)生PWM信號。

　　脈沖計數可以利用51單片機的內部計數器來(lái)實(shí)現，但是從軟件系統的穩定性和程序結構的合理性看，宜使用外部的計數器，還可以提高CPU的工作效率。實(shí)驗后從精度上考慮，對于FUTABA系列的接收機，當采用1MHz的外部晶振時(shí)，其控制電壓幅值的變化為0.6mV，而且不會(huì )出現誤差積累，可以滿(mǎn)足控制舵機的要求。最后考慮數字系統的離散誤差，經(jīng)估算誤差的范圍在