全志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;    }

相关内容

热门资讯

一分钟内幕!科乐吉林麻将系统发... 一分钟内幕!科乐吉林麻将系统发牌规律,福建大玩家确实真的是有挂,技巧教程(有挂ai代打);所有人都在...
一分钟揭秘!微扑克辅助软件(透... 一分钟揭秘!微扑克辅助软件(透视辅助)确实是有挂(2024已更新)(哔哩哔哩);1、用户打开应用后不...
五分钟发现!广东雀神麻雀怎么赢... 五分钟发现!广东雀神麻雀怎么赢,朋朋棋牌都是是真的有挂,高科技教程(有挂方法)1、广东雀神麻雀怎么赢...
每日必看!人皇大厅吗(透明挂)... 每日必看!人皇大厅吗(透明挂)好像存在有挂(2026已更新)(哔哩哔哩);人皇大厅吗辅助器中分为三种...
重大科普!新华棋牌有挂吗(透视... 重大科普!新华棋牌有挂吗(透视)一直是有挂(2021已更新)(哔哩哔哩)1、完成新华棋牌有挂吗的残局...
二分钟内幕!微信小程序途游辅助... 二分钟内幕!微信小程序途游辅助器,掌中乐游戏中心其实存在有挂,微扑克教程(有挂规律)二分钟内幕!微信...
科技揭秘!jj斗地主系统控牌吗... 科技揭秘!jj斗地主系统控牌吗(透视)本来真的是有挂(2025已更新)(哔哩哔哩)1、科技揭秘!jj...
1分钟普及!哈灵麻将攻略小,微... 1分钟普及!哈灵麻将攻略小,微信小程序十三张好像存在有挂,规律教程(有挂技巧)哈灵麻将攻略小是一种具...
9分钟教程!科乐麻将有挂吗,传... 9分钟教程!科乐麻将有挂吗,传送屋高防版辅助(总是存在有挂)1、完成传送屋高防版辅助透视辅助安装,帮...
每日必看教程!兴动游戏辅助器下... 每日必看教程!兴动游戏辅助器下载(辅助)真是真的有挂(2025已更新)(哔哩哔哩)1、打开软件启动之...