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

การทดสอบการเคลื่อนที่ของหุ่นยนต์ Raspberry Pi นั้น จะเป็นการตรวจสอบการประกอบหุ่นยนต์ของเราว่า ถูกต้องหรือไม่ เช่น การต่อสายต่างๆ การต่อขั้วของมอเตอร์เป็นต้น


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

1. Raspberry Pi 3 Model B+

2. Micro SD Card Class 10 16GB + Card Adapter

3. 4WD Smart Robot Car Chassis Kits (สีน้ำเงิน)

4. Motor Driver Module L298N

5. Jumper (M2M) cable 20cm Male to Male

6. Jumper (F2M) cable 20cm Female to Male

7. Jumper (F2F) cable 10cm Female to Female

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

9. รางถ่าน 18650 3 ก้อน

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

11. สกรูหัวกลม+น็อตตัวเมีย ขนาด 2.6 มม. ยาว 10 มม

12. Power Bank 20000 mAh USB Output DC 5V/2.1A

ขั้นตอนการทำงาน

1. การติดตั้ง Linux ให้กับ Raspberry โดยใช้ไฟล์ image


2. การใช้งาน GPIO ใน Raspberry Pi ด้วย Python


3. การประกอบหุ่นยนต์ Raspberry Pi


4. วิธีเปิดใช้งาน Remote Desktop ไปยัง Raspberry Pi


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

5.1 ถอดการเชื่อมต่อ สาย HDMI Monitor , USB Keyboard , USB Mouse ออกจากตัวหุ่นยนต์

5.2 หาพื้นที่สำหรับ การทดสอบการเคลื่อนที่ของหุ่นยนต์ Raspberry Pi

5.3 เปิด เพาเวอร์สวิตซ์ จะมีไฟสีแดงติดที่ Motor Driver

5.4 เสียบสาย USB ของ Power Bank ต่อเข้ากับ 5V  Micro USB ของบอร์ด Raspberry Pi

5.5 ที่คอมพิวเตอร์ PC ให้ทำการ Remote Desktop ไปยัง Raspberry Pi

ไปที่ Menu -> Programming -> Python 3 (IDLE)

โปรแกรม Python 3 (IDLE)

ไปที่ File -> New File

เขียนโค้ดดังนี้


import RPi.GPIO as GPIO
import time
GPIO.setmode(GPIO.BOARD)
GPIO.setup(11,GPIO.OUT)
GPIO.setup(13,GPIO.OUT)
GPIO.setup(35,GPIO.OUT)
GPIO.setup(37,GPIO.OUT)
#ForWard
GPIO.output(11,True)
GPIO.output(13,False)
GPIO.output(35,True)
GPIO.output(37,False)
time.sleep(0.4)
#Stop
GPIO.output(11,False)
GPIO.output(13,False)
GPIO.output(35,False)
GPIO.output(37,False)
time.sleep(0.6)
#BackWard
GPIO.output(11,False)
GPIO.output(13,True)
GPIO.output(35,False)
GPIO.output(37,True)
time.sleep(0.4)
#TurnLeft
GPIO.output(11,True)
GPIO.output(13,False)
GPIO.output(35,False)
GPIO.output(37,False)
time.sleep(0.6)
#Stop
GPIO.output(11,False)
GPIO.output(13,False)
GPIO.output(35,False)
GPIO.output(37,False)
time.sleep(0.6)
#TurnRight
GPIO.output(11,False)
GPIO.output(13,False)
GPIO.output(35,True)
GPIO.output(37,False)
time.sleep(0.6)
GPIO.cleanup()

หรือ ดาวน์โหลด ไฟล์: https://drive.google.com/open?id=12RjYVjTmqAZABkdqvkChCJmYg0WFXLx-

ไปที่ File -> Save

ตั้งชื่อไฟล์ ในตัวอย่างเป็น robot_test_01 แล้ว คลิก Save

ไฟล์ robot_test_01.py

ทดสอบการทำงานของโปรแกรม โดยไปที่ Run -> Run Module (หรือกด F5)

ถ้าการต่อหุ่นยนต์ของเรานั้นถูกต้อง ปรกติ หุ่นยนต์ จะ เดินหน้า->ถอยหลัง->เลี้ยวซ้าย->เลี้ยวขวา ตามวีดีโอ ถ้าไม่ปรกติ ให้ทำการตรวจสอบการประกอบ และการต่อสายต่างๆ แล้วทำการแก้ไขให้ถูกต้อง

วีดีโอผลลัพธ์การทำงานของโปรแกรม (ทดสอบการเคลื่อนที่ของหุ่นยนต์ Raspberry Pi)