新聞中心

EEPW首頁 > 嵌入式系統(tǒng) > 設(shè)計應用 > 基于51單片機的智能小車(遙控模塊尋跡避障)

基于51單片機的智能小車(遙控模塊尋跡避障)

作者: 時間:2016-11-29 來源:網(wǎng)絡(luò) 收藏
/***********************************循跡模塊***********************************/void track(){if(Left_1_led==0&&Right_1_led==0) //有信號為0 沒有信號為1run();else{ if(Left_1_led==0&&Right_1_led==1) //右邊檢測到黑線{ rightrun();} if(Right_1_led==0&&Left_1_led==1) //左邊檢測到黑線{ leftrun();}if(Right_1_led==1&&Left_1_led==1) //左邊檢測到黑線{ stop();}}}/***********************************避障***************************************/void bar(){if(Left_2_led==1&&Right_2_led==1) //有信號為0 沒有信號為1run();else{ if(Left_2_led==1&&Right_2_led==0) //右邊檢測到障礙{ leftrun();} if(Right_2_led==1&&Left_2_led==0) //左邊檢測到障礙{ rightrun();}if(Right_2_led==0&&Left_2_led==0) //左右邊都檢測到障礙{ rightrun();}} }/**********************************主函數(shù)**************************************/void main(void){while(1) /*無限循環(huán)*/{if(P2_4 == 0){delay(10);//延時去抖動if(P2_4==0){stop();while(P2_5&P2_6){remotecontrol();}}}if(P2_5 == 0){delay(10);//延時去抖動if(P2_5==0){while(P2_4&P2_6){track(); } }}if(P2_6 == 0){delay(10);//延時去抖動if(P2_6==0){while(P2_4&P2_5){bar(); } }}}}
上一頁 1 2 下一頁

評論


技術(shù)專區(qū)

關(guān)閉