M5StackとCatM+GNSSモジュールを用いて位置情報を取得する

#include <M5Stack.h>
#include <Wire.h>

// GPSモジュールとのシリアル接続を定義
#define SerialGPS Serial2

void setup() {
  M5.begin(); // M5Stackの初期化
  Serial.begin(115200); // シリアル通信の初期化（デバッグ用）
  SerialGPS.begin(9600, SERIAL_8N1, 16, 17); // GPSモジュールとのシリアル接続設定

  Serial.println("GPSモジュールを初期化中...");

  // GPSモジュールの初期化コマンドを送信
  SerialGPS.println("AT+CGNSPWR=1"); // GNSS電源をオンにする
  delay(1000);
  while (SerialGPS.available()) {
    char c = SerialGPS.read();
    Serial.print(c);
  }
  Serial.println();

  SerialGPS.println("AT+CGNSSEQ=\"RMC\""); // GNSS出力シーケンスを設定
  delay(1000);
  while (SerialGPS.available()) {
    char c = SerialGPS.read();
    Serial.print(c);
  }
  Serial.println();

  Serial.println("GPS初期化完了");
}

void loop() {
  SerialGPS.println("AT+CGNSINF"); // GNSS情報を照会
  delay(1000);

  String gpsData = "";
  while (SerialGPS.available()) {
    char c = SerialGPS.read();
    gpsData += c;
  }

  if (gpsData.length() > 0) {
    Serial.println("データ受信:");
    Serial.println(gpsData);

    // 受信データの解析
    if (gpsData.startsWith("AT+CGNSINF")) {
      int index = gpsData.indexOf(":");
      if (index != -1) {
        String gpsInfo = gpsData.substring(index + 1);
        parseGPSData(gpsInfo);
      }
    } else {
      Serial.println("有効なGPSデータがありません");
    }
  }
  delay(5000); // 5秒待機後、再度照会
}

void parseGPSData(String gpsInfo) {
  gpsInfo.trim();
  String data[10];
  int index = 0;

  while (gpsInfo.length() > 0 && index < 10) {
    int commaIndex = gpsInfo.indexOf(",");
    if (commaIndex == -1) {
      data[index++] = gpsInfo;
      break;
    } else {
      data[index++] = gpsInfo.substring(0, commaIndex);
      gpsInfo = gpsInfo.substring(commaIndex + 1);
    }
  }

  Serial.println("解析されたGPSデータ:");
  for (int i = 0; i < index; i++) {
    Serial.print("データ[");
    Serial.print(i);
    Serial.print("]: ");
    Serial.println(data[i]);
  }

  // GPS情報の表示
  if (index >= 7) {
    String latitude = data;
    String longitude = data;
    String altitude = data[5];
    String speed = data[6];

    Serial.print("緯度: ");
    Serial.println(latitude);
    Serial.print("経度: ");
    Serial.println(longitude);
    Serial.print("高度: ");
    Serial.println(altitude);
    Serial.print("速度: ");
    Serial.println(speed);

    // M5Stackのディスプレイに表示
    M5.Lcd.clear();
    M5.Lcd.setCursor(0, 0);
    M5.Lcd.setTextSize(2);
    M5.Lcd.printf("緯度: %s\n", latitude.c_str());
    M5.Lcd.printf("経度: %s\n", longitude.c_str());
    M5.Lcd.printf("高度: %s\n", altitude.c_str());
    M5.Lcd.printf("速度: %s\n", speed.c_str());
  } else {
    Serial.println("無効なGPSデータ形式");
  }
}