UltraSonicWIthmotorDc
با سلام.
من میخوام وقتی رباتم مانع دید؛ از حرکت بایستد.
در ابتدا ماژول التراسونیک را بدون موتور تست کردم و اندازه های معقولی میداد(برای تست سالم بودن قطعه)
مشکل1:
اما وقتی با موتور تست کردم و سریال مانیتور رو دیدم (مثلا مانع در 10 cm هس در بین کار یهو یه عدد 2cm میده )
مشکل 2:
موتور هام وقتی مانع میزارم جلوش توقف نمیکنه ( برنامه ای که نوشتمم گذاشتم)
واقعا گیر کردم تا ربات مسیر یابم کامل شودلطفا در صورت امکان جواب مشخص وکامل بدین.. اگه مشکل از برنانمم نیس از چی میتونه باشه؟؟
با تشکر
[/CPP][/FONT][/COLOR]من میخوام وقتی رباتم مانع دید؛ از حرکت بایستد.
در ابتدا ماژول التراسونیک را بدون موتور تست کردم و اندازه های معقولی میداد(برای تست سالم بودن قطعه)
مشکل1:
اما وقتی با موتور تست کردم و سریال مانیتور رو دیدم (مثلا مانع در 10 cm هس در بین کار یهو یه عدد 2cm میده )
مشکل 2:
موتور هام وقتی مانع میزارم جلوش توقف نمیکنه ( برنامه ای که نوشتمم گذاشتم)
واقعا گیر کردم تا ربات مسیر یابم کامل شودلطفا در صورت امکان جواب مشخص وکامل بدین.. اگه مشکل از برنانمم نیس از چی میتونه باشه؟؟
با تشکر
int Trigerpin=13
[FONT=Yekan]int Echopin=2[/FONT];
unsigned long duration,cm;
int EnA=3;
int In1=4;
int In2=5;
//=============================== Motor 1
int EnB=6;
int In3=7;
int In4=8;
void setup() {
// put your setup code here, to run once:
pinMode(In1,OUTPUT);
pinMode(In2,OUTPUT);
pinMode(In3,OUTPUT);
pinMode(In4,OUTPUT);
pinMode(Echopin,INPUT);
pinMode(Trigerpin,OUTPUT);
Serial.begin(9600);
}
void loop() {
// put your main code here, to run repeatedly:
analogWrite(EnA,100);
analogWrite(EnB,100);
digitalWrite(In1,HIGH);
digitalWrite(In2,LOW);
digitalWrite(In3,HIGH);
digitalWrite(In4,LOW);
digitalWrite(Trigerpin,LOW);
delayMicroseconds(2);
digitalWrite(Trigerpin,HIGH);
delayMicroseconds(10);
digitalWrite(Trigerpin,LOW);
duration=pulseIn(Echopin,HIGH);
cm=Micro_Cm(duration);
Serial.print(" Cm = ");
Serial.println(cm);
if(cm<6){
analogWrite(EnA,0);
analogWrite(EnB,0);
}
delay(500);
}
unsigned long Micro_Cm(unsigned long MicroS){
return (MicroS/2)*0.0344;
[COLOR=#333333][FONT=IRANSans-engilsh][COLOR=#222222][FONT=Yekan] }[/FONT][/COLOR][/FONT][/COLOR]
دیدگاه