งานที่ 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); }           รูปถ่ายการทดลองประกอบตัวอย่าง ตัวอย่างการออกแบบวงจร  ตัวอย่างการต่อวงจร การทดลองโดยนำกระดาษมาบังแสงตรงโฟโต้ทรานซิสเตอร์
อ่านเพิ่มเติม

งาน arduino 7 Voltage Sensor

รูปภาพ
Voltage Sensor Voltage Sensor เป็นเซนเซอร์ที่ใช้วัดแรงดันไฟฟ้าได้ตั้งแต่ 0-24V  Output ที่ได้เป็นแบบ Analog 0-1023 Product Details: Voltage Sensor Module Condition: New This module is based on principle of resistive voltage divider design, can make the red terminal connector input voltage to 5 times smaller. Arduino analog input voltages up to 5 v, the voltage detection module input voltage not greater than 5Vx5=25V (if using 3.3V systems, input voltage not greater than 3.3Vx5=16.5V). Arduino AVR chips have 10-bit AD, so this module simulates a resolution of 0.00489V(5V/1023), so the minimum voltage of input voltage detection module is 0.00489Vx5=0.02445V การต่อวงจร   โค้ดตัวอย่างการใช้งาน ดาวน์โหลดโค้ดตัวอย่าง(คลิ๊ก) รีวิว
อ่านเพิ่มเติม