用arduino控制板做小车路线死程序源代码
时间: 2023-09-18 14:10:23 浏览: 50
以下是使用Arduino控制板制作小车路线死程序的完整源代码:
```C++
#include <AFMotor.h> //使用AFMotor库控制电机
AF_DCMotor leftMotor(1); //定义左电机
AF_DCMotor rightMotor(2); //定义右电机
void setup() {
pinMode(13, OUTPUT); //设置LED灯控制引脚
Serial.begin(9600); //打开串口通信
}
void loop() {
char input = Serial.read(); //读取串口输入数据
if (input == 'F') { //当接收到'F'时,小车前进
forward();
digitalWrite(13, HIGH); //LED灯亮
} else if (input == 'B') { //当接收到'B'时,小车后退
backward();
digitalWrite(13, HIGH); //LED灯亮
} else if (input == 'L') { //当接收到'L'时,小车左转
left();
digitalWrite(13, HIGH); //LED灯亮
} else if (input == 'R') { //当接收到'R'时,小车右转
right();
digitalWrite(13, HIGH); //LED灯亮
} else if (input == 'S') { //当接收到'S'时,小车停止
stop();
digitalWrite(13, LOW); //LED灯灭
}
}
void forward() { //小车前进
leftMotor.setSpeed(200);
leftMotor.run(FORWARD);
rightMotor.setSpeed(200);
rightMotor.run(FORWARD);
}
void backward() { //小车后退
leftMotor.setSpeed(200);
leftMotor.run(BACKWARD);
rightMotor.setSpeed(200);
rightMotor.run(BACKWARD);
}
void left() { //小车左转
leftMotor.setSpeed(100);
leftMotor.run(BACKWARD);
rightMotor.setSpeed(100);
rightMotor.run(FORWARD);
}
void right() { //小车右转
leftMotor.setSpeed(100);
leftMotor.run(FORWARD);
rightMotor.setSpeed(100);
rightMotor.run(BACKWARD);
}
void stop() { //小车停止
leftMotor.run(RELEASE);
rightMotor.run(RELEASE);
}
```
这个程序使用串口通信接收指令,并根据指令控制小车运动。你可以在串口监视器中输入指令(F前进,B后退,L左转,R右转,S停止)来控制小车的运动。请注意,你需要先安装AFMotor库才能编译和上传这个程序。