จัดทำโดย
นายอนัต์สิทธิ์ ปรุงชัยภูมิ เลขที่ 15 ชอ D.2
นายชาญณเรงค์ มาสอาด เลขที่ 14 ชอ D.2
นายชานนท์ จันทร์คำ เลขที่ 6 ชอ D.2
วัสดุอุปกรณ์
1.บอร์ดทดลองArduino UNO R3 1บอร์ด
2.สาย USB 1เส้น
3.สายแพร์ 14 เส้น
4.โพโตบอร์ด 1 บอร์ด
7.มอเตอร์ 2ตัว
8.บอร์ด Motor Driver 1บอร์ด
9.บอร์ด ultrasonic sensor 1อัน
รูปวงจร
การทำงาน
เมื่อโปรแกรมเริ่มทำงานมอเตอร์ทั้งสองตัวจะทำงานและมอเตอร์จะหยุดทำงานเมื่อเซนเชอร์เจอวัตถุเข้ามาใกล้ระยะน้อยกว่า 11 ชม.
#define echoPin 8
#define trigPin 7
const int M1R = 3;
const int M1L = 4;
const int M2R = 5;
const int M2L = 6;
void setup()
{
Serial.begin(9600);
pinMode(trigPin,OUTPUT);
pinMode(echoPin,INPUT);
pinMode(M1R,OUTPUT);
pinMode(M1L,OUTPUT);
pinMode(M2R,OUTPUT);
pinMode(M2L,OUTPUT);
}
void loop()
{
int distance,duration;
digitalWrite(trigPin,HIGH);
delay(200);
digitalWrite(trigPin,LOW);
duration=pulseIn(echoPin,HIGH);
distance=(duration/2)/29.1;
Serial.println(distance);
if(distance >10) // for going forward
{
digitalWrite(M1R,HIGH);
digitalWrite(M1L,LOW);
digitalWrite(M2R,HIGH);
digitalWrite(M2L,LOW);
}
else // obstacle detected turn left
{
digitalWrite(M1R,LOW);
digitalWrite(M1L,LOW);
digitalWrite(M2R,LOW);
digitalWrite(M2L,LOW);
}
}
ไม่มีความคิดเห็น:
แสดงความคิดเห็น