全志ARM-超声波测距
创始人
2025-01-07 22:34:52
0

超声波测距模块是用来测量距离的一种产品,通过发送和收超声波,利用时间差和声音传播速度, 计算出模块到前方障碍物的距离

1.测距原理:

给Trig端口至少10us的高电平发送声波,Echo信号,由低电平跳转到高电平,开始发送波;Echo,由高电平跳转回低电平,表示波回来了

计算时间:Echo引脚维持高电平的时间!声波发出去的那一下,开始启动定时器声波回来的拿一下,我们开始停止定时器,计算出中间经过多少时间

计算距离:

距离=速度(340m/s)*时间/2

2. 时间函数

#include int gettimeofday(struct timeval *tv,struct timezone *tz )

gettimeofday()会把目前的时间用tv 结构体返回,当地时区的信息则放到tz所指的结构中

1. timeval 结构体定义:

struct  timeval{         long  tv_sec;  /*秒*/         long  tv_usec; /*微妙*/  };

 2. timezone 结构定义:

struct  timezone{          int tz_minuteswest;/*和greenwich 时间差了多少分钟*/          int tz_dsttime;    /*type of DST correction*/  }:

代码实现:

//计算程序在当前环境中数数10万次耗时多少 #include   #include   //int gettimeofday(struct timeval *tv,struct timezone *tz )  void mydelay()  {  int i,j;  for(i=0;i<100;i++){  for(j=0;j<1000;j++);  }  }  int main()  {  struct timeval startTime;  struct timeval stopTime;  gettimeofday(&startTime,NULL);  mydelay();  gettimeofday(&stopTime,NULL);  long diffTime = 1000000*(stopTime.tv_sec - startTime.tv_sec) +   (stopTime.tv_usec - startTime.tv_usec);  printf("全志H6的Linux数100000耗时%ldus\n",diffTime);  return 0;  }

3.实现超声波实时返回距离

getDistance()函数实现声波测定距离,主函数main()中获取并打印,sleep()控制每次测定距离的间隔

 double getDistance()  {  double dis;  struct timeval start;  struct timeval stop;  pinMode(Trig, OUTPUT);  pinMode(Echo, INPUT);  digitalWrite(Trig ,LOW);  usleep(5);  digitalWrite(Trig ,HIGH);  usleep(10);  digitalWrite(Trig ,LOW);  /*above init CSB*/  while(!digitalRead(Echo));  gettimeofday(&start,NULL);  while(digitalRead(Echo));  gettimeofday(&stop,NULL);  }  long diffTime = 1000000*(stop.tv_sec-start.tv_sec)+(stop.tv_usec -  start.tv_usec);  printf("diffTime = %ld\n",diffTime);  dis = (double)diffTime/1000000 * 34000 / 2;  return dis;    int main(){      double dis;  if(wiringPiSetup() == -1){  fprintf(stderr,"%s","initWringPi error");  exit(-1);  }  while(1){  dis = getDistance();  printf("dis = %lf\n",dis);  usleep(500000);  }  return 0;    }

相关内容

热门资讯

技术分享!吉祥麻将免输神器下载... 技术分享!吉祥麻将免输神器下载(辅助挂)外挂透视辅助神器(2022已更新)(哔哩哔哩)1、在吉祥麻将...
必备科技!博雅红河棋牌有没有挂... 必备科技!博雅红河棋牌有没有挂(辅助挂)都是存在有挂(2020已更新)(哔哩哔哩)1、很好的工具软件...
十分钟普及!哈局十三张,来玩德... 十分钟普及!哈局十三张,来玩德州好像真的有挂,2025新版总结(有挂攻略)1)哈局十三张辅助挂:进一...
必备教程!乐乐四川麻将助赢神器... 必备教程!乐乐四川麻将助赢神器购买(透视)外挂透明挂辅助工具(2022已更新)(哔哩哔哩);1、让任...
必备教程!乐清麻将花到底有没有... 必备教程!乐清麻将花到底有没有挂(透视)原来是有挂(2026已更新)(哔哩哔哩);1、不需要AI权限...
八分钟了解!吉安麻将73棋牌有... 八分钟了解!吉安麻将73棋牌有挂嘛,菠萝德州app好像是真的有挂,2025新版教程(有挂科普);1、...
推荐一款!!雀神小程序除了微信... 推荐一款!!雀神小程序除了微信哪有(透视辅助)外挂透明挂辅助脚本(2020已更新)(哔哩哔哩)推荐一...
一分钟了解!欢乐茶坊辅助器(辅... 一分钟了解!欢乐茶坊辅助器(辅助挂)确实有挂(2026已更新)(哔哩哔哩)在进入欢乐茶坊辅助器辅助挂...
两分钟攻略!喜扣跑胡子免费辅助... 两分钟攻略!喜扣跑胡子免费辅助器,智星德州扑克本来存在有挂,力荐教程(有挂透明);小薇(透视辅助)致...
必备科技!广西棋牌友玩十三张有... 必备科技!广西棋牌友玩十三张有挂吗(辅助挂)透视辅助神器(2020已更新)(哔哩哔哩)亲,关键说明,...