pluseIn(pin,value)
image.png

  1. const short trigPin[4];                         //定义一个数组，表示4个发出超声波的引脚
  2. const short echoPin[4];                         //定义一个数组，表示4个接收超声波的引脚
  4. float d(short trp, short ecp) {                 //函数d，两个参数是引脚的名称。在后面用数组依次初始化。
  5.   digitalWrite(trp, LOW);                       //trigPin引脚 低高低发出超声波
  6.   delayMicroseconds(2);
  7.   digitalWrite(trp, HIGH);
  8.   delayMicroseconds(10);
  9.   digitalWrite(trp, LOW);
  10.   return (pulseIn(ecp, HIGH) / 58.0);           //返回值是echoPin的距离    //pulseIn()返回值是时间，/58.0之后就是距离单位是cm。
  11. }
  15. /// <summary>
  16. /// 超声波测距初始化
  17. /// </summary>
  18. void HighWave_Init() {                          //highwave_init表示超声波初始化函数。
  19.   for (short i = 0; i < 4; i++)                 //依次设置引脚为输出和输入，顺便把trigPin引脚设置为LOW
  20.   {
  21.     pinMode(trigPin[i], OUTPUT);
  22.     pinMode(echoPin[i], INPUT);
  23.     digitalWrite(trigPin[i], LOW);
  24.   }
  25. }
  27. /// <summary>
  28. /// 获取超声波测距数据
  29. /// </summary>
  30. /// <param name="val">数据存储数组</param>
  31. void GetLength_HighWave(float value[]) {       //其他位置声明value数组，调用value数组储存着最后的距离值。//而且返回值是void，因为调用数组/指针，不需要返回值。
  32.   for (short i = 0; i < 4; i++)
  33.     value[i] = d(trigPin[i], echoPin[i]);      //依次调用d()函数测距离。
  34. }

串口监视器

  1. float value[4]={0};
  2. const short trigPin[4] = {22, 24, 26, 28};
  3. const short echoPin[4] = {23, 25, 27, 29};
  5. float d(short trp, short ecp) {
  6.   digitalWrite(trp, LOW);
  7.   delayMicroseconds(2);
  8.   digitalWrite(trp, HIGH);
  9.   delayMicroseconds(10);
  10.   digitalWrite(trp, LOW);
  11.   return (pulseIn(ecp, HIGH) / 58.0);
  12. }
  16. /// <summary>
  17. /// 超声波测距初始化
  18. /// </summary>
  19. void HighWave_Init() {
  20.   for (short i = 0; i < 4; i++)
  21.   {
  22.     pinMode(trigPin[i], OUTPUT);
  23.     pinMode(echoPin[i], INPUT);
  24.     digitalWrite(trigPin[i], LOW);
  25.   }
  26. }
  28. /// <summary>
  29. /// 获取超声波测距数据
  30. /// </summary>
  31. /// <param name="val">数据存储数组</param>
  32. void GetLength_HighWave(float value[]) {
  33.   for (short i = 0; i < 4; i++)
  34.     value[i] = d(trigPin[i], echoPin[i]);
  35. }
  38. void setup() {
  39.   Serial.begin(9600);
  40.   HighWave_Init();
  41. }
  43. void loop() {
  44.   Serial.print("Distance:");
  45.   GetLength_HighWave(value);
  46.   Serial.println(value[0]);
  47.    Serial.println(value[1]);
  48.     Serial.println(value[2]);
  49.      Serial.println(value[3]);
  50.   Serial.print("cm");
  51.   Serial.println();  
  53. }