「Grove 超音波距離測定センサー - Ultrasonic Distance Sensor」を動かす

2021/12/30
初版

Grove_Ultrasonic_Distance_Sensor

Grove_Ultrasonic_Distance_Sensor

概要

「Grove 超音波距離測定センサー - Ultrasonic Distance Sensor」を動かす。
なお、M5Stackから「Ultrasonic Distance Unit (RCWL-9600)」が出ているが、これはインタフェースがI2CでありGroveのものと互換性がない。使用しているスケッチはM5StackのI2C用のものをGrove用に変更した。
ソースは共通になっており、ターゲットのM5StickCPlus,M5Core2をplatformio.iniの内容で切り替えてビルドする。

ソース

src/GROVE_ULTRA_SONIC.ino

  /*
  *******************************************************************************
  * Copyright (c) 2021 by M5Stack
  *                  Equipped with M5Core2 sample source code
  *                          配套  M5Core2 示例源代码
  * Visit the website for more information：https://docs.m5stack.com/en/core/core2
  * 获取更多资料请访问：https://docs.m5stack.com/zh_CN/core/core2
  *
  * describe: Ultrasonic.  超声波测距传感器
  * date：2021/8/19
  *******************************************************************************
    Please connect to Port A,Display the distance measured by ultrasonic
    请连接端口A,显示超声波测量的距离
  */

  //#define INCHES
  #define CMS

  #ifdef M5C2
  #include <M5Core2.h>
  #endif
  #ifdef M5STICK_CP
  #include <M5StickCPlus.h>
  #endif

  #include "Ultrasonic.h"

  Ultrasonic ultrasonic(33); // PIRT-A of M5Core2/M5StickCPlus

  void setup() {
    Serial.begin(115200);
    M5.begin(); //Init M5Core2.  初始化M5Core2
  #ifdef M5STICK_CP
    M5.Lcd.setRotation(3);
  #endif  

    //Wire.begin(32, 33);
  #ifdef M5C2
    M5.Lcd.setCursor(105, 0, 4);  //Set the cursor at (105,0) and set the font to a 4 point font.  将光标设置在(105,0)处,且设置字体为4号字体
  #endif
  #ifdef M5STICK_CP
    M5.Lcd.setCursor(0, 0, 4);  
  #endif
    M5.Lcd.print("Ultrasonic\nDistance:");
  }

  long readEUS()
  {
      long RangeInInches;
      long RangeInCentimeters;

      Serial.println("The distance to obstacles in front is: ");
  #ifdef INCHES
      RangeInInches = ultrasonic.MeasureInInches();
      Serial.print(RangeInInches);//0~157 inches
      Serial.println(" inch");
      return RangeInInches;
      //delay(250);
  #endif
  #ifdef CMS
      RangeInCentimeters = ultrasonic.MeasureInCentimeters(); 
      Serial.print(RangeInCentimeters);//0~400cm
      Serial.println(" cm");
      return RangeInCentimeters;
      //delay(250);   
  #endif    
  }

  /*****
  float readEUS()
  {
    uint32_t data;
    Wire.beginTransmission(0x57); //Transfer data to 0x57.  将数据传输到0x57
    Wire.write(0x01);
    Wire.endTransmission(); //Stop data transmission with the Ultrasonic Unit.  停止与Ultrasonic Unit的数据传输
    delay(120);
    Wire.requestFrom(0x57,3); //Request 3 bytes from Ultrasonic Unit.  向Ultrasonic Unit请求3个字节。
    data  = Wire.read();data <<= 8;
    data |= Wire.read();data <<= 8;
    data |= Wire.read();
    return float(data) / 1000;
  }

  void loop() {
    static float newvalue = 0;
    newvalue = readEUS();
    if(( newvalue < 1500 )&&( newvalue > 20 )){
      M5.Lcd.setCursor(105,27);
      M5.Lcd.printf("%.2fmm",newvalue);
    }
    delay(100);
  }
  ***********/

  void loop() {
    long newvalue = 0;

    newvalue = readEUS();
  #ifdef M5C2
    M5.Lcd.setCursor(105,27);
  #endif
  #ifdef M5STICK_CP
    M5.Lcd.setCursor(0, 47);
  #endif
    M5.Lcd.printf("%4d cm    ",newvalue);
    delay(100);
  }
  

platformio.ini

M5Core2用

  [env:m5core2]
  platform = espressif32
  board = m5stack-core2
  framework = arduino
  upload_speed = 2000000
  monitor_speed = 115200
  board_build.partitions = default_16MB.csv

  build_flags = 
      -DM5C2
      -DCORE_DEBUG_LEVEL=4
      -DBOARD_HAS_PSRAM
      -mfix-esp32-psram-cache-issue

  lib_deps =
      https://github.com/m5stack/M5Core2.git
      https://github.com/FastLED/FastLED
      ;https://github.com/m5stack/M5Core2/blob/master/examples/core2_for_aws/ArduinoECCX08.zip
      lovyan03/LovyanGFX
      adafruit/Adafruit BMP280 Library @ ^2.5.0
      adafruit/Adafruit Unified Sensor @ ^1.1.4    
      m5stack/UNIT_ENV @ ^0.0.2 
      seeed-studio/Grove Ultrasonic Ranger @ ^1.0.1

  lib_ldf_mode = deep+

  

M5StickCPlus用

  [env:M5StickCPlus]
  platform = espressif32
  board = m5stick-c
  framework = arduino
  build_flags = -DM5STICK_CP
  monitor_speed = 115200
  lib_ldf_mode = deep+

  lib_deps =
      m5stack/M5StickCPlus @ ^0.0.5
      tinyu-zhao/FFT @ ^0.0.1
      m5stack/UNIT_ENV @ ^0.0.2
      adafruit/Adafruit BMP280 Library @ ^2.5.0
      adafruit/Adafruit Unified Sensor @ ^1.1.4
      seeed-studio/Grove Ultrasonic Ranger @ ^1.0.1

  

動作

超音波で距離を測定した結果がLCDに表示される。

参考情報

terminal関連:
Bootterm – a developer-friendly serial terminal program

platformio関連：
arduinoフレームワーク用platformio.ini集
Building Core2 FactoryDemo in PlatformIO
VSCodeとPlatformIOでM5Stack Core2開発
M5Stack Core2とVSCode + PlatformIOとでM5Stackプログラミングを始めてみた。

Arduino-IDE関連：
Arduino IDE environment - M5Paper
Arduino IDEのインストールと設定 (Windows, Mac, Linux対応)

M5Stackファミリ関連：
M5Core2 Arduino Install
M5Paper Arduino Install
M5CoreInk Arduino Install
M5Stamp-PICO Arduino Install
M5Stamp-C3 Arduino Install
Wio-Terminal/ESP8622/ESP32ボードを共通のスケッチで動かす(NTP-CLIENT編)
Wio-Terminal/M5Atom/ESP8622/ESP32ボードを共通のスケッチで動かす(v2)(STARWARS編)
Wio-Terminal/M5Atom/ESP8622/ESP32ボードを共通のスケッチで動かす(v2)(MQTT編)
Wio-Terminal/M5Atom/ESP8622/ESP32ボードを共通のスケッチで動かす(v2)(REST-API編)
Wio-Terminal/M5Atom/ESP8622/ESP32ボードを共通のスケッチで動かす(v2)(OSC編)

以上