Arduino 超声波测距+OLED+RGB

1、通过超声历弊大波测距模块进行距离卜辩测量

2、将测量的结果显示在OLED屏幕上

3、当测量距肢竖离 <20cm 时，RGB模块显示红灯报警

#include <Wire.h>

#include "MPU6050.h"

#include <Ultrasonic.h>

#include "I2Cdev.h"

#define LED_PIN 13 //指示灯

//MPU6050陀螺仪

//MPU6050 my_gyro(3)

//使用ax, rx来获取二轮车姿态

//x轴加速度 &偏转角

short ax,rx

//short = int16_t

//缺陪HC-SRO4超声波传感器

//TRIG_PIN &ECHO_PIN

Ultrasonic my_hcsr(5,6)

float distance

int startTime

void setup() {

pinMode(LED_PIN,LOW)

//加入I2C总线

Wire.begin()

//初始化串口通信频道

Serial.begin(9600)

//初始化模块

//my_gyro.initialize()

my_hcsr.measure()

startTime = millis()

//初始化完成后指示灯常亮

pinMode(LED_PIN,HIGH)

}

void loop() {

//获取伏消蠢车身姿态

//ax=my_gyro.getAccelerationX()

//rx=my_gyro.getRotationX()

//获取前方障碍物距离

my_hcsr.measure()

distance=millis()-startTime

distance/桥猛=1000

distance=my_hcsr.get_cm()

Serial.print(distance,3)

Serial.println("cm")

delay(50)

}

---