日: 2024年7月27日

//初期値設定用　平均
float sokutei_heikin(int m){
  float Value[10];
  float Max;
  float Min;
  float Sum;
  
    for(int Ct=0;Ct<m;Ct++){
       Value[Ct]=measureDistance_1();//距離の測定関数を呼び出す。
       Serial.print(Ct);
       Serial.print(" =");
       Serial.println(Value[Ct]);
      if(Ct == 0) {//最初の測定値を最大・最小値として保存
          Max=Value[0];
          Min=Value[0];
      }
      else {
        if(Value[Ct] > Max){//取得したデータを最大値と比較して，大きければ，新たに保存
            Max=Value[Ct];
        }
        if(Value[Ct] < Min){////取得したデータを最小値と比較して，小さければ，新たに保存
            Min=Value[Ct];
        }
      }
     Sum+=Value[Ct];/*測定値を加算*///測定値を加算していく
  }

  Sum=(Sum-(Max+Min))/(m-2);//最大値と最小値を除いて，平均をとる。
  Serial.print("AVE");
  Serial.print(" =");
  Serial.println(Sum);

  return Sum;/*最大値・最小値を除いた平均値を返す*/
}

float measureDistance_1() {
  char m[50];
  Serial2.write("S");//ＲＸ端子をＨＩＧＨにするのに一文字書き込む。
  if (Serial2.available()){
    hdr = (byte)Serial2.read();
    if (hdr == 255){
      data_h = (byte)Serial2.read();
      data_l = (byte)Serial2.read();
      chksum = (byte)Serial2.read();
        if (chksum == ((hdr + data_h + data_l)&0x00FF)){
            distance = data_h * 256 + data_l;//距離計算
        }
     }
    }
  delay(100); 
  return distance;
 }