Using Arduino with Ultrasonic Range Finder

Progress of mini-project

Part: Arduino

• ทำการทดลองส่งข้อมูลจาก putty ผ่านสาย Serial port ไปยัง Arduino เพื่อจำลองการควบคุมการทำงานของ motor โดยใช้ LED แสดงทิศทางการหมุนของล้อทั้งสองข้างได้แก่ เดินหน้า ถอยหลัง เลี้ยวซ้าย และ เลี้ยวขวา

ผลการทดลอง: ถ้า LED สว่าง แสดงว่าล้อข้างนั้นหมุนทวนเข็มนาฬิกา ถ้า LED ดับ แสดงว่าล้อข้างนั้นหมุนตามเข็มนาฬิกา
     เมื่อกดปุ่ม w หมายถึงเดินหน้า ล้อด้านซ้ายหมุนทวนเข็มนาฬิกา ล้อด้านขวาหมุนตามเข็มนาฬิกา
     ทำให้ LED ด้านซ้ายติด ด้านขวาดับ

     เมื่อกดปุ่ม s หมายถึงถอยหลัง ล้อด้านซ้ายหมุนตามเข็มนาฬิกา ล้อด้านขวาหมุนทวนเข็มนาฬิกา
     ทำให้ LED ด้านซ้ายดับ ด้านขวาติด

 

     เมื่อกดปุ่ม a หมายถึงเลี้ยวซ้าย ล้อด้านซ้ายหมุนตามเข็มนาฬิกา ล้อด้านขวาหมุนตามเข็มนาฬิกา
     ทำให้ LED ด้านซ้ายดับ ด้านขวาดับ

     เมื่อกดปุ่ม d หมายถึงเลี้ยวขวา ล้อด้านซ้ายหมุนทวนเข็มนาฬิกา ล้อด้านขวาหมุนทวนเข็มนาฬิกา
     ทำให้ LED ด้านซ้ายติด ด้านขวาติด

• ทำการทดลองใช้ Arduino รับข้อมูลจาก Ultrasonic Range Finder เพื่อหาระยะทางของสิ่งกีดขวางแล้วส่งข้อมูลระยะทางผ่านสาย Serial port ไปยัง putty โดยจะส่งข้อมูลระยะทางครั้งละ 6 บิตที่อยู่ตรงกลางของ package โดยบิตที่เหลืออีก 2 บิตจะเป็น 0 ที่บิตแรกและบิดสุดท้ายจะเป็น 0 เมื่อได้ส่งข้อมูลครบทุก package แต่ถ้าบิตสุดท้ายเป็น 1 แสดงว่ายังส่งข้อมูลระยะทางไม่ครบทุก package

ผลการทดลอง :