#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)
}
1、通过超声历弊大波测距模块进行距离卜辩测量2、将测量的结果显示在OLED屏幕上
3、当测量距肢竖离 <20cm 时,RGB模块显示红灯报警
欢迎分享,转载请注明来源:内存溢出
评论列表(0条)