moving

การทำให้หุ่นยนต์เคลื่อนที่

ข้อกำหนดเบื้องต้น

1. ต่อมอเตอร์ล้อด้านซ้าย กับ M1 และมอเตอร์ด้านขวา กับ M2 บนแผงวงจรหลัก

ชุดคำสั่ง

#include <ipst.h> // include file for IPST-SE

void setup() {

lcd(" Moving ");

sw1_press();

lcd_clear();

}

void loop() {

lcd("Forward");

motor(1,50);

motor(2,50);

delay(1000);

lcd("Backward");

motor(1,-50);

motor(2,-50);

delay(1000);

lcd("Turn Left");

motor(1,-50);

motor(2,50);

delay(1000);

lcd("Turn Right");

motor(1,50);

motor(2,-50);

delay(1000);

motorStop();

}

หมายเหตุ

ผนวกไฟล์ ipst.h

ฟังก์ชั่น กำหนดค่า

แสดงข้อความ Moving บนจอ LCD

รอรับการกดสวิตช์ SW1

ลบข้อความบนจอ LCD

ฟังก์ชั่น หลักในการทำงาน

แสดงข้อความ Forward บนจอ LCD

มอเตอร์ด้านซ้ายหมุนไปข้างหน้า ด้วยกำลัง 50%

มอเตอร์ด้านขวาหมุนไปข้างหน้า ด้วยกำลัง 50%

หน่วงเวลาไว้ 1000 มิลลิวินาที หรือ 1 นาที นั่นเอง

แสดงข้อความ Backward บนจอ LCD

มอเตอร์ด้านซ้ายหมุนไปข้างหลัง ด้วยกำลัง 50%

มอเตอร์ด้านขวาหมุนไปข้างหลัง ด้วยกำลัง 50%

หน่วงเวลาไว้ 1000 มิลลิวินาที

แสดงข้อความ Turn Left บนจอ LCD

มอเตอร์ด้านซ้ายหมุนไปข้างหลัง ด้วยกำลัง 50%

มอเตอร์ด้านขวาหมุนไปข้างหน้า ด้วยกำลัง 50%

หน่วงเวลาไว้ 1000 มิลลิวินาที

แสดงข้อความ Turn Right บนจอ LCD

มอเตอร์ด้านซ้ายหมุนไปข้างหน้า ด้วยกำลัง 50%

มอเตอร์ด้านขวาหมุนไปข้างหลัง ด้วยกำลัง 50%

หน่วงเวลาไว้ 1000 มิลลิวินาที

หยุดการทำงานของ มอเตอร์

Page updated

Google Sites

Report abuse