งานที่ 7

 รถบังคับ Rc Car wifi ด้วย Nodemcu esp8266 Arduino IDE ควบคุมผ่านมือถือ android

วันก่อนมีน้องๆ เข้ามาขอคำปรึกษาที่ร้าน โดยเขาจะทำรถบังคับควบคุมผ่าน Wifi ซึ่งบทความส่วนใหญ่ จะเป็นบทความเกี่ยวกับ รถบังคับโดยใช้ Arduino + bluetooth HC06 เป็นหลัก ระบบเดิมที่น้องเขาได้พัฒนา เป็นการควบคุมผ่าน App โดยการเชื่อมต่อ TCP มักจะเจอปัญหา Nodemcu เอ๋อบ้าง ช้าบ้างไม่ทันใจวัยรุ่น เลยให้คำปรึกษาน้องไปว่าให้ใช้ UDP แทน เนื่องจากการส่งข้อมูลของ TCP จะเป็นลักษณะการสนทนา มีการตอบกลับ ทำให้การส่งข้อมูลทำได้ช้ากว่า UDP เนื่องจาก UDP จะส่งข้อมูลออกไปทิศทางเดียวไม่มีการติดต่อกลับมาจึงทำให้มีความเร็งสูงกว่า TCP จากที่ให้คำปรึกษาน้องๆไป เลยนำมาเขียนบทความเรื่องรถบังคับ ผ่าน Wifi ด้วย Nodemcu esp8266 Arduino IDE.

เตรียมอุปกรณ์ 

• Nodemcu V2
• รถบังคับเก่า (เป็นรถดริฟ ของเล่นเก่า)
• Drive Motor เลือกใช้สินค้า L298 Dual Motor Driver Module 2A (ไดร์ขับมอเตอร์) รหัสสินค้า F01001
• อุปกรณ์อื่นๆ เช่นสายไฟ เป็นต้น

เพื่อให้เป็นการไม่เสียเวลา ขี้เกียดเขียนเว็บด้วย จึงหา App android ที่ GUI ใช้งานได้ง่ายๆ แล้วมาดัก Packet การส่งเอาเพื่อเอามาใช้กับงานของเราจึงแนะนำ App ที่มีชื่อว่า RC Joystick

หน้าตาของ App RC Joystick

หลักการทำงานของรถบังคับดริฟ คันนี้ จะแบ่งออกเป็น 2 ชุดคือ

1. ชุดบังคับเลี้ยวซ้าย ขวา
2. ชุดมอเตอร์ขับเคลื่อน เดินหน้า ถอยหลัง 
   

ถอดวงจรที่มีอยู่ออกมาให้หมดแล้วทำการบัดกรีสายไฟ เลี้ยวซ้ายขวา และเดินหน้า ถอยหลัง 2 เส้นเตรียมไว้ครับ

การต่อวงจรของชุดรถบังคับของเราต่อได้ดังนี้

ส่วนของ Code ของ Nodemcu IDE เราจะใช้ Arduino IDE ในการพัฒนา Code มีดังนี้

	/*
	Arduino RC Car Drift
	By Pakorn Rattanaying
	https://www.9arduino.com
	ตามบทความ https://www.9arduino.com/article/53/
	*/
	#include <ESP8266WiFi.h>
	#include <WiFiUDP.h>
	int status = WL_IDLE_STATUS;
	const char* ssid = "9arduino"; // your network SSID (name)
	const char* pass = "Pass wifi"; // your network password
	unsigned int localPort = 2390; // Port สำหรับการเชื่อมต่อ
	byte packetBuffer[512]; //buffer to hold incoming and outgoing packets
	// A UDP instance to let us send and receive packets over UDP
	WiFiUDP Udp;
	int a;
	int b;
	int c;
	int d;
	int pw1;
	int pw2;
	const int pin1 = D1;
	const int pin2 = D2;
	const int pin3 = D3;
	const int pin4 = D4;
	const int pwm1 = D5;
	const int pwm2 = D6;
	void setup()
	{
	// Open serial communications and wait for port to open:
	Serial.begin(115200);
	pinMode(pin1, OUTPUT);
	pinMode(pin2, OUTPUT);
	pinMode(pin3, OUTPUT);
	pinMode(pin4, OUTPUT);
	pinMode(pwm1, OUTPUT);
	pinMode(pwm2, OUTPUT);
	digitalWrite(pin1, HIGH);
	digitalWrite(pin2, HIGH);
	digitalWrite(pin3, HIGH);
	digitalWrite(pin4, HIGH);
	while (!Serial) {
	; // wait for serial port to connect. Needed for Leonardo only
	}
	// setting up Station AP
	WiFi.begin(ssid, pass);
	// Wait for connect to AP
	Serial.print("[Connecting]");
	Serial.print(ssid);
	int tries=0;
	while (WiFi.status() != WL_CONNECTED) {
	delay(500);
	Serial.print(".");
	tries++;
	if (tries > 30){
	break;
	}
	}
	Serial.println();
	printWifiStatus();
	Serial.println("Connected to wifi");
	Serial.print("Udp server started at port ");
	Serial.println(localPort);
	Udp.begin(localPort);
	}
	void loop()
	{
	int noBytes = Udp.parsePacket();
	if ( noBytes ) {
	Serial.print(millis() / 1000);
	Serial.print(":Packet of ");
	Serial.print(noBytes);
	Serial.print(" received from ");
	Serial.print(Udp.remoteIP());
	Serial.print(":");
	Serial.println(Udp.remotePort());
	// We've received a packet, read the data from it
	Udp.read(packetBuffer,noBytes); // read the packet into the buffer
	/* motor 1 */
	Serial.print("Motor 1 ");
	Serial.print(packetBuffer[2],DEC);
	Serial.print(" ");
	Serial.print(packetBuffer[3],DEC);
	Serial.print(" ");
	a = packetBuffer[2],DEC;
	b = packetBuffer[3],DEC;
	if (a == 255 and b >= 106){ //เลี้ยวซ้าย
	Serial.print(" Left ");
	pw1 = map(b, 255, 106, 0, 255);
	digitalWrite(pin1, LOW);
	digitalWrite(pin2, HIGH);
	}
	else if(a == 0 and b <= 150 and b >= 1){ //เลี้ยวขวา
	Serial.print(" Right ");
	pw1 = map(b, 1, 150, 0, 255);
	digitalWrite(pin2, LOW);
	digitalWrite(pin1, HIGH);
	}
	else{
	Serial.print(" Stop ");
	pw1 = 0;
	digitalWrite(pin1, HIGH);
	digitalWrite(pin2, HIGH);
	}
	Serial.println(pw1);
	/* motor 2 */
	Serial.print("Motor 2 ");
	Serial.print(packetBuffer[6],DEC);
	Serial.print(" ");
	Serial.print(packetBuffer[7],DEC);
	Serial.print(" ");
	c = packetBuffer[6],DEC;
	d = packetBuffer[7],DEC;
	if (c == 255 and d >= 106){ //ถอยหลัง
	Serial.print(" BACK ");
	pw2 = map(d, 255, 106, 0, 255);
	digitalWrite(pin4, LOW);
	digitalWrite(pin3, HIGH);
	}
	else if(c == 0 and d <= 150 and d >= 1){ //เดินหน้า
	Serial.print(" GO ");
	pw2 = map(d, 1, 150, 0, 255);
	digitalWrite(pin3, LOW);
	digitalWrite(pin4, HIGH);
	}
	else{
	Serial.print(" stop ");
	pw2 = 0;
	digitalWrite(pin3, HIGH);
	digitalWrite(pin4, HIGH);
	}
	Serial.print(pw2);
	Serial.println();
	} // end if
	}
	void printWifiStatus() {
	// print the SSID of the network you're attached to:
	Serial.print("SSID: ");
	Serial.println(WiFi.SSID());
	// print your WiFi shield's IP address:
	IPAddress ip = WiFi.localIP();
	Serial.print("IP Address: ");
	Serial.println(ip);
	}