[OTTO Ninja] 忍者機器人輪子旋轉控制

 

範例一、右輪一直轉

1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24

#include <Servo.h> /* ====== 舵機腳位 ====== */ #define PIN_RF D3 // 右輪（右腳） Servo rightWheel; void setup() { rightWheel.attach(PIN_RF); } void loop() { rightWheel.write(180); // 正轉（速度最大） delay(2000); rightWheel.write(90); // 停止 delay(1000); rightWheel.write(0); // 反轉（速度最大） delay(2000); rightWheel.write(90); // 停止 delay(2000); }

範例二、左右輪輪流旋轉

程式：

1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43

#include <Servo.h> /* ====== 舵機腳位 ====== */ #define PIN_LF D7 // 左輪（左腳） #define PIN_RF D3 // 右輪（右腳） Servo leftWheel; Servo rightWheel; // 連續旋轉舵機：90=停、>90 正轉、<90 反轉 const int STOP = 90; const int FWD = 180; // 正轉最大（可改 120~160 做慢速） void setup() { leftWheel.attach(PIN_LF); rightWheel.attach(PIN_RF); leftWheel.write(STOP); rightWheel.write(STOP); delay(500); } void loop() { // 1) 右輪轉，左輪停 leftWheel.write(STOP); rightWheel.write(FWD); delay(2000); // 2) 全停 leftWheel.write(STOP); rightWheel.write(STOP); delay(800); // 3) 左輪轉，右輪停 leftWheel.write(FWD); rightWheel.write(STOP); delay(2000); // 4) 全停 leftWheel.write(STOP); rightWheel.write(STOP); delay(800); }