超声波测距

steeven_3009566

前面有人写过测距程序（https://www.cirmall.com/bbs/thread-11401-1-1.html），没注意到，自己从头写了一个，发现精度很好，发上来给大家玩玩

买板子的时候在淘宝买了个人体探头和超声探头，非常便宜：
http://item.taobao.com/item.htm?id=18046651946

本程序用gpio 1除非trip管脚，用adc 3采样，输出如下：
Usage ./dist trig(gpio 0~13) echo(adc 2~5)
Trig GPIO: 1, Echo ADC: 2
distance: 322cm
distance: 11cm
distance: 11cm
distance: 3716cm

这个程序从Echo上升沿开始计时，到下降沿结束作为具体计算： Echo时间*声速340/2
源代码：

1. /*
   
2. * Distance test program
   
3. */
   
4. #include <core.h>
   
5. 
   
6. int trig_pin = 1; //2nd pin of GPIO
   
7. int echo_pin = 2; //3rd ADC pin, 12bits, 4096 max
   
8. 
   
9. void setup()
   
10. {
    
11.     if ( argc != 2)
    
12.     {
    
13.         printf("Usage %s trig(gpio 0~13) echo(adc 2~5)\n", argv[0]);
    
14.     } else if(argc==2) {
    
15.         trig_pin = atoi(argv[1]);
    
16.         echo_pin = atoi(argv[2]);
    
17.     }
    
18.     printf("Trig GPIO: %d, Echo ADC: %d\n", trig_pin, echo_pin);
    
19.     pinMode(trig_pin, OUTPUT);
    
20. }
    
21. 
    
22. void loop()
    
23. {
    
24.     unsigned long time;
    
25.     int value;
    
26.     digitalWrite(trig_pin, HIGH);
    
27.     while(1) {
    
28.         value = analogRead(echo_pin); // get adc value
    
29.         if (value > 2048) { // send out
    
30.             time = micros();
    
31.             break;
    
32.         }
    
33.     }
    
34.     while(1) {
    
35.         value = analogRead(echo_pin); // get adc value
    
36.         if (value < 2048 ) { //echo stop
    
37.             printf("distance: %lucm\n", (micros() - time) * 340/2/10000 );
    
38.             break;
    
39.         }
    
40.      }
    
41.      digitalWrite(trig_pin, LOW);
    
42.      delay(100);
    
43. }

复制代码

库中pulsein函数应该很好用，但是看了下源码，貌似不对。

dwwzl

支持一下，端午快乐！

jameswang

MARK，向楼主学习