Arduinoで超音波センサHC-SR04による距離測定する【ブロックプログラミングLesson13】

/* 作品名：LESSON13 */
/* 作成者：せでぃあ　https://cediablog.com */
/* 超音波センサ　×　4ケタ7セグメントディスプレイ */

int TRIG_SOCKET = 0;          //超音波センサTRIG接続ソケット番号
int ECHO_SOCKET = 1;          //超音波センサECHO接続ソケット番号
int SEG_A_SOCKET = 2;         //セグメントA(7)の出力ソケット番号
int SEG_B_SOCKET = 3;         //セグメントB(6)の出力ソケット番号
int SEG_C_SOCKET = 4;         //セグメントC(4)の出力ソケット番号
int SEG_D_SOCKET = 5;         //セグメントD(2)の出力ソケット番号
int SEG_E_SOCKET = 6;         //セグメントE(1)の出力ソケット番号
int SEG_F_SOCKET = 7;         //セグメントF(9)の出力ソケット番号
int SEG_G_SOCKET = 8;         //セグメントG(10)の出力ソケット番号
int SEG1_SOCKET = 9;          //4桁目のセグメント点灯出力ソケット番号
int SEG2_SOCKET = 10;         //3桁目のセグメント点灯出力ソケット番号
int SEG3_SOCKET = 11;         //2桁目のセグメント点灯出力ソケット番号
int SEG4_SOCKET = 12;         //1桁目のセグメント点灯出力ソケット番号
int SEGDP_SOCKET = 13;        //セグメントDP(3)の出力ソケット番号

int SEGNUM;                   //セグメント点灯数字
int SEGNUM1;                  //セグメント1桁目点灯数字
int SEGNUM2;                  //セグメント2桁目点灯数字
int SEGNUM3;                  //セグメント3桁目点灯数字
int SEGNUM4;                  //セグメント4桁目点灯数字

float DURATION;               //超音波センサ検出時間
float DISTANCE;               //超音波センサ検出距離

void setup() {
  // put your setup code here, to run once:　プログラム起動時1回だけ処理される回路

  //入出力の割り当て

  pinMode(TRIG_SOCKET, OUTPUT);       //0番ﾋﾟﾝは出力として使用
  pinMode(ECHO_SOCKET, INPUT);        //1番ﾋﾟﾝは入力として使用
  pinMode(SEG_A_SOCKET, OUTPUT);      //2番ﾋﾟﾝは出力として使用
  pinMode(SEG_B_SOCKET, OUTPUT);      //3番ﾋﾟﾝは出力として使用
  pinMode(SEG_C_SOCKET, OUTPUT);      //4番ﾋﾟﾝは出力として使用
  pinMode(SEG_D_SOCKET, OUTPUT);      //5番ﾋﾟﾝは出力として使用
  pinMode(SEG_E_SOCKET, OUTPUT);      //6番ﾋﾟﾝは出力として使用
  pinMode(SEG_F_SOCKET, OUTPUT);      //7番ﾋﾟﾝは出力として使用
  pinMode(SEG_G_SOCKET, OUTPUT);      //8番ﾋﾟﾝは出力として使用
  pinMode(SEG1_SOCKET, OUTPUT);       //9番ﾋﾟﾝは出力として使用
  pinMode(SEG2_SOCKET, OUTPUT);       //10番ﾋﾟﾝは出力として使用
  pinMode(SEG3_SOCKET, OUTPUT);       //11番ﾋﾟﾝは出力として使用
  pinMode(SEG4_SOCKET, OUTPUT);       //12番ﾋﾟﾝは出力として使用
  pinMode(SEGDP_SOCKET, OUTPUT);     //13番ﾋﾟﾝは出力として使用

}

void loop() {
  // put your main code here, to run repeatedly:　プログラム起動後ﾙｰﾌﾟ処理される回路

  digitalWrite(TRIG_SOCKET , LOW);                              //計測前にトリガー信号をOFFする
  delayMicroseconds(2);                                         //2マイクロ秒ウェイト
  digitalWrite(TRIG_SOCKET , HIGH);                             //超音波トリガー信号をONさせる
  delayMicroseconds(10);                                        //10マイクロ秒ウェイト
  digitalWrite(TRIG_SOCKET , LOW);                              //超音波トリガー信号をOFFさせる

  DURATION = pulseIn(ECHO_SOCKET , HIGH);                       //エコー入力時間(マイクロ秒)を測定
  DURATION = DURATION / 2;                                      //往復時間を2で割って、片道時間に
  DISTANCE = DURATION * 340 * 100 / 1000000;                    //音速を掛けてcm単位にする
  DISTANCE = DISTANCE * 100;                                    //ディスプレイ表示用に12.34⇒1234に変換

  SEGNUM4 = DISTANCE / 1000;                                    //4桁目(DIG1)数字の抽出
  SEGNUM3 = (DISTANCE - SEGNUM4*1000) /100;                     //3桁目(DIG2)数字の抽出
  SEGNUM2 = (DISTANCE - SEGNUM4*1000 - SEGNUM3*100) / 10;       //2桁目(DIG3)数字の抽出
  SEGNUM1 = DISTANCE - SEGNUM4*1000 - SEGNUM3*100 - SEGNUM2*10; //1桁目(DIG4)数字の抽出
  
 for(int i = 1; i <= 4; i++){                   //1～4桁の数字表示を順番に出力する
  if(i == 1){                                   //1桁目(DIG4)の数字表示出力
    SEGNUM = SEGNUM1;                           //セグメント表示数字に1桁目数字を代入
    digitalWrite(SEG1_SOCKET , HIGH);           //4桁目(DIG1)表示OFF
    digitalWrite(SEG2_SOCKET , HIGH);           //3桁目(DIG2)表示OFF
    digitalWrite(SEG3_SOCKET , HIGH);           //2桁目(DIG3)表示OFF
    digitalWrite(SEG4_SOCKET , LOW);            //1桁目(DIG4)表示ON
    digitalWrite(SEGDP_SOCKET , LOW);
    
  }else if(i == 2){                             //2桁目(DIG3)の数字表示出力
    SEGNUM = SEGNUM2;                           //セグメント表示数字に2桁目数字を代入
    digitalWrite(SEG1_SOCKET , HIGH);           //4桁目(DIG1)表示OFF
    digitalWrite(SEG2_SOCKET , HIGH);           //3桁目(DIG2)表示OFF
    digitalWrite(SEG3_SOCKET , LOW);            //2桁目(DIG3)表示ON
    digitalWrite(SEG4_SOCKET , HIGH);           //1桁目(DIG4)表示OFF
    digitalWrite(SEGDP_SOCKET , LOW);
    
  }else if(i == 3){                             //3桁目(DIG2)の数字表示出力
    SEGNUM = SEGNUM3;                           //セグメント表示数字に3桁目数字を代入
    digitalWrite(SEG1_SOCKET , HIGH);           //4桁目(DIG1)表示OFF
    digitalWrite(SEG2_SOCKET , LOW);            //3桁目(DIG2)表示ON
    digitalWrite(SEG3_SOCKET , HIGH);           //2桁目(DIG3)表示OFF
    digitalWrite(SEG4_SOCKET , HIGH);           //1桁目(DIG4)表示OFF
    digitalWrite(SEGDP_SOCKET , HIGH);
    
  }else if(i == 4){                             //4桁目(DIG1)の数字表示出力
    SEGNUM = SEGNUM4;                           //セグメント表示数字に4桁目数字を代入
    digitalWrite(SEG1_SOCKET , LOW);            //4桁目(DIG1)表示ON
    digitalWrite(SEG2_SOCKET , HIGH);           //3桁目(DIG2)表示OFF
    digitalWrite(SEG3_SOCKET , HIGH);           //2桁目(DIG3)表示OFF
    digitalWrite(SEG4_SOCKET , HIGH);           //1桁目(DIG4)表示OFF
    digitalWrite(SEGDP_SOCKET , LOW);
  }

  if(SEGNUM == 0){                              //セグメントディスプレイ表示｢0｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , HIGH);          //セグメントDの出力をON
    digitalWrite(SEG_E_SOCKET , HIGH);          //セグメントEの出力をON
    digitalWrite(SEG_F_SOCKET , HIGH);          //セグメントFの出力をON
    digitalWrite(SEG_G_SOCKET , LOW);           //セグメントGの出力をOFF
  }
  else if(SEGNUM == 1){                         //セグメントディスプレイ表示｢1｣
    digitalWrite(SEG_A_SOCKET , LOW);           //セグメントAの出力をOFF
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , LOW);           //セグメントDの出力をOFF
    digitalWrite(SEG_E_SOCKET , LOW);           //セグメントEの出力をOFF
    digitalWrite(SEG_F_SOCKET , LOW);           //セグメントFの出力をOFF
    digitalWrite(SEG_G_SOCKET , LOW);           //セグメントGの出力をOFF
  }
  else if(SEGNUM == 2){                         //セグメントディスプレイ表示｢2｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , LOW);           //セグメントCの出力をOFF
    digitalWrite(SEG_D_SOCKET , HIGH);          //セグメントDの出力をON
    digitalWrite(SEG_E_SOCKET , HIGH);          //セグメントEの出力をON
    digitalWrite(SEG_F_SOCKET , LOW);           //セグメントFの出力をOFF
    digitalWrite(SEG_G_SOCKET , HIGH);          //セグメントGの出力をON
  }
  else if(SEGNUM == 3){                         //セグメントディスプレイ表示｢3｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , HIGH);          //セグメントDの出力をON
    digitalWrite(SEG_E_SOCKET , LOW);           //セグメントEの出力をOFF
    digitalWrite(SEG_F_SOCKET , LOW);           //セグメントFの出力をOFF
    digitalWrite(SEG_G_SOCKET , HIGH);          //セグメントGの出力をON
  }
  else if(SEGNUM == 4){                         //セグメントディスプレイ表示｢4｣
    digitalWrite(SEG_A_SOCKET , LOW);           //セグメントAの出力をOFF
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , LOW);           //セグメントDの出力をOFF
    digitalWrite(SEG_E_SOCKET , LOW);           //セグメントEの出力をOFF
    digitalWrite(SEG_F_SOCKET , HIGH);          //セグメントFの出力をON
    digitalWrite(SEG_G_SOCKET , HIGH);          //セグメントGの出力をON
  }
  else if(SEGNUM == 5){                         //セグメントディスプレイ表示｢5｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , LOW);           //セグメントBの出力をOFF
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , HIGH);          //セグメントDの出力をON
    digitalWrite(SEG_E_SOCKET , LOW);           //セグメントEの出力をOFF
    digitalWrite(SEG_F_SOCKET , HIGH);          //セグメントFの出力をON
    digitalWrite(SEG_G_SOCKET , HIGH);          //セグメントGの出力をON
  }
  else if(SEGNUM == 6){                         //セグメントディスプレイ表示｢6｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , LOW);           //セグメントBの出力をOFF
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , HIGH);          //セグメントDの出力をON
    digitalWrite(SEG_E_SOCKET , HIGH);          //セグメントEの出力をON
    digitalWrite(SEG_F_SOCKET , HIGH);          //セグメントFの出力をON
    digitalWrite(SEG_G_SOCKET , HIGH);          //セグメントGの出力をON
  }
  else if(SEGNUM == 7){                         //セグメントディスプレイ表示｢7｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , LOW);           //セグメントDの出力をOFF
    digitalWrite(SEG_E_SOCKET , LOW);           //セグメントEの出力をOFF
    digitalWrite(SEG_F_SOCKET , LOW);           //セグメントFの出力をOFF
    digitalWrite(SEG_G_SOCKET , LOW);           //セグメントGの出力をOFF
  }
  else if(SEGNUM == 8){                         //セグメントディスプレイ表示｢8｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , HIGH);          //セグメントDの出力をON
    digitalWrite(SEG_E_SOCKET , HIGH);          //セグメントEの出力をON
    digitalWrite(SEG_F_SOCKET , HIGH);          //セグメントFの出力をON
    digitalWrite(SEG_G_SOCKET , HIGH);          //セグメントGの出力をON
  }
  else if(SEGNUM == 9){                         //セグメントディスプレイ表示｢9｣
    digitalWrite(SEG_A_SOCKET , HIGH);          //セグメントAの出力をON
    digitalWrite(SEG_B_SOCKET , HIGH);          //セグメントBの出力をON
    digitalWrite(SEG_C_SOCKET , HIGH);          //セグメントCの出力をON
    digitalWrite(SEG_D_SOCKET , HIGH);          //セグメントDの出力をON
    digitalWrite(SEG_E_SOCKET , LOW);           //セグメントEの出力をOFF
    digitalWrite(SEG_F_SOCKET , HIGH);          //セグメントFの出力をON
    digitalWrite(SEG_G_SOCKET , HIGH);          //セグメントGの出力をON
  }
  delay(5);                                     //0.005秒ウェイト
}
}