โอ อาร์ เทคโนโลยี จำหน่ายอุปกร์ไฟฟ้า ออโตเมชัน ไมโครคอนโทรลเลอร์ นิวเมติก อุปกรณ์ลม หุ่นยนต์บาลานซ์ (Balancing Robot)

หน้าแรก (Home)
สินค้าทั้งหมด (All Product)
การสั่งซื้อ (Payment)
ติดต่อเรา (Contact us)

@or-tech มี @ ด้านหน้า

[email protected]

ชุดเรียนรู้
Makerzoid

อาร์ดูโน่
(Arduino)

นิวเมติก
(Pneumatic)

อื่นๆ
(Ungroup)

บทความ
(Article)

Starter Kit EP1

ตัวอย่าง
(Sample)

หุ่นยนต์บาลานซ์ (Balancing Robot)

อุปกรณ์

การต่อใช้งาน Wiring Diagram

Code

/* -------------------------------------- */
/* Motor Control with RF Remote.          */
/* O.R. Technology Co., Ltd               */
/* -------------------------------------- */
/* Target Device : Arduino R3 Board       */
/* Created Date  : 27-JUL-2023            */  
/* Modified Date : 28-JUL-2023            */ 
/* By Kraisorn K.                         */ 
/* -------------------------------------- */

// กำหนดค่า PIN ของบอร์ด Arduino R3
// IR Remote
#define SW_A 6
#define SW_B 4
#define SW_C 7
#define SW_D 5
// Output บอร์ดควบคุมมอเตอร์
#define OUT_1 9        // มอเตอร์ 1
#define OUT_2 10       // มอเตอร์ 1
#define OUT_3 11       // มอเตอร์ 2
#define OUT_4 12       // มอเตอร์ 2
// ประกาศ Function ที่จะใช้
void Stop(void);
void Forward(void);
void Backward(void);
void TurnLeft(void);
void TurnRight(void);
// Function กำหนดค่าเริ่มต้น
void setup() 
{
  // กำหนดให้ PIN รับค่า Input
  pinMode(SW_A, INPUT);
  pinMode(SW_B, INPUT);
  pinMode(SW_C, INPUT);
  pinMode(SW_D, INPUT);
  // กำหนดให้ PIN เป็น Output
  pinMode(OUT_1, OUTPUT);
  pinMode(OUT_2, OUTPUT);
  pinMode(OUT_3, OUTPUT);
  pinMode(OUT_4, OUTPUT);
  // กำหนดค่า PIN LED ที่บอร์ด
  pinMode(LED_BUILTIN, OUTPUT);
  // ให้เริ่มต้น Motor หยุดทำงาน
  Stop();
  // ให้เริ่มต้น LED ดับ
  digitalWrite(LED_BUILTIN, LOW);
}

void loop() 
{
  if(digitalRead(SW_A) == HIGH)           //ถ้ามีการกด SW A ที่ RF Remote
  {
    Forward();                            // เรียก Function เดินหน้า
    digitalWrite(LED_BUILTIN, HIGH);      // LED ติด 
    while(digitalRead(SW_A) == HIGH);     // รอจนกว่าจะปล่อยปุ่ม
  }
  else if(digitalRead(SW_B) == HIGH)      //ถ้ามีการกด SW B ที่ IR Remote
  {
    Backward();                           // เรียก Function ถอยหลัง
    digitalWrite(LED_BUILTIN, HIGH);      // LED ติด 
    while(digitalRead(SW_B) == HIGH);     // รอจนกว่าจะปล่อยปุ่ม
  }
  if(digitalRead(SW_C) == HIGH)           //ถ้ามีการกด SW C ที่ IR Remote
  {
    TurnLeft();                           // เรียก Function เลี้ยวซ้าย
    digitalWrite(LED_BUILTIN, HIGH);      // LED ติด 
    while(digitalRead(SW_C) == HIGH);     // รอจนกว่าจะปล่อยปุ่ม
  }
  else if(digitalRead(SW_D) == HIGH)      //ถ้ามีการกด SW D ที่ IR Remote
  {
    TurnRight();                          // เรียก Function เลี้ยวขวา
    digitalWrite(LED_BUILTIN, HIGH);      // LED ติด 
    while(digitalRead(SW_D) == HIGH);     // รอจนกว่าจะปล่อยปุ่ม
  }
  else
  {
    Stop();                               // เมื่อไม่มีการกดปุ่มใดๆ ให้เรียก Function หยุด
    digitalWrite(LED_BUILTIN, LOW);       // LED ดับ
  }
}

void Stop()                               // Function หยุด
{
  digitalWrite(OUT_1, LOW);               // ให้ OUT 1 เป็น Logic 0
  digitalWrite(OUT_2, LOW);               // ให้ OUT 2 เป็น Logic 0
  digitalWrite(OUT_3, LOW);               // ให้ OUT 3 เป็น Logic 0
  digitalWrite(OUT_4, LOW);               // ให้ OUT 4 เป็น Logic 0
}

void Forward()                            // Function เดินหน้า
{
  digitalWrite(OUT_1, HIGH);              // ให้ OUT 1 เป็น Logic 1
  digitalWrite(OUT_2, LOW);               // ให้ OUT 2 เป็น Logic 0
  digitalWrite(OUT_3, HIGH);              // ให้ OUT 3 เป็น Logic 1
  digitalWrite(OUT_4, LOW);               // ให้ OUT 4 เป็น Logic 0
}

void Backward()                           // Function ถอยหลัง
{
  digitalWrite(OUT_1, LOW);               // ให้ OUT 1 เป็น Logic 0
  digitalWrite(OUT_2, HIGH);              // ให้ OUT 2 เป็น Logic 1
  digitalWrite(OUT_3, LOW);               // ให้ OUT 3 เป็น Logic 0
  digitalWrite(OUT_4, HIGH);              // ให้ OUT 4 เป็น Logic 1  
}

void TurnLeft()                           // Function เลี้ยวซ้าย
{
  digitalWrite(OUT_1, LOW);               // ให้ OUT 1 เป็น Logic 0
  digitalWrite(OUT_2, LOW);               // ให้ OUT 2 เป็น Logic 0
  digitalWrite(OUT_3, HIGH);              // ให้ OUT 3 เป็น Logic 1
  digitalWrite(OUT_4, LOW);               // ให้ OUT 4 เป็น Logic 0  
}

void TurnRight()                          // Function เลี้ยวขวา
{
  digitalWrite(OUT_1, HIGH);              // ให้ OUT 1 เป็น Logic 1
  digitalWrite(OUT_2, LOW);               // ให้ OUT 2 เป็น Logic 0
  digitalWrite(OUT_3, LOW);               // ให้ OUT 3 เป็น Logic 0
  digitalWrite(OUT_4, LOW);               // ให้ OUT 4 เป็น Logic 0  
}