メインコンテンツへスキップ
見出し画像

人感センサーSeeed Studio 24GHz mmWave for XIAOをXIAO ESP32C3で動かしてみた。

    1.センサ単体の動作確認

    まず、USBシリアル変換モジュール(FTDI232やCP210x)とセンサ単体(Seeed Studio 24GHz mmWave for XIAO)を次のように接続します。

    <USBシリアル変換モジュールーセンサ単体>
    ・VCCー3V3(5Vはだめです。動きません。)
    ・GNDーGND
    ・TXーRX
    ・RXーTX

    次に下記リンク先にある、「Windows用HLKRadarToolをダウンロード」をクリックして、HLKRadarTool.zipを入手します。

    HLKRadarTool.zipを解凍したら、LD2410.exeを実行します。
    ・USBシリアル変換モジュールのCOMポート(画像ではCOM14)
    ・ボーレート(絶対に256000)
    の2点を設定の上、Connectボタンで接続します。

    画像
    Connectボタンで接続する。

    接続に成功したら、Startボタンで計測を開始します。
    ・センサに近づくと、ランプが赤色になって、cmの値が小さく、
    ・センサから遠ざかると、ランプが緑色になって、cmの値が大きく、
    なります。これで単体動作確認は完了です。

    画像
    Startボタンで計測を開始する。

    2.XIAO ESP32C3との接続

    Seeed Studio 24GHz mmWave for XIAOとXIAO ESP32C3を接続します。
    下記の画像のように、向きを間違えないようにしてください。

    画像
    アンテナが外側を向くように取り付ける。

    3.XIAO ESP32C3に書き込み(その1)

    Arduino IDEを開いたら、ボードはXIAO_ESP32C3、USB CDC On BootはEnabledに設定します。

    画像
    ボードはXIAO_ESP32C3、USB CDC On BootはEnabledにする。

    次のプログラムを書き込むと、シリアルモニタでセンサの情報を確認できます。(2回目以降書き込むときは、UARTが速すぎてエラーが出ることがあったので、BOOTを押しながら、パソコンに接続して、BOOTを離しました。)(シリアルモニタに何も表示されない場合は、モニタの閉じる開くを繰り返してみてください。)

    #include <HardwareSerial.h>
    
    #define RX_PIN D2
    #define TX_PIN D3
    
    HardwareSerial mmwave(1);
    
    void setup() {
      Serial.begin(115200);
      delay(2000);
    
      mmwave.begin(256000, SERIAL_8N1, RX_PIN, TX_PIN);
      Serial.println("LD2410 HEX Monitor Start");
    }
    
    void loop() {
      while (mmwave.available()) {
        uint8_t c = mmwave.read();
    
        // 16進表示
        if (c < 0x10) Serial.print("0");
        Serial.print(c, HEX);
        Serial.print(" ");
      }
    }

    得られたデータを取り出すと、
    F4 F3 F2 F1 0D 00 02 AA 03 1E 00 64 45 00 64 00 00 55 00 F8 F7 F6 F5
    となりますが、以下ChatGPTの解説です。

    <↘↘↘ここから↙↙↙>

    素晴らしいです。
    このダンプから完全に正常通信していることが確定しました。
    しかもフレーム構造もはっきり見えています。


    受信フレームの構造解析

    あなたのログは次の周期で繰り返されています:

    F4 F3 F2 F1 0D 00 02 AA 03 XX 00 64 YY 00 64 00 00 55 00 F8 F7 F6 F5
    

    重要なのはここです:

    AA 03 XX 00 64 YY 00 64
    

    これはLD2410のリアルタイムデータ領域です。


    人検知に関係するバイト位置

    このフォーマットの場合:

    ・data[7] = 0xAA  データ種別
    ・data[8] = 0x03  ターゲット状態
    ・data[9] = XX  動体エネルギー
    ・data[11] = YY  静止体エネルギー

    特に重要なのは
    data[8] = 0x03 です。


    ここが超重要

    ログを見ると常に

    AA 03
    

    となっています。

    これは仕様上:

    00 人なし
    01 動体あり
    02 静止体あり
    03 動体+静止体あり(=人がいる)

    つまり現在ログは

    常に「人がいる」状態

    を示しています。

    <↗↗↗ここまで↖↖↖>

    実際にパソコン画面を録画しながら離れてみると、
    AA 03 → AA 02 → AA 00
    と値が変化するのを確認できました。

    4.XIAO ESP32C3に書き込み(その2)

    最後に分かりやすい表示形式にして、終わりにしたいと思います。
    以下のプログラムを実行すると、人の有無がシリアルモニタに表示されます。

    #include <HardwareSerial.h>
    
    #define RX_PIN D2
    #define TX_PIN D3
    
    HardwareSerial mmwave(1);
    
    bool human_present = false;
    
    void setup() {
      Serial.begin(115200);
      delay(2000);
      mmwave.begin(256000, SERIAL_8N1, RX_PIN, TX_PIN);
      Serial.println("LD2410 Presence Detect Start");
    }
    
    void loop() {
      static uint8_t buf[32];
      static int idx = 0;
    
      while (mmwave.available()) {
        uint8_t b = mmwave.read();
    
        // 正しいヘッダ: F4 F3 F2 F1
        if (idx == 0 && b != 0xF4) continue;
        if (idx == 1 && b != 0xF3) { idx = 0; continue; }
        if (idx == 2 && b != 0xF2) { idx = 0; continue; }
        if (idx == 3 && b != 0xF1) { idx = 0; continue; }
    
        buf[idx++] = b;
    
        if (idx >= 20) {  // 必要部分だけ取得
          parseFrame(buf);
          idx = 0;
        }
      }
    }
    
    void parseFrame(uint8_t *data) {
      uint8_t target_state = data[8];
    
      bool detected = (target_state != 0x00);
    
      Serial.print("TargetState: ");
      Serial.print(target_state);
      Serial.print("  -> ");
      Serial.println(detected ? "PRESENT" : "ABSENT");
    }
    
    
    画像
    風呂場まで行って、戻ってきたときの表示。
    ABSENTからPRESENTに変化している。

    以上になります。人感センサーSeeed Studio 24GHz mmWave for XIAOをXIAO ESP32C3で動かすことが出来て良かったです。

    あなたへのおすすめ