Arduino连接超声波传感器测距

来源:互联网 发布:黑暗风格数据地图 编辑:程序博客网 时间:2024/05/22 03:22

  这里介绍arduino mega2560通过L298N 2路电机驱动板两个方面的知识:1、连接超声波传感器电路。2、编写代码实现测距功能。

一、电路连接

1、arduino mega2560与驱动板的引脚对应关系(arduino与驱动板的链接)


驱动板引脚

对应Arduino引脚

功能

IN1

7

电机1输入

IN2

8

电机1输入

ENA

9

电机1PWM

IN3

12

电机2输入

IN4

13

电机2输入

ENB

10

电机2PWM

5

2

电机1编码器中断

6

3

电机2编码器中断

1

 

电机1编码器4引脚

2

 

电机2编码器4引脚

2、驱动板与超声波传感器的线路链接



二、写代码进行超声波传感器测距

1、写代码

const int TrigPin = 5; 
const int EchoPin = 6; 
float cm; 
void setup() 

Serial.begin(9600); 
pinMode(TrigPin, OUTPUT); 
pinMode(EchoPin, INPUT); 

void loop() 

digitalWrite(TrigPin, LOW); //低高低电平发一个短时间脉冲去TrigPin 
delayMicroseconds(2); 
digitalWrite(TrigPin, HIGH); 
delayMicroseconds(10); 
digitalWrite(TrigPin, LOW); 


cm = pulseIn(EchoPin, HIGH) / 58.0; //将回波时间换算成cm 
cm = (int(cm * 100.0)) / 100.0; //保留两位小数 
Serial.print(cm); 
Serial.print("cm"); 
Serial.println(); 
delay(1000); 


使用arduino IDE把以上代码下载进arduino mega2560,通电即可使用超声波传感器测距了。


2、实现效果



that's all!

2 0
原创粉丝点击