0

このプログラムでgpsで位置情報を取得した後、ラジコンをまっすぐ走らせるというプログラムを作りたいのですが、どうしたらよいかわかりません。
現在はこのコードでエラーが発生します。
マイコンはesp-32を使用しており、開発環境はarduinoです。

volatile int gps_hh;          // GPSの時
volatile int gps_mm;          // 分
volatile int gps_ss;          // 秒
volatile int gps_dd;
volatile int gps_MM;
volatile int gps_yy;
volatile int GPS_OK = 0;
const int TD = 9;             // UTC+9時間

int RC_Motor_Pin = 26;
int RC_Sarvo_Pin = 27;

void setup()
{
  // シリアルポート開始
  Serial.begin(115200);
  Serial2.begin(9600); // GPSとのシリアル通信
  //Serial3.begin(115200);
  GPS_INIT();          // GPSの設定(GPZDAのみ取得)
 
 
}

void loop() {
  GPS_function();
}

// GPGGA
// 0----5---10---15---20---25---30---35---40---45---50---55---60---65---70-
// $GPGGA,015850.00,3543.51555,N,13926.84251,E,1,07,1.26,76.8,M,39.0,M,,*61

// GPZDA
// 0----5---10---15---20---25---30---35
// $GPZDA,065601.00,25,03,2021,00,00*67
void GPS_function() {
  //if (Serial1.available()) {
  if (Serial2.available()) {
    String nmea_gga = Serial2.readStringUntil('\n');  // GPGGAのセンテンス取得
    String nmea_zda = Serial2.readStringUntil('\n');  // GPZDAのセンテンス取得
    String nmeames_gga = nmea_gga.substring(0, 6);    // $GPGGA
    String nmeames_zda = nmea_zda.substring(0, 6);    // $GPZDA
    
    if ( nmeames_zda.equals("$GPZDA") ) { // get UTC
      if (nmea_zda.length()==37){         // 異常出力抑制 ※厳密にはチェックサム確認
        Serial.println("");
        String shh = nmea_zda.substring(7, 9);
        String smm = nmea_zda.substring(9, 11);
        String sss = nmea_zda.substring(11, 13);
        String ddd = nmea_zda.substring(17, 19);
        String MMM = nmea_zda.substring(20, 22);
        String yyy = nmea_zda.substring(23, 27);
        gps_hh = (shh.toInt() + TD) % 24; // Timezone offset+
        gps_mm = smm.toInt();
        gps_ss = sss.toInt();
        gps_dd = ddd.toInt();
        gps_MM = MMM.toInt();
        gps_yy = yyy.toInt();
        GPS_OK=1;
        Serial.print("GPS >> ");
        Serial.print(gps_yy);
        Serial.print("/");
        Serial.print(gps_MM);
        Serial.print("/");
        Serial.print(gps_dd);
        Serial.print(" ");
        Serial.print(gps_hh);
        Serial.print(":");
        Serial.print(gps_mm);
        Serial.print(":");
        Serial.println(gps_ss);
      }
    }
    else{
      Serial.println("GPZDAが来ないぞ!");
    }

    if ( nmeames_gga.equals("$GPGGA") ) {   // 衛星の数取得
      if (nmea_gga.length()==73){         // 異常出力抑制 ※厳密にはチェックサム確認
        String satellite = nmea_gga.substring(46, 48);
//        Serial.println(nmea_gga);
        Serial.print("衛星の数: ");
        Serial.println(satellite);
      }
    }
    else{
      Serial.println("GPGGAが来ないぞ!");
    }
  }
  else {
//    Serial.println("受け取れてないな...");
}
      if (Serial2.available()) {
        if(gps_mm() > 35.65){
          analogWrite(RC_Motor_Pin, 86)
          analogWrite(RC_Sarvp_Pin, 85)
        }
        else{
          analogWrite(RC_Motor_Pin, 89)
          analogWrite(RC_Sarvp_Pin, 85)
        }
        else{
          analogWrite(RC_Motor_Pin, 89)
          analogWrite(RC_Sarvp_Pin, 85)
        }
      }
   
}
1
  • 2
    エラーが出るのであればエラーメッセージも質問中に含めてください。 / 「作りたいけど分からない」ではなく、「分からない部分」を具体的に説明した方が回答が付きやすいと思います。
    – cubick
    1月27日 1:32

0

この質問に回答するには、ログインする必要があります。

のタグが付いた他の質問を参照する。