版權(quán)說(shuō)明:本文檔由用戶(hù)提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)
文檔簡(jiǎn)介
舵機(jī)是一種位置伺服的驅(qū)動(dòng)器,適用于那些需要角度不斷變化并可以保持的控制系統(tǒng)其工作原理是:控制信號(hào)由接收機(jī)的通道進(jìn)入信號(hào)調(diào)制芯片,獲得直流偏置電壓它內(nèi)部有一個(gè)基準(zhǔn)電路,產(chǎn)生周期為20ms,寬度為1.5ms的基準(zhǔn)信號(hào),將獲得的直流偏置電壓與電位器的電壓比較,獲得電壓差輸出最后,電壓差的正負(fù)輸出到電機(jī)驅(qū)動(dòng)芯片決定電機(jī)的正反轉(zhuǎn)當(dāng)電機(jī)轉(zhuǎn)速一定時(shí),通過(guò)級(jí)聯(lián)減速齒輪帶動(dòng)電0位器旋轉(zhuǎn),使得電壓差為0,電機(jī)停止轉(zhuǎn)動(dòng)舵機(jī)的控制信號(hào)是PWM信號(hào),利用占空比的變化改變舵機(jī)的位置一般舵機(jī)的控制要求如圖1所示圖1舵機(jī)的控制要求單片機(jī)實(shí)現(xiàn)舵機(jī)轉(zhuǎn)角控制可以使用FPGA、模擬電路、單片機(jī)來(lái)產(chǎn)生舵機(jī)的控制信號(hào),但FPGA成本高且電路復(fù)雜對(duì)于脈寬調(diào)制信號(hào)的脈寬變換,常用的一種方法是采用調(diào)制信號(hào)獲取有源濾波后的直流電壓,但是需要50Hz(周期是20ms)的信號(hào),這對(duì)運(yùn)放器件的選擇有較高要求,從電路體積和功耗考慮也不易采用。5mV以上的控制電壓的變化就會(huì)引起舵機(jī)的抖動(dòng),對(duì)于機(jī)載的測(cè)控系統(tǒng)而言,電源和其他器件的信號(hào)噪聲都遠(yuǎn)大于5mV,所以濾波電路的精度難以達(dá)到舵機(jī)的控制精度要求也可以用單片機(jī)作為舵機(jī)的控制單元,使PWM信號(hào)的脈沖寬度實(shí)現(xiàn)微秒級(jí)的變化,從而提高舵機(jī)的轉(zhuǎn)角精度單片機(jī)完成控制算法,再將計(jì)算結(jié)果轉(zhuǎn)化為PWM信號(hào)輸出到舵機(jī),由于單片機(jī)系統(tǒng)是一個(gè)數(shù)字系統(tǒng),其控制信號(hào)的變化完全依靠硬件計(jì)數(shù),所以受外界干擾較小,整個(gè)系統(tǒng)工作可靠單片機(jī)系統(tǒng)實(shí)現(xiàn)對(duì)舵機(jī)輸出轉(zhuǎn)角的控制,必須首先完成兩個(gè)任務(wù):首先是產(chǎn)生基本的PWM周期信號(hào),本設(shè)計(jì)是產(chǎn)生20ms的周期信號(hào);其次是脈寬的調(diào)整,即單片機(jī)模擬PWM信號(hào)的輸出,并且調(diào)整占空比當(dāng)系統(tǒng)中只需要實(shí)現(xiàn)一個(gè)舵機(jī)的控制,采用的控制方式是改變單片機(jī)的一個(gè)定時(shí)器中斷的初值,將20ms分為兩次中斷執(zhí)行,一次短定時(shí)中斷和一次長(zhǎng)定時(shí)中斷這樣既節(jié)省了硬件電路,也減少了軟件開(kāi)銷(xiāo),控制系統(tǒng)工作效率和控制精度都很高具體的設(shè)計(jì)過(guò)程:例如想讓舵機(jī)轉(zhuǎn)向左極限的角度,它的正脈沖為2ms,則負(fù)脈沖為20ms-2ms=18ms,所以開(kāi)始時(shí)在控制口發(fā)送高電平,然后設(shè)置定時(shí)器在2ms后發(fā)生中斷,中斷發(fā)生后,在中斷程序里將控制口改為低電平,并將中斷時(shí)間改為18ms,再過(guò)18ms進(jìn)入下一次定時(shí)中斷,再將控制口改為高電平,并將定時(shí)器初值改為2ms,等待下次中斷到來(lái),如此往復(fù)實(shí)現(xiàn)PWM信號(hào)輸出到舵機(jī)用修改定時(shí)器中斷初值的方法巧妙形成了脈沖信號(hào),調(diào)整時(shí)間段的寬度便可使伺服機(jī)靈活運(yùn)動(dòng)為保證軟件在定時(shí)中斷里采集其他信號(hào),并且使發(fā)生PWM信號(hào)的程序不影響中斷程序的運(yùn)行(如果這些程序所占用時(shí)間過(guò)長(zhǎng),有可能會(huì)發(fā)生中斷程序還未結(jié)束,下次中斷又到來(lái)的后果),所以需要將采集信號(hào)的函數(shù)放在長(zhǎng)定時(shí)中斷過(guò)程中執(zhí)行,也就是說(shuō)每經(jīng)過(guò)兩次中斷執(zhí)行一次這些程序,執(zhí)行的周期還是20ms軟件流程如圖2所示圖2產(chǎn)生PWM信號(hào)的軟件流程如果系統(tǒng)中需要控制幾個(gè)舵機(jī)的準(zhǔn)確轉(zhuǎn)動(dòng),可以用單片機(jī)和計(jì)數(shù)器進(jìn)行脈沖計(jì)數(shù)產(chǎn)生PWM信號(hào)脈沖計(jì)數(shù)可以利用51單片機(jī)的內(nèi)部計(jì)數(shù)器來(lái)實(shí)現(xiàn),但是從軟件系統(tǒng)的穩(wěn)定性和程序結(jié)構(gòu)的合適性看,宜使用外部的計(jì)數(shù)器,還可以提高CPU的工作效率實(shí)驗(yàn)后從精度上考慮,對(duì)于FUTABA系列的接收機(jī),當(dāng)采用1MHz的外部晶振時(shí),其控制電壓幅值的變化為0.6mV,而且不會(huì)出現(xiàn)誤差積累,可以滿(mǎn)足控制舵機(jī)的要求最后考慮數(shù)字系統(tǒng)的離散誤差,經(jīng)估算誤差的范圍在±0.3%內(nèi),所以采用單片機(jī)和8253、8254這樣的計(jì)數(shù)器芯片的PWM信號(hào)產(chǎn)生電路是可靠的圖3是硬件連接圖
圖3PWA信號(hào)的計(jì)數(shù)和輸出電路(點(diǎn)擊放大)基于8253產(chǎn)生PWM信號(hào)的程序主要包括三方面內(nèi)容:一是定義8253寄存器的地址,二是控制字的寫(xiě)入,三是數(shù)據(jù)的寫(xiě)入軟件流程如圖4所示,具體代碼如下//定時(shí)器T0中斷,向8253發(fā)送控制字和數(shù)據(jù)
voidT0Int()interrupt1
{
TH0=0xB1;
TL0=0xE0;//20ms的時(shí)鐘基準(zhǔn)
//先寫(xiě)入控制字,再寫(xiě)入計(jì)數(shù)值
SERVO0=0x30;//選擇計(jì)數(shù)器0,寫(xiě)入控制字
PWM0=BUF0L;//先寫(xiě)低,后寫(xiě)高
PWM0=BUF0H;
SERVO1=0x70;//選擇計(jì)數(shù)器1,寫(xiě)入控制字
PWM1=BUF1L;
PWM1=BUF1H;
SERVO2=0xB0;//選擇計(jì)數(shù)器2,寫(xiě)入控制字
PWM2=BUF2L;
PWM2=BUF2H;
}
圖4基于8253產(chǎn)生PWA信號(hào)的軟件流程當(dāng)系統(tǒng)的主要工作任務(wù)就是控制多舵機(jī)的工作,并且使用的舵機(jī)工作周期均為20ms時(shí),要求硬件產(chǎn)生的多路PWM波的周期也相同使用51單片機(jī)的內(nèi)部定時(shí)器產(chǎn)生脈沖計(jì)數(shù),一般工作正脈沖寬度小于周期的1/8,這樣可以在1個(gè)周期內(nèi)分時(shí)啟動(dòng)各路PWM波的上升沿,再利用定時(shí)器中斷T0確定各路PWM波的輸出寬度,定時(shí)器中斷T1控制20ms的基準(zhǔn)時(shí)間第1次定時(shí)器中斷T0按20ms的1/8設(shè)置初值,并設(shè)置輸出I/O口,第1次T0定時(shí)中斷響應(yīng)后,將當(dāng)前輸出I/O口對(duì)應(yīng)的引腳輸出置高電平,設(shè)置該路輸出正脈沖寬度,并啟動(dòng)第2次定時(shí)器中斷,輸出I/O口指向下一個(gè)輸出口第2次定時(shí)器定時(shí)時(shí)間結(jié)束后,將當(dāng)前輸出引腳置低電平,設(shè)置此中斷周期為20ms的1/8減去正脈沖的時(shí)間,此路PWM信號(hào)在該周期中輸出完畢,往復(fù)輸出在每次循環(huán)的第16次(2×8=16)中斷實(shí)行關(guān)定時(shí)中斷T0的操作,最后就可以實(shí)現(xiàn)8路舵機(jī)控制信號(hào)的輸出也可以采用外部計(jì)數(shù)器進(jìn)行多路舵機(jī)的控制,但是因?yàn)槌R?jiàn)的8253、8254芯片都只有3個(gè)計(jì)數(shù)器,所以當(dāng)系統(tǒng)需要產(chǎn)生多路PWM信號(hào)時(shí),使用上述方法可以減少電路,降低成本,也可以達(dá)到較高的精度調(diào)試時(shí)注意到由于程序中脈沖寬度的調(diào)整是靠調(diào)整定時(shí)器的初值,中斷程序也被分成了8個(gè)狀態(tài)周期,并且需要嚴(yán)格的周期循環(huán),而且運(yùn)行其他中斷程序代碼的時(shí)間需要嚴(yán)格把握在實(shí)際應(yīng)用中,采用51單片機(jī)簡(jiǎn)單方便地實(shí)現(xiàn)了舵機(jī)控制需要的PWM信號(hào)對(duì)機(jī)器人舵機(jī)控制的測(cè)試表明,舵機(jī)控制系統(tǒng)工作穩(wěn)定,PWM占空比(0.5~2.5ms的正脈沖寬度)和舵機(jī)的轉(zhuǎn)角(-90°~90°)線(xiàn)性度較好/***************************************************************************/
/*杭州電子&計(jì)算機(jī)工作室*/
/**/
/*步進(jìn)電機(jī)演示程序*/
/*目標(biāo)器件:AT89S51*/
/*晶振:11.0592MHZ*/
/*編譯環(huán)境:Keil7.50A*/
/***************************************************************************/
/*********************************包含頭文件********************************/
#include<reg51.h>
/*********************************端口定義**********************************/
sbitkey=P1^4;
/****************************************************************************
函數(shù)功能:延時(shí)子程序
入口參數(shù):
出口參數(shù):
****************************************************************************/
voiddelay(void)
{
intk;
for(k=0;k<2000;k++);
}
/****************************************************************************
函數(shù)功能:主程序
入口參數(shù):
出口參數(shù):
****************************************************************************/
voidmain()
{
P0=0x00;//輸出全高
key=1;//按鍵置輸入狀態(tài)
while(1)//主循環(huán)
{
if(key==1)//無(wú)鍵按下正轉(zhuǎn)
{
P0=0xFC;//1100
delay();
P0=0xF6;//0110
delay();
P0=0xF3;//0011
delay();
P0=0xF9;//1001
delay();
}
else//有鍵按下反轉(zhuǎn)
{
P0=0xFC;//1100
delay();
P0=0xF9;//1001
delay();
P0=0xF3;//0011
delay();
P0=0xF6;//0110
delay();
}
}
}利用定時(shí)/計(jì)數(shù)器T0從P1.0輸出周期為1s的方波,
讓發(fā)光二極管以1HZ閃爍,
#include<reg52.h>//52單片機(jī)頭文件
#include<intrins.h>//包含有左右循環(huán)移位子函數(shù)的庫(kù)
#defineuintunsignedint//宏定義
#defineucharunsignedchar//宏定義
sbitP1_0=P1^0;
uchartt;
voidmain()//主函數(shù)
{
TMOD=0x01;//設(shè)置定時(shí)器0為工作方式1
TH0=(65536-50000)/256;
TL0=(65536-50000)%256;
EA=1;//開(kāi)總中斷
ET0=1;//開(kāi)定時(shí)器0中斷
TR0=1;//啟動(dòng)定時(shí)器0
while(1);//等待中斷產(chǎn)生
}
voidtimer0()interrupt1
{
TH0=(65536-50000)/256;
TL0=(65536-50000)%256;
tt++;
if(tt==20)
{
tt=0;
P1_0=~P1_0;
}
}//12MHz
#include<reg51.h>
voidInitTimer0(void)
{
TMOD=0x01;
TH0=0x0B1;
TL0=0x0E0;
EA=1;
ET0=1;
TR0=1;
}
voiddelay(void)//誤差0us延時(shí)1ms此處可以修改高電平周期
//修改此處的延時(shí)可以更改舵機(jī)轉(zhuǎn)的角度,45度具體是多少你可以試試
{
unsignedchara,b,c
溫馨提示
- 1. 本站所有資源如無(wú)特殊說(shuō)明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
- 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶(hù)所有。
- 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁(yè)內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒(méi)有圖紙預(yù)覽就沒(méi)有圖紙。
- 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
- 5. 人人文庫(kù)網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶(hù)上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶(hù)上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
- 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
- 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶(hù)因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。
最新文檔
- 漳州衛(wèi)生職業(yè)學(xué)院《助產(chǎn)學(xué)I》2023-2024學(xué)年第一學(xué)期期末試卷
- 漳州科技職業(yè)學(xué)院《數(shù)據(jù)可視化實(shí)現(xiàn)》2023-2024學(xué)年第一學(xué)期期末試卷
- 張家口職業(yè)技術(shù)學(xué)院《多高層建筑結(jié)構(gòu)課程設(shè)計(jì)》2023-2024學(xué)年第一學(xué)期期末試卷
- 棗莊學(xué)院《商務(wù)數(shù)據(jù)分析與應(yīng)用》2023-2024學(xué)年第一學(xué)期期末試卷
- 運(yùn)城護(hù)理職業(yè)學(xué)院《電視專(zhuān)題與專(zhuān)欄》2023-2024學(xué)年第一學(xué)期期末試卷
- 2025年投資擔(dān)保公司合同書(shū):金融衍生品交易擔(dān)保協(xié)議3篇
- 二零二五年度苗木運(yùn)輸信息化管理合同范本4篇
- 云南輕紡職業(yè)學(xué)院《創(chuàng)業(yè)理論與實(shí)踐》2023-2024學(xué)年第一學(xué)期期末試卷
- 二零二五年度體育場(chǎng)館租賃及賽事組織合同4篇
- 2025年度個(gè)人貸款合同爭(zhēng)議解決條款模板3篇
- 2024-2025學(xué)年成都高新區(qū)七上數(shù)學(xué)期末考試試卷【含答案】
- 2025年浙江杭州市西湖區(qū)專(zhuān)職社區(qū)招聘85人歷年高頻重點(diǎn)提升(共500題)附帶答案詳解
- 《數(shù)學(xué)廣角-優(yōu)化》說(shuō)課稿-2024-2025學(xué)年四年級(jí)上冊(cè)數(shù)學(xué)人教版
- “懂你”(原題+解題+范文+話(huà)題+技巧+閱讀類(lèi)素材)-2025年中考語(yǔ)文一輪復(fù)習(xí)之寫(xiě)作
- 2025年景觀(guān)照明項(xiàng)目可行性分析報(bào)告
- 2025年江蘇南京地鐵集團(tuán)招聘筆試參考題庫(kù)含答案解析
- 2025年度愛(ài)讀書(shū)學(xué)長(zhǎng)參與的讀書(shū)項(xiàng)目投資合同
- 2024年城市軌道交通設(shè)備維保及安全檢查合同3篇
- 電力系統(tǒng)分析答案(吳俊勇)(已修訂)
- 化學(xué)-河北省金太陽(yáng)質(zhì)檢聯(lián)盟2024-2025學(xué)年高三上學(xué)期12月第三次聯(lián)考試題和答案
- 期末復(fù)習(xí)試題(試題)-2024-2025學(xué)年四年級(jí)上冊(cè)數(shù)學(xué) 北師大版
評(píng)論
0/150
提交評(píng)論