#include <Servo.h>
//定義五中運動狀態
#define STOP 0
#define FORWARD 1
#define BACKWARD 2
#define TURNLEFT 3
#define TURNRIGHT 4
//定義需要用到的引腳
int leftMotor1 = 7;
int leftMotor2 = 6;
int rightMotor1 = 4;
int rightMotor2 = 5;
void setup() {
pinMode(leftMotor1, OUTPUT);
pinMode(leftMotor2, OUTPUT);
pinMode(rightMotor1, OUTPUT);
pinMode(rightMotor2, OUTPUT);
}
void loop() {
// put your main code here, to run repeatedly:
int cmd;
for(cmd=0;cmd<5;cmd++)//依次執行向前、向后、向左、想有、停止四個運動狀態
{
motorRun(cmd);
delay(2000);//每個命令執行2s
}
} //運動控制函式
void motorRun(int cmd)
{ switch(cmd)
{
case FORWARD:
digitalWrite(leftMotor1, LOW);
digitalWrite(leftMotor2, HIGH);
digitalWrite(rightMotor1, LOW);
digitalWrite(rightMotor2, HIGH);
delay(1);
digitalWrite(leftMotor1, LOW);
digitalWrite(leftMotor2, LOW);
digitalWrite(rightMotor1, LOW);
digitalWrite(rightMotor2, LOW);
delay(10);
break;
case BACKWARD:
digitalWrite(leftMotor1, HIGH);
digitalWrite(leftMotor2, LOW);
digitalWrite(rightMotor1, HIGH);
digitalWrite(rightMotor2, LOW);
default: digitalWrite(leftMotor1, LOW);
digitalWrite(leftMotor2, LOW);
digitalWrite(rightMotor1, LOW);
digitalWrite(rightMotor2, LOW);
}
}
請問這段代碼有什么問題嗎，小車不動
轉載請註明出處，本文鏈接：https://www.uj5u.com/houduan/238695.html
標籤：新手樂園
上一篇：LeetCode：每日一題：21. 合并兩個有序鏈表
下一篇：圖子系統(在Dev -C++下功能1可以正常完成,但完成后直接退出運行視窗了,功能2和3不能正常運行,是什么情況,求解答))