ESP32 #7: หุ่นยนต์ควบคุมผ่านอินเตอร์เน็ต DevKitC ESP32

จาก โปรเจค หุ่นยนต์ควบคุมด้วยเว็บบราวเซอร์ นั้น เราจะสามารถสั่งควบคุมหุ่นยนต์  จาก เว็บบราวเซอร์ ผ่านทาง ระบบอินทราเน็ต ที่ใช้ WiFi  หรือ วง แลน หรือใช้ เร้าเตอร์ เดียวกัน เท่านั้น

แต่ถ้าจะให้ หุ่นยนต์ สามารถ ควบคุมผ่านอินเตอร์เน็ต ได้ ต้องใช้ แอพ Blynk ในการควบคุม โดยแอพ จะติดต่อ ไอพี ของ เว็บเซิร์ฟเวอร์ ESP32 ได้โดยอัตโนมัติ และ แอพ ยังสามารถควบคุมได้ผ่านอินเตอร์เน็ต  เพียงเราเชื่อมต่อ หุ่นยนต์ ESP32 ของเรา เข้ากับ WiFi ส่วนมือถือ แอพ Blynk ที่ใช้ควบคุม จะใช้ WiFi หรือ อินเตอร์เน็ตของมือถือ ก็สามารถใช้ควบคุมได้เช่นกัน

Blynk Application เป็นโปรแกรมบนมือถือที่ทำให้เราสร้างหน้าต่างควบคุมหรือแสดงผลเชื่อมต่อกับพวกไมโครคอนโทรเลอร์(Ardunio, ESP32 , Raspberry Pi) ได้ง่ายๆ และยังสามารถควบคุมผ่าน ทุกที่ ที่สามารถเชื่อมต่ออินเตอร์เน็ต  ได้อีกด้วย


โหมด STA

STA ย่อมาจาก Station เป็นโหมดที่จะใช้ DevKitC ESP32 ไปเชื่อมต่อกับอุปกรณ์ปล่อยสัญญาณอื่น ๆ เช่น เร้าเตอร์ โทรศัพท์มือถือที่เปิดฮอตสปอต การใช้งานในโหมดนี้นิยมใช้กับงานที่ต้องการเชื่อมต่ออินเตอร์เน็ต

ในงานด้าน IoT Smart Home และ Smart Farm มักใช้งานในโหมดนี้เพื่อส่งข้อมูลจากเซ็นเซอร์ขึ้นไปบนระบบคลาวด์และใช้โหมดนี้เพื่อเชื่อมต่อกับระบบคลาวด์รับคำสั่งมีสั่งอุปกรณ์ต่าง ๆ ให้ทำงานผ่านอินเตอร์เน็ต


หุ่นยนต์ควบคุมผ่านอินเตอร์เน็ต

หากต้องการใช้งานอินเตอร์เน็ต หรือต้องการให้อุปกรณ์หลาย ๆ ตัวสามารถเข้ามาสื่อสารได้ จำเป็นต้องใช้งานในโหมด STA เพื่อให้ Access Point เป็นอุปกรณ์ตัวกลางในการสื่อสาร



โดยในโปรเจคนี้เราจะสร้างเว็บเซิร์ฟเวอร์ จาก DevKitC ESP32 และ และ สั่งควบคุมหุ่นยนต์ จากมือถือที่ติดตั้ง แอพ Blynk ผ่านทาง ระบบอินเตอร์เน็ต (ทุกที่ ที่สามารถเชื่อมต่อกับ ระบบอินเตอร์เน็ตได้)



### อุปกรณ์ที่ใช้ ###


1 . 4WD Smart Robot Car Chassis Kits

2. DevKitC V2 ESP32 Development Board

3. Micro USB Cable Wire 1m

4. Breadboard 8.5CM x 5.5CM 400 holes  //  จำนวน 2 ชิ้น

5. Motor Driver Module L298N

6. สกรูหัวกลม+น็อตตัวเมีย ขนาด 3มม ยาว 12มม

7. Jumper 20cm Male to Male

8. Jumper 20cm Female to Male

9. เพาเวอร์สวิตซ์สำหรับเปิดปิด

10. รางถ่าน 18650 แบบ 2 ก้อน

11. ถ่านชาร์จ 18650 Panasonic NCR18650B 3.7v 3400mAh  // จำนวน 2 ก้อน

...


โดยการทำโปรเจคมีขั้นตอนดังนี้


1.ติดตั้ง Arduino core for ESP32

ลิงค์การติดตั้ง Arduino core for ESP32

https://robotsiam.blogspot.com/2017/09/arduino-core-for-esp32.html


2.ประกอบหุ่นยนต์ DevKitC ESP32


ลิงค์การประกอบหุ่นยนต์ DevKitC ESP32


https://robotsiam.blogspot.com/2017/11/esp32-4.html



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


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


https://robotsiam.blogspot.com/2017/11/esp32-5-gpio-devkitc.html





6.เขียนโค้ดควบคุมหุ่นยนต์ 


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



เปิด โปรแกรม Arduino IDE ขึ้นมา เขียนโปรแกรม หรือ  Sketch  ตามโค้ดด้านล่างนี้



/*

   Blynk app controlled Robot with DevKitC ESP32.
    For more details visit:
    https://robotsiam.blogspot.com/2017/11/esp32-7-devkitc-esp32.html

*/

#define BLYNK_PRINT Serial    // Comment this out to disable prints and save space
#include <WiFi.h>
#include <WiFiClient.h>
#include <BlynkSimpleEsp32.h>

//pins to drive motors
int MotorLeft[2] = {12, 13};
int MotorRight[2] = {33, 32};

// You should get Auth Token in the Blynk App.
// Go to the Project Settings (nut icon).
char auth[] = "blynk_key";

// Your WiFi credentials.
// Set password to "" for open networks.
char ssid[] = "wifi_SSID";
char pass[] = "wifi_password";


void setup()
{
  Serial.begin(115200);
  Blynk.begin(auth, ssid, pass);
  MotorInit();
  //Serial.print("*Explore Robo Mode Computer: Controlled*\n\r");
  //Serial.println("Commands:\n W->Forward \n S->Backwards \n A->Left \n D->Right");
}

void loop()
{

  Blynk.run();

}

//Intialize the motor
void MotorInit()
{
  int i;
  for (i = 0 ; i < 2; i++)
  {
    pinMode(MotorLeft[i], OUTPUT);
    pinMode(MotorRight[i], OUTPUT);
  }
}
//Robot Driving Functions
void Robot_Forward()
{
  digitalWrite(MotorLeft[0], 0);
  digitalWrite(MotorLeft[1], 1);
  digitalWrite(MotorRight[0], 1);
  digitalWrite(MotorRight[1], 0);
}
void Robot_Backward()
{
  digitalWrite(MotorLeft[0], 1);
  digitalWrite(MotorLeft[1], 0);
  digitalWrite(MotorRight[0], 0);
  digitalWrite(MotorRight[1], 1);
}
void Robot_Left()
{
  digitalWrite(MotorLeft[0], 1);
  digitalWrite(MotorLeft[1], 0);
  digitalWrite(MotorRight[0], 1);
  digitalWrite(MotorRight[1], 0);
}
void Robot_Right()
{
  digitalWrite(MotorLeft[0], 0);
  digitalWrite(MotorLeft[1], 1);
  digitalWrite(MotorRight[0], 0);
  digitalWrite(MotorRight[1], 1);
}

void Robot_Stop()
{
  digitalWrite(MotorLeft[0], 0);
  digitalWrite(MotorLeft[1], 0);
  digitalWrite(MotorRight[0], 0);
  digitalWrite(MotorRight[1], 0);
}



BLYNK_WRITE(V1)
{
  int value = param.asInt(); // Get value as integer
  // Serial.println("Going Forward");
  if (value)
  {
    Robot_Forward();

  }
}

BLYNK_WRITE(V2)
{
  int value = param.asInt(); // Get value as integer
  //Serial.println("Moving Left");
  if (value)
  {

    Robot_Left();
    delay(200);
    Robot_Stop();
  }
}


BLYNK_WRITE(V3)
{
  int value = param.asInt(); // Get value as integer
  // Serial.println("Going back");
  if (value)
  {
    Robot_Backward();

  }
}


BLYNK_WRITE(V4)
{
  int value = param.asInt(); // Get value as integer
  //Serial.println("Moving Right");
  if (value)
  {
    Robot_Right();
    delay(200);
    Robot_Stop();

  }
}

BLYNK_WRITE(V5)
{
  int value = param.asInt(); // Get value as integer
  // Serial.println("Braking!!");
  if (value)
  {
    Robot_Stop();
  }
}

ไปที่ Tools -> Board เลือก "ESP32 Dev Module"

ไปที่ Tools -> Port แล้วเลือกพอร์ตที่ปรากฏ (กรณีใช้เครื่องคอมพิวเตอร์ที่มี COM Port ให้เลือกตัวอื่นที่ไม่ใช่ COM1)

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

ไปที่ Tools -> Upload Speed : เลือกเป็น "115200"

กดปุ่ม   เพื่ออัพโหลด
 


หากสามารถอัพโหลดโปรแกรมลงบอร์ดได้สำเร็จ จะแสดงคำว่า Done uploading. ที่แถบด้านล่าง