l298n驱动智能小车的超声波模块和舵机简单程序

你好，以下是对于你的问题的简单程序：

#include <Servo.h>//导入舵机库
#define trigPin 4//定义超声波引脚
#define echoPin 5
Servo myservo;//定义舵机实例
int pos = 0;//定义舵机角度
void setup() {
Serial.begin (9600);//初始化串口
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
myservo.attach(9);//舵机信号线接9脚
}
void loop() {
long duration, distance;//定义超声波测距时间和距离
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration/2) / 29.1;//计算距离
if (distance < 30) {//小于30厘米时，舵机向左旋转
myservo.write(0);//舵机旋转到0度
} else {//大于30厘米时，舵机向右旋转
myservo.write(180);//舵机旋转到180度
}
Serial.print(distance);//将距离输出到串口
Serial.println(" cm");
delay(200);
}

希望这个程序能够帮到你。