龍人寶貝機器人的結(jié)構(gòu)設(shè)計與控制畢業(yè)論文-資料下載頁
2025-06-28 23:08本頁面
【正文】 //設(shè)置串行口工作方式1：SCON格式 |M0|M1|M2|REN|TB8|RB8|TI|RI TH1=0xfd。 //波特率9600 TL1=0xfd。 TR1=1。 //啟動定時器 ES=1。 //開串行口中斷} void uart_Init(){ _initialize()。 EA=1。 //CPU開總中斷}全速前進程序代碼如下：includeavr/ //寶貝車的標(biāo)準(zhǔn)頭文件includeavr/ //串口的頭文件int main(void) //主函數(shù)，程序從這里開始運行{ usta_Init()。 //串口初始化 uint16_t counter。 //定義16位無符號整型變量 SET_DDRD7。 //設(shè)置PD7為輸出口 SET_DDRC3。 //設(shè)置PC3為輸出口SET_DDRC2。 //設(shè)置PC2為輸出口 printf(Program Running\n)。//在調(diào)試窗口顯示一條信息 /*在開始時Counter被設(shè)為1，并在每次重復(fù)的最后被增加1。在循環(huán)重復(fù)前，如果Counter大于6000，則循環(huán)結(jié)束。*/for(counter=1。counter=6000。counter++) //開始/復(fù)位信號 { HIGH_PORTD7。 //設(shè)置PD7輸出高電平 delay_nus(166)。 // LOW_PORTD7。 //設(shè)置PD7輸出低電平 delay_nus(166)。 // } /*在開始時Counter被設(shè)為1，并在每次重復(fù)的最后被增加1。在循環(huán)重復(fù)前，如果Counter大于等于130，則循環(huán)結(jié)束。*/for(counter=0。counter130。counter++)//運行3秒 { HIGH_PORTC3。 //設(shè)置PC3輸出高電平 delay_nus(1700)。 // LOW_PORTC3。 //設(shè)置PC3輸出低電平 HIGH_PORTC2。 //設(shè)置PC2輸出高電平 delay_nus(1300)。 // LOW_PORTC2。 //設(shè)置PC2輸出低電平 delay_nms(20)。 //延時20ms }}紅外線導(dǎo)航程序代碼如下：includeavr/ //寶貝車的標(biāo)準(zhǔn)頭文件includeavr/ //串口的頭文件int PC0_state(void) //獲取PC0的狀態(tài){ return (PINCamp。0x01)?1:0。 // 判斷紅外和聲是否遇到探測物}int PC1_state(void) //獲取PC1的狀態(tài){ return (PINCamp。0x02)?1:0。 // 判斷紅外和聲是否遇到探測物}void IRLaunch(unsigned char IR){ int counter。 if(IR==39。L39。) for(counter=0。counter38。counter++) { HIGH_PORTD6。 delay_nus(13)。 LOW_PORTD6。 delay_nus(13)。 } if(IR==39。R39。) for(counter=0。counter38。counter++)//右邊發(fā)射 { HIGH_PORTD5。 delay_nus(13)。 LOW_PORTD5。 delay_nus(13)。 }}void Forward(void) //聲明一個前進子函數(shù){ HIGH_PORTC3。 //設(shè)置PC3輸出高電平 delay_nus(1700)。 // LOW_PORTC3。 //設(shè)置PC3輸出低電平 HIGH_PORTC2。 //設(shè)置PC2輸出高電平 delay_nus(1300)。 // LOW_PORTC2。 //設(shè)置PC2輸出低電平 delay_nms(20)。 //延時20ms}void Left_Turn(void) //聲明一個向左子函數(shù){ /*聲明定義16位無符號整型變量i，在開始時i被設(shè)為1，并在每次重復(fù)的最后被增加1。在循環(huán)重復(fù)前，如果i大于26，則循環(huán)結(jié)束。*/for(uint16_t i=1。i=26。i++) { HIGH_PORTC3。 //設(shè)置PC3輸出高電平 delay_nus(1300)。 // LOW_PORTC3。 //設(shè)置PC3輸出低電平 HIGH_PORTC2。 //設(shè)置PC2輸出高電平 delay_nus(1300)。 // LOW_PORTC2。 //設(shè)置PC2輸出低電平 delay_nms(20)。 //延時20ms }}void Right_Turn(void) //聲明一個向右子函數(shù){ /*聲明定義16位無符號整型變量i，在開始時i被設(shè)為1，并在每次重復(fù)的最后被增加1。在循環(huán)重復(fù)前，如果i大于26，則循環(huán)結(jié)束。*/for(uint16_t i=1。i=26。i++) { HIGH_PORTC3。 //設(shè)置PC3輸出高電平 delay_nus(1700)。 // LOW_PORTC3。 //設(shè)置PC3輸出低電平 HIGH_PORTC2。 //設(shè)置PC2輸出高電平 delay_nus(1700)。 // LOW_PORTC2。 //設(shè)置PC2輸出低電平 delay_nms(20)。 //延時20ms }}void Backward(void) //聲明一個向后子函數(shù){/*聲明定義16位無符號整型變量i，在開始時i被設(shè)為1，并在每次重復(fù)的最后被增加1。在循環(huán)重復(fù)前，如果i大于65，則循環(huán)結(jié)束。*/for(uint16_t i=1。i=65。i++) { HIGH_PORTC3。 //設(shè)置PC3輸出高電平 delay_nus(1300)。 // LOW_PORTC3。 //設(shè)置PC3輸出低電平 HIGH_PORTC2。 //設(shè)置PC2輸出高電平 delay_nus(1700)。 // LOW_PORTC2。 //設(shè)置PC2輸出低電平 delay_nms(20)。 //延時20ms }}int main(void) //主函數(shù)，程序從這里開始運行{ usta_Init()。 //串口初始化 int irDetectLeft。 //定義整型變量，存儲左邊IR檢測器的狀態(tài) int irDetectRight。 //定義整型變量，存儲右邊IR檢測器的狀態(tài) SET_DDRD7。 //設(shè)置PD7為輸出口 SET_DDRD6。 //設(shè)置PD6為輸出口 SET_DDRC3。 //設(shè)置PD3為輸出口 SET_DDRC2。 //設(shè)置PD2為輸出口 SET_DDRD5。 //設(shè)置PD5為輸出口 printf(Program Running!)。 //在調(diào)試窗口顯示一條信息 /*聲明定義16位無符號整型變量counter，在開始時Counter被設(shè)為1，并在每次重復(fù)的最后被增加1。在循環(huán)重復(fù)前，如果Counter大于6000，則循環(huán)結(jié)束。*/for(uint16_t counter=1。counter=6000。counter++)//開始/復(fù)位信號 { HIGH_PORTD7。 //設(shè)置PD7輸出高電平 delay_nus(166)。 // LOW_PORTD7。 //設(shè)置PD7輸出低電平 delay_nus(166)。 // } while(1) //死循環(huán) { IRLaunch(39。L39。)。 irDetectLeft=PC0_state()。//當(dāng)沒有IR信號返回時，探測器的PC0口輸出狀態(tài)為高；當(dāng)它探測到被物體反射的38500 Hz和聲時，它的輸出為低 IRLaunch(39。R39。)。 irDetectRight=PC1_state()。//當(dāng)沒有IR信號返回時，探測器的PC1口輸出狀態(tài)為高；當(dāng)它探測到被物體反射的38500 Hz和聲時，它的輸出為低 if((irDetectLeft==0)amp。amp。(irDetectRight==0))//兩邊同時接收到紅外線 { Backward()。//向后 Left_Turn()。//向左 Left_Turn()。//向左 } else if(irDetectLeft==0)//只有左邊接收到紅外線 { Backward()。//向后 Right_Turn()。//向右 } else if(irDetectRight==0)//只有右邊接收到紅外線 { Backward()。//向后 Left_Turn()。//向左 } else //沒有接收到紅外線 Forward()。//向前 }}4
環(huán)評公示相關(guān)推薦
鄂ICP備17016276號-1