DIY PIXHAWK APM等飞控用的声纳

最新推荐文章于 2024-10-22 12:20:35 发布

weixin_33922672

最新推荐文章于 2024-10-22 12:20:35 发布

阅读量944

点赞数

CC 4.0 BY-SA版权

原文链接：http://www.cnblogs.com/Tranquilty/p/6226469.html

本文介绍了一个基于SR04超声波模块与Arduino的项目，通过使用SR04类库实现距离测量，并将数据通过I2C协议发送给APM主控板。代码实现了距离的平均值计算，确保了读数的稳定性。

代码：

SR04 + ApmSonar.ino 打包下载

注意，使用到了SR04的类库。

ApmSonar.ino

// sr04 to apm I2c sonar
// by panxu mail: pxzleo@126.com
// Created 2014
#include <Wire.h>
#include "SR04.h"
#define TRIG_PIN 2
#define ECHO_PIN 3
SR04 sr04 = SR04(ECHO_PIN,TRIG_PIN);
uint16_t reading_cm;
uint16_t tempread;
void setup()
{
  reading_cm=0; 
  Wire.begin(0x70);                // join i2c bus with address #2
  Wire.onRequest(requestEvent); // register event
}

void loop()
{
  tempread=sr04.DistanceAvg(25,1);
  if (tempread<500)  
       reading_cm=tempread;  
}
void requestEvent()
{
  byte sendhi;
  byte sendli;
  byte sendbyte[2];
  uint16_t tempreading_cm;
  tempreading_cm=reading_cm;
  sendhi=tempreading_cm>>8;
  sendli=tempreading_cm&0xff;
  sendbyte[0]=sendhi;
  sendbyte[1]=sendli;
  Wire.write(sendbyte,2); 
}