งานที่ 19 หุ่นยนต์เดินตาม เปลวไฟ Fire Extinguisher

HARDWARE

SOFTWARE

// Motor A pins (enableA = enable motor, pinA1 = forward, pinA2 = backward)
int enableA = 3;
int pinA1 = 6;
int pinA2 = 7;
 
//Motor B pins (enabledB = enable motor, pinB2 = forward, pinB2 = backward)
int enableB = 5;
int pinB1 = 8;
int pinB2 = 9;
 
int sensor[5] = {0, 0, 0, 0, 0};
 
void setup()
{
  pinMode(enableA, OUTPUT);
  pinMode(pinA1, OUTPUT);
  pinMode(pinA2, OUTPUT);
 
  pinMode(enableB, OUTPUT);
  pinMode(pinB1, OUTPUT);
  pinMode(pinB2, OUTPUT);
 
  enableMotors();
  analogWrite(enableA, 120);  // ปรับค่าความเร็วของหุ่นยนต์
  analogWrite(enableB, 120);  // ปรับค่าความเร็วของหุ่นยนต์
 
  delay(2000);
 
}
 
void loop()
{
 
 
 
  sensor[0] = analogRead(A1);
  sensor[1] = analogRead(A2);
  sensor[2] = analogRead(A3);
  sensor[3] = analogRead(A4);
  sensor[4] = analogRead(A5);
 
  if ((sensor[0] > sensor[1]) && (sensor[0] > sensor[2]) && (sensor[0] > sensor[3]) && (sensor[0] > sensor[4]))
    turnLeft(200);
  else if ((sensor[1] > sensor[0]) && (sensor[1] > sensor[2]) && (sensor[1] > sensor[3]) && (sensor[1] > sensor[4]))
    turnLeft(100);
  else if ((sensor[2] > sensor[0]) && (sensor[2] > sensor[1]) && (sensor[2] > sensor[3]) && (sensor[2] > sensor[4]))
    forward(1);
  else if ((sensor[3] > sensor[0]) && (sensor[3] > sensor[1]) && (sensor[3] > sensor[2]) && (sensor[3] > sensor[4]))
    turnRight(100);
  else if ((sensor[4] > sensor[0]) && (sensor[4] > sensor[1]) && (sensor[4] > sensor[2]) && (sensor[4] > sensor[3]))
    turnRight(200);
 
  else
    coast(100);
}
 
//Define high-level H-bridge commands
 
void enableMotors()
{
  motorAOn();
  motorBOn();
}
 
void disableMotors()
{
  motorAOff();
  motorBOff();
}
 
void forward(int time)
{
  motorAForward();
  motorBForward();
  delay(time);
}
 
void backward(int time)
{
  motorABackward();
  motorBBackward();
  delay(time);
}
 
void turnLeft(int time)
{
  motorABackward();
  motorBForward();
  delay(time);
}
 
void turnRight(int time)
{
  motorAForward();
  motorBBackward();
  delay(time);
}
 
void coast(int time)
{
  motorACoast();
  motorBCoast();
  delay(time);
}
 
void brake(int time)
{
  motorABrake();
  motorBBrake();
  delay(time);
}
//Define low-level H-bridge commands
 
//enable motors
void motorAOn()
{
  digitalWrite(enableA, HIGH);
}
 
void motorBOn()
{
  digitalWrite(enableB, HIGH);
}
 
//disable motors
void motorAOff()
{
  digitalWrite(enableB, LOW);
}
 
void motorBOff()
{
  digitalWrite(enableA, LOW);
}
 
//motor A controls
void motorAForward()
{
  digitalWrite(pinA1, HIGH);
  digitalWrite(pinA2, LOW);
}
 
void motorABackward()
{
  digitalWrite(pinA1, LOW);
  digitalWrite(pinA2, HIGH);
}
 
//motor B controls
void motorBForward()
{
  digitalWrite(pinB1, HIGH);
  digitalWrite(pinB2, LOW);
}
 
void motorBBackward()
{
  digitalWrite(pinB1, LOW);
  digitalWrite(pinB2, HIGH);
}
 
//coasting and braking
void motorACoast()
{
  digitalWrite(pinA1, LOW);
  digitalWrite(pinA2, LOW);
}
 
void motorABrake()
{
  digitalWrite(pinA1, HIGH);
  digitalWrite(pinA2, HIGH);
}
 
void motorBCoast()
{
  digitalWrite(pinB1, LOW);
  digitalWrite(pinB2, LOW);
}
 
void motorBBrake()
{
  digitalWrite(pinB1, HIGH);
  digitalWrite(pinB2, HIGH);
}

ความคิดเห็น

แสดงความคิดเห็น

โพสต์ยอดนิยมจากบล็อกนี้

งาน FLOWCHART

รูปภาพ
ผังงาน (Flowchart)  คือ แผนภาพแสดงลำดับขั้นตอนการทำงานของ Algorithm, Workflow, Process เป็นเครื่องมือใช้การรวบรวมจัดลำดับความคิด เพื่อให้เห็นขั้นตอนการทำงานที่ชัดเจนและใช้วางแผนการทำงานขั้นแรก โดยสัญลักษณ์ Flowchart แสดงถึงการทำงานลักษณะต่างๆ เชื่อมต่อกัน  Flowchart  ถูกใช้ในการออกแบบ เพื่อช่วยให้เห็นภาพสิ่งที่เกิดขึ้นและช่วยให้เข้าใจกระบวนการทำงานและบางทีอาจช่วยหาข้อบกพร่องภายในงานอีกด้วย เช่น ปัญหาคอขวด (ปัญหาที่มีงานไปกองที่ส่วนใดส่วนหนึ่งและส่วนอื่นเกิดการรอ) เป็นต้น ประวัติของ Flowchart เริ่มต้นครั้งแรก Flowchart ถูกนำเสนอโดย Frank Gilbreth เป็นสมาชิกของ American Society of Machanical Engineers (ASME) ในปี 1921 และถูกพัฒนาในวงการอุตสาหกรรมและวิศวกรรม จนออกเป็นเวอร์ชั่นที่เป็นมาตรฐานในปี 1947 ที่เราใช้กันมาถึงปัจจุบัน  ในปี 1949 Herman Goldstine และ John von Neumann ได้นำมาพัฒนาต่อเนื่องให้นำไปประยุกต์ใช้กับโปรแกรมคอมพิวเตอร์ (Computer Program) และการเขียนโปรแกรม (Computer Programming) ต่อมาได้ถูกรับรองโดยวิศวกรของ IBM และใช้ต่อจนถึงปัจจุบั...
อ่านเพิ่มเติม

งาน arduino 5 photo transistor

รูปภาพ
photo transistor Code Arduino const byte Input = A1; const byte LED = 5; void setup(){   pinMode(Input,INPUT);   pinMode(LED,OUTPUT);   digitalWrite(LED,LOW);   analogReference(DEFAULT);   Serial.begin(9600); } void loop(){   float distance = analogRead(Input);     Serial.println(distance);   if(distance > 170){ //have objects Value between 170-255       distance = (1/distance)*100000; //Scale       digitalWrite(LED, HIGH); //LED on        delay(distance); //delay       digitalWrite(LED, LOW); //LED off       delay(distance); //delay   }   else //value 0-170    digitalWrite(LED,LOW); }           รูปถ่ายการทดลองประกอบตัวอย่าง ตัวอย่างการออกแบบวงจร  ตัวอย่างการต่อวงจร การทดลองโดยนำกระดาษมาบังแสงตรงโฟโต้ทรานซิสเตอร์
อ่านเพิ่มเติม

mini project วัดความกดอากาศและความสูงแสดงผลทางจอLCD

รูปภาพ
Arduino Barometer Project Using BMP180   Nikodem Bartnik   Arduino Projects Pressure sensors are widely used in drones, weather stations, smartphones and more. It is important to know how this small piece of technology works. We are going to be using the BPM180 sensor. The name of the module is GY-68. The small device can read, pressure, altitude, and temperature. Let’s build a small device that uses BPM180 to read pressure and altitude and uses an I2C LCD display to show that information (You can as well choose to display it on the serial port). Here are the components we need: 1 x Arduino Uno Board 1 x BMP180 pressure sensor 1 x I2C LCD Jumpers wires As usual, we need to do the connection before uploading the sketch into the board. Because both the LCD and the pressure sensor use the I2C, we have to connect the pins SDA and SCL to the analog pins 4 and 5. Some barometers have a Vin pin and some a 3V3 pin. If yours has a Vin, it should...
อ่านเพิ่มเติม