int TRIGER_PIN = 3;
int ECHO_PIN = 2;

int A = 10;
int B = 6;
int C = 5;
int D = 12;
int E = 11;
int F = 9;
int G = 4;

int DIG1 = 13;
int DIG2 = 8;
int DIG3 = 7;



void setup() {
  pinMode(TRIGER_PIN, OUTPUT); //TRIG
  pinMode(ECHO_PIN, INPUT); //ECHO

  pinMode(A, OUTPUT); 
  pinMode(B, OUTPUT); 
  pinMode(C, OUTPUT); 
  pinMode(D, OUTPUT); 
  pinMode(E, OUTPUT); 
  pinMode(F, OUTPUT); 
  pinMode(G, OUTPUT); 
  pinMode(DIG1, OUTPUT); 
  pinMode(DIG2, OUTPUT); 
  pinMode(DIG3, OUTPUT); 
}

void loop() {
  //Read Ultrasonic input
  int time = 0;
  int cm = 0;
  digitalWrite(TRIGER_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGER_PIN, LOW);

  time = pulseIn(ECHO_PIN, HIGH);
  cm = time * 0.028;
  printf(cm);

  //Seven Segment
  int numberTable[10][7] = {
  /*0*/{1,1,1,1,1,1,0}, //A,B,C,D,E,F,G
  /*1*/{0,1,1,0,0,0,0}, //A,B,C,D,E,F,G
  /*2*/{1,1,0,1,1,0,1}, //A,B,C,D,E,F,G
  /*3*/{1,1,1,1,0,0,1}, //A,B,C,D,E,F,G
  /*4*/{0,1,1,0,0,1,1}, //A,B,C,D,E,F,G
  /*5*/{1,0,1,1,0,1,1}, //A,B,C,D,E,F,G
  /*6*/{1,0,1,1,1,1,1}, //A,B,C,D,E,F,G
  /*7*/{1,1,1,0,0,0,0}, //A,B,C,D,E,F,G
  /*8*/{1,1,1,1,1,1,1}, //A,B,C,D,E,F,G
  /*9*/{1,1,1,1,0,1,1} //A,B,C,D,E,F,G
  };

  cm = 123;
  int number = cm;
  for (int i = 0; i < 4; i++){
    digitalWrite(DIG1, i != 2); //Low h h
    digitalWrite(DIG2, i != 1); //hlh
    digitalWrite(DIG3, i != 0); //hhl

    digitalWrite(A,numberTable[number % 10][0]);
    digitalWrite(B,numberTable[number % 10][1]);
    digitalWrite(C,numberTable[number % 10][2]);
    digitalWrite(D,numberTable[number % 10][3]);
    digitalWrite(E,numberTable[number % 10][4]);
    digitalWrite(F,numberTable[number % 10][5]);
    digitalWrite(G,numberTable[number % 10][6]);
    number = number / 10;
  }




  delay(50);
}