โปรเจค หุ่นยนต์ ESP8266 NodeMCU V2 ควบคุมด้วย แอพ Blynk

การใช้งาน Digital/Input ซึ่งการใช้งาน Digital I/O ของ ESP8266 นั้น สามารถใช้งานคำสั่ง digitalWrite, digitalRead ได้เช่นเดียวกับการใช้งาน Digital I/O ของ Arduino โดยกำหนดหมายเลขของ Pin เช่นตัวอย่าง Pin ที่  5 หรือจะกำหนดชื่อ Pin โดยอ้างตามชื่อ Pin บนบอร์ด NodeMCU  V2 เป็น D1 ก็ได้เช่นกัน

การต่อวงจร ระหว่าง  NodeMCU กับ Motor Driver
ใช้ จั้มเปอร์ เมีย-เมีย ในการเชื่อมต่อ

D1 <-> IN1

D3 <-> IN2

D2 <-> IN3

D4 <-> IN4

Upload โปรแกรม ทดสอบการทำงาน

เชื่อมต่อ สาย USB ระหว่าง คอมพิวเตอร์ กับ  NodeMCU 

1. ตรวจสอบการติดตั้งไดร์เวอร์ ของ NodeMCU V2 

โดย คลิกขวา Computet -> Properties

 

คลิกที่ Device Manager

ที่ Ports (COM & LPT) จะพบ ไดร์เวอร์ ของ NodeMCU V2 ในตัวอย่างเป็น "COM12"

 

(ถ้าไม่พบให้ทำการติดตั้งไดร์เวอร์ก่อน) 
การติดตั้งโปรแกรม Arduino (IDE) และ การติดตั้งไดร์เวอร์

2.ทดสอบ การเคลื่อนที่ของหุ่นยนต์

เปิดโปรแกรม Arduino (IDE) และ Upload โค้ดนี้ ไปยัง บอร์ด NodeMCU V2

// Motor A pins
int enableA = 12; // D6 - ENB
int pinA2 = 4; // D2 - IN3
int pinA1 = 2;  // D4 - IN4


//Motor B pins 
int enableB = 14; // D5 - ENA
int pinB2 = 5; // D1 - IN1
int pinB1 = 0; // D3 - IN2


//This lets you run the loop a single time for testing
boolean run = true;

void setup() {
  pinMode(enableA, OUTPUT);
  pinMode(pinA1, OUTPUT);
  pinMode(pinA2, OUTPUT);

  pinMode(enableB, OUTPUT);
  pinMode(pinB1, OUTPUT);
  pinMode(pinB2, OUTPUT);
}
void loop() {
  if (run) {
    for (int i = 0; i <= 500; i++) {
      delay(10);
    }

    enableMotors();
    //Go forward
    forward(400);
    coast(200);
    //Go backward
    backward(400);
    coast(200);
    //Turn left
    turnLeft(400);
    coast(200);
    //Turn right
    turnRight(400);
    coast(200);
    //This stops the loop
    run = false;
  }
}

//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);
}

เลือก Port ในตัวอย่างเป็น "COM12"

เลือก Board : NodeMCU 1.0 (ESP-12E Module)

Upload

ถ้ามีปัญหา Upload ไม่เข้า ขึ้น Error แสดงข้อความว่า ตามรูปภาพ 

warning: espcomm_sync failed

error: espcomm_open failed

error: espcomm_upload_mem failed

ให้กดปุ่ม RST 1 ครั้ง และ กดปุ่ม  FLASH บนบอร์ด ของ NodeMCU  ค้างไว้ ในขณะที่ทำการอัพโหลดโปรแกรม

รอจนกระทั่ง Done uploading. 100%

ใส่ แบตเตอรี่ลิเธียม 18650 จำนวน 2 ก้อน ไปที่ รางถ่าน และ ตรวจสอบขั้วของแบตเตอรี่ ใส่ถุกต้องหรือไม่

ถ้าทุกอย่างถูกต้อง ทดลอง ยกลงวางที่พื้นแล้ว ทดสอบ  ปิดเปิด สวิทช์ไฟ Power  ถ้าทุกอย่างถูกต้อง ปรกติ หุ่นยนต์จะเคลื่อนที่ไปข้างหน้า-ถอยหลัง แล้ว เลี้ยวซ้าย แล้ว เลี้ยวขวา

ถ้าหุ่นยนต์ เคลื่อนที่ปรกติ แสดงว่า หุ่นยนต์ของเราพร้อมทำงานแล้ว

3.การสร้างแอพ Blynk สำหรับหุ่นยนต์ NodeMCU V2

กรอก อีเมล และ พาสเวิด -> Sign Up

-> New Project

ตั้งชื่อ Project ในตัวอย่างชื่อ robot_car -> Create

โปรกรม จะส่ง Auth Toke ไปที่ อีเมล ที่เรากรอกไว้ -> OK

โดยทุกๆครั้งที่เริ่มสร้างโปรเจคใหม่ AUTH TOKEN จะถูกเปลี่ยนใหม่เสมอ ซึ่ง KEY นี้เองที่เป็นเสมือนกุญแจสำหรับเชื่อมต่อ


คลิก เครื่องหมาย +

คลิก เพิ่ม Button

จะมี ปุ่ม BUTTON เพิ่มเข้ามาที่หน้าจอ แล้วจึง คลิกที่ BUTTON เพื่อตั้งค่า

คลิก ที่ PIN

เลือก Virtual -> V0 -> CONTINUE

เปลี่ยนชื่อ Button เป็น FORWARD

ลาก Button ไว้กลางหน้าจอ

เพิ่ม Button อีก 3 ปุ่ม ตั้งค่า จัดวางตำแหน่ง ตามรูป

ปุ่ม BACK เลือก Virtual -> V1 -> CONTINUE
ปุ่ม RIGHT เลือก Virtual -> V2 -> CONTINUE
ปุ่ม LEFT เลือก Virtual -> V3 -> CONTINUE

การติดตั้ง ไลบรารี่ Blynk

ดาวน์โหลด ไลบรารี่ Blynk

https://github.com/blynkkk/blynk-library

 คลิกที่ Clone or download

 

 

 คลิกที่ Download ZIP

 

เปิด โปรแกรม Arduino IDE 

 

 

ไปที่ Skecth -> Include Library -> Add .ZIP Library...

 

 ไปที่ ไลบรารี blynk-library-master.zip ที่เรา ดาวน์โหลด มา -> Open

ตรวจสอบที่ Skecth -> Include Library  จะพบ ไลบรารี Blynk เพิ่มเข้ามาใน Arduino IDE ของเรา

 

ก่อน Upload โปรแกรม มีค่าเฉพาะที่ต้องแก้ไข อยู่ 3 ค่าด้วยกันคือ

1.  char auth[] = "xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx";

เป็นค่าที่เราได้รับจาก  ที่ Blynk ส่ง อีเมล ให้เรา

ในตัวอย่างนี้แก้เป็น

char auth[] = "264b50a5284642c09eff8a0815cff21e";



2. char ssid[] = "MyWifi";

แก้เป็น ชื่อ WiFi ที่ต้องการเชื่อมต่อ


3. char pass[] = "MyWifiPassword";

แก้เป็น รหัสผ่าน ของWiFiที่ต้องการเชื่อมต่อ



แล้วจีง Upload โค้ดที่แก้ไขแล้ว ไปยัง บอร์ด NodeMCU V2

/**************************************************************

 * This example runs directly on NodeMCU chip

 * using the Blynk platform and mobile application.

 * Change WiFi ssid, password, and Blynk auth token to run :)

 **************************************************************/

 

#define BLYNK_PRINT Serial // Comment this out to disable prints and save space

#include <ESP8266WiFi.h>

#include <BlynkSimpleEsp8266.h>

 

#define RightMotorSpeed 5 // D1 <-> IN1
#define RightMotorDir 0  // D3 <-> IN2
#define LeftMotorSpeed 4  // D2 <-> IN3
#define LeftMotorDir 2  // D4 <-> IN4

 

// You should get Auth Token in the Blynk App.

// Go to the Project Settings (nut icon).

char auth[] = "xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx";

char ssid[] = "MyWifi";

char pass[] = "MyWifiPassword";

 

void setup()

{

 Serial.begin(9600);

 Blynk.begin(auth, ssid, pass);

 

 pinMode(RightMotorSpeed, OUTPUT);

 pinMode(RightMotorDir, OUTPUT);

 pinMode(LeftMotorSpeed, OUTPUT);

 pinMode(LeftMotorDir, OUTPUT);

}

 

void loop()

{

 Blynk.run();

}

 

void halt()

{

 digitalWrite(RightMotorSpeed, LOW);

 digitalWrite(LeftMotorSpeed, LOW);

}

 

void forward()

{

 digitalWrite(RightMotorDir, HIGH);

 digitalWrite(LeftMotorDir, HIGH);

 digitalWrite(RightMotorSpeed, LOW);

 digitalWrite(LeftMotorSpeed, LOW);

}

 

void reverse()

{

 digitalWrite(RightMotorDir, LOW);

 digitalWrite(LeftMotorDir, LOW);

 digitalWrite(RightMotorSpeed, HIGH);

 digitalWrite(LeftMotorSpeed, HIGH);

}

 

void right()

{

 digitalWrite(RightMotorDir, LOW);

 digitalWrite(LeftMotorDir, HIGH);

 digitalWrite(RightMotorSpeed, HIGH);

 digitalWrite(LeftMotorSpeed, HIGH);

}

 

void left()

{

 digitalWrite(RightMotorDir, HIGH);

 digitalWrite(LeftMotorDir, LOW);

 digitalWrite(RightMotorSpeed, HIGH);

 digitalWrite(LeftMotorSpeed, HIGH);

}

 

BLYNK_WRITE(V0)

{

 if (param[0])

 forward();

 else

 halt();

}

 

BLYNK_WRITE(V1)

{

 if (param[0])

 reverse();

 else

 halt();

}

 

BLYNK_WRITE(V2)

{

 if (param[0])

 right();

 else

 halt();

}

 

BLYNK_WRITE(V3)

{

 if (param[0])

 left();

 else

 halt();

}

เลือก Port ในตัวอย่างเป็น "COM12"

เลือก Board : NodeMCU 1.0 (ESP-12E Module)

Upload

ถ้ามีปัญหา Upload ไม่เข้า ขึ้น Error แสดงข้อความว่า ตามรูปภาพ 

warning: espcomm_sync failed

error: espcomm_open failed

error: espcomm_upload_mem failed

ให้กดปุ่ม RST 1 ครั้ง และ กดปุ่ม  FLASH บนบอร์ด ของ NodeMCU  ค้างไว้ ในขณะที่ทำการอัพโหลดโปรแกรม

รอจนกระทั่ง Done uploading. 100%

ภาพรวมการต่อหุ่นยนต์

กลับไปที่ Blynk Application คลิกที่ เครื่องหมาย สามเหลี่ยม เพื่อทดสอบการทำงาน

หน้าต่างควบคุม แอพ robot_car

วีดีโอผลลัพธ์การทำงานของ โปรเจค หุ่นยนต์  ESP8266 NodeMCU V2 ควบคุมด้วย แอพ Blynk