![]() |
zhangsm 發表于 2017-5-21 13:11 謝謝回復,這里邊有3個模式,模式1為尋跡,模式2為避障,模式3為遙控,我估計是程序之間有干擾,我只想用模式2,我把模式1和3都屏蔽掉了,只用模式2,D3閃爍頻次減輕了很多,小車可以正常運行。 另外,我不想調低避障的靈敏度,這樣小車老是撞墻后才傳感器才反應。 謝謝 |
是圖中的D3閃嗎?。 調整W1電位器改變左避障靈敏度。也可試一試有障礙時,V3收到V1的反射光,LM393的1腳電位低D3亮,用易拉罐皮卷一個6MM的小管套在V3上,不讓它接受到光線這時LM393的1腳電位高D3不亮。 |
有大神能幫助解決嗎????? |
#ifndef _LED_H_ #define _LED_H_ //定義小車驅動模塊輸入IO口 sbit IN1=P1^2; sbit IN2=P1^3; sbit IN3=P1^4; sbit IN4=P1^5; sbit EN1=P1^6; sbit EN2=P1^7; /***蜂鳴器接線定義*****/ sbit BUZZ=P2^3; //#define Left_1_led P3_3 // 左傳感器 //#define Right_1_led P3_2 //右傳感器 #define Left_moto_pwm P1_6 //PWM信號端 #define Right_moto_pwm P1_7 //PWM信號端 #define Left_moto_go {P1_2=1,P1_3=0;} //左電機向前走 #define Left_moto_back {P1_2=0,P1_3=1;} //左邊電機向后轉 #define Left_moto_Stop {P1_2=0,P1_3=0;} //左邊電機停轉 #define Right_moto_go {P1_4=1,P1_5=0;} //右邊電機向前走 #define Right_moto_back {P1_4=0,P1_5=1;} //右邊電機向后走 #define Right_moto_Stop {P1_4=0,P1_5=0;} //右邊電機停轉 unsigned char pwm_val_left =0;//變量定義 unsigned char push_val_left =0;// 左電機占空比N/20 unsigned char pwm_val_right =0; unsigned char push_val_right=0;// 右電機占空比N/20 bit Right_moto_stop=1; bit Left_moto_stop =1; unsigned int time3=0; /************************************************************************/ //延時函數 void delay(unsigned int k) { unsigned int x,y; for(x=0;x<k;x++) for(y=0;y<2000;y++); } /************************************************************************/ //前速前進 void run(void) { push_val_left=6; //速度調節變量 0-20。。。0最小,20最大 push_val_right=6; Left_moto_go ; //左電機往前走 Right_moto_go ; //右電機往前走 } //前速后退 void back(void)//后退 { push_val_left=13; //速度調節變量 0-20。。。0最小,20最大 push_val_right=13; Left_moto_back ; //左電機往前走 Right_moto_back ; //右電機往前走 } //左轉 void leftrun(void) { push_val_left=6; push_val_right=14; Right_moto_go ; //右電機往前走 Left_moto_back ; //左電機后走 } //右轉 void rightrun(void) { push_val_left=14; push_val_right=6; Left_moto_go ; //左電機往前走 Right_moto_back ; //右電機往后走 } //停止 void stop(void) { P1_2 = 0; P1_3 = 0; P1_4 = 0; P1_5 = 0; } /************************************************************************/ /* PWM調制電機轉速 */ /************************************************************************/ /* 左電機調速 */ /*調節push_val_left的值改變電機轉速,占空比 */ void pwm_out_left_moto(void) { if(Left_moto_stop) { if(pwm_val_left<=push_val_left) { Left_moto_pwm=1; } else { Left_moto_pwm=0; } if(pwm_val_left>=20) pwm_val_left=0; } else { Left_moto_pwm=0; } } /******************************************************************/ /* 右電機調速 */ void pwm_out_right_moto(void) { if(Right_moto_stop) { if(pwm_val_right<=push_val_right) { Right_moto_pwm=1; } else { Right_moto_pwm=0; } if(pwm_val_right>=20) pwm_val_right=0; } else { Right_moto_pwm=0; } } /***************************************************/ ///*TIMER0中斷服務子函數產生PWM信號*/ void timer0()interrupt 1 using 2 { TL0 = 0x66; //設置定時初值 TH0 = 0xFC; //設置定時初值 time3++; pwm_val_left++; pwm_val_right++; pwm_out_left_moto(); pwm_out_right_moto(); } /*********************************************************************/ #endif |
|
這個是小車的原理圖 |
105.15 KB, 下載次數: 7
67.53 KB, 下載次數: 7