基于51單片機的智能小車(遙控模塊尋跡避障) 作者: 時間:2016-11-29 來源:網(wǎng)絡(luò) 加入技術(shù)交流群 掃碼加入和技術(shù)大咖面對面交流海量資料庫查詢 收藏 /***********************************循跡模塊***********************************/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 下一頁
評論