写一个arduino避障小车的代码
时间: 2023-04-10 13:05:20 浏览: 269
非常感谢您的提问,以下是一个简单的 Arduino 避障小车代码:
```
// 定义引脚
const int trigPin = 9;
const int echoPin = 10;
const int leftMotorPin1 = 5;
const int leftMotorPin2 = 6;
const int rightMotorPin1 = 10;
const int rightMotorPin2 = 11;
// 定义变量
long duration;
int distance;
void setup() {
// 初始化引脚
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(leftMotorPin1, OUTPUT);
pinMode(leftMotorPin2, OUTPUT);
pinMode(rightMotorPin1, OUTPUT);
pinMode(rightMotorPin2, OUTPUT);
}
void loop() {
// 发送超声波信号
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
// 接收超声波信号
duration = pulseIn(echoPin, HIGH);
distance = duration * 0.034 / 2;
// 判断距离是否小于 30 厘米
if (distance < 30) {
// 停止小车
digitalWrite(leftMotorPin1, LOW);
digitalWrite(leftMotorPin2, LOW);
digitalWrite(rightMotorPin1, LOW);
digitalWrite(rightMotorPin2, LOW);
} else {
// 启动小车
digitalWrite(leftMotorPin1, HIGH);
digitalWrite(leftMotorPin2, LOW);
digitalWrite(rightMotorPin1, HIGH);
digitalWrite(rightMotorPin2, LOW);
}
}
```
希望这个代码对您有所帮助!
阅读全文