以下是一个基于Arduino的自动驾驶汽车示例代码,使用超声波传感器来检测前方障碍物并采取相应的行动。
// 引入超声波库
#include
// 定义超声波传感器的引脚
#define TRIGGER_PIN 12
#define ECHO_PIN 11
// 定义电机驱动引脚
#define MOTOR_PIN1 9
#define MOTOR_PIN2 10
// 定义超声波传感器对象
Ultrasonic ultrasonic(TRIGGER_PIN, ECHO_PIN);
void setup() {
// 设置电机引脚为输出模式
pinMode(MOTOR_PIN1, OUTPUT);
pinMode(MOTOR_PIN2, OUTPUT);
// 初始化串口通信
Serial.begin(9600);
}
void loop() {
// 读取超声波传感器测量的距离(单位:厘米)
int distance = ultrasonic.Ranging(CM);
// 打印距离值到串口监视器
Serial.print("Distance: ");
Serial.println(distance);
// 如果距离小于10厘米,表示有障碍物
if (distance < 10) {
// 停止电机
digitalWrite(MOTOR_PIN1, LOW);
digitalWrite(MOTOR_PIN2, LOW);
// 输出提示信息
Serial.println("Obstacle detected! Stopping the car.");
} else {
// 没有障碍物,继续前进
digitalWrite(MOTOR_PIN1, HIGH);
digitalWrite(MOTOR_PIN2, LOW);
}
// 等待一段时间再进行下一次测量
delay(100);
}
上述代码使用了Ultrasonic库来控制超声波传感器。首先在setup()
函数中,通过pinMode()
函数将电机引脚设为输出模式,并初始化串口通信。
在loop()
函数中,使用ultrasonic.Ranging(CM)
函数来获取超声波传感器检测到的距离值,并将其存储在distance
变量中。
然后,使用Serial.print()
和Serial.println()
函数将距离值打印到串口监视器。
接下来,使用if
语句判断距离是否小于10厘米,如果是,则表示有障碍物,需要停止电机并输出相应的提示信息。如果距离大于等于10厘米,则表示没有障碍物,可以继续前进。
最后,使用delay()
函数等待一段时间再进行下一次测量。
请注意,上述代码仅为示例,实际情况可能需要根据具体硬件和需求进行适当的修改。
上一篇:Arduino状态机问题与状态机