#include <LiquidCrystal_I2C.h>
#include <Wire.h>
int trigPin = 11;  
int echoPin = 10; 
float duration, distance;
LiquidCrystal_I2C lcd(0x27, 16, 2);
byte ZERO[] = {
  B00000,
  B00000,
  B00000,
  B00000,
  B00000,
  B00000,
  B00000,
  B00000,
};
byte ONE[] = {
  B10000,
  B10000,
  B10000,
  B10000,
  B10000,
  B10000,
  B10000,
  B10000
};
byte TWO[] = {
  B11000,
  B11000,
  B11000,
  B11000,
  B11000,
  B11000,
  B11000,
  B11000,
};
byte THREE[] = {
  B11100,
  B11100,
  B11100,
  B11100,
  B11100,
  B11100,
  B11100,
  B11100,
};
byte FOUR[] = {
  B11110,
  B11110,
  B11110,
  B11110,
  B11110,
  B11110,
  B11110,
  B11110,
};
byte FIVE[] = {
  B11111,
  B11111,
  B11111,
  B11111,
  B11111,
  B11111,
  B11111,
  B11111
};
void setup() {
  pinMode(trigPin, OUTPUT);  
	pinMode(echoPin, INPUT);  
	Serial.begin(9600); 
  lcd.init();
  lcd.backlight();
  lcd.createChar(0, ZERO);
  lcd.createChar(1, ONE);
  lcd.createChar(2, TWO);
  lcd.createChar(3, THREE);
  lcd.createChar(4, FOUR);
  lcd.createChar(5, FIVE);
}

void loop() {
   digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);
  distance = (duration*.0343)/2;
  Serial.print("Distance: ");
  Serial.println(distance);
  delay(100);
    int printVal = map(distance, 0, 402, 0, 80); // Map analog value to 0-80 range
  int A= printVal / 5;  
  int B= printVal % 5; 
  lcd.setCursor(0, 0); 
  for (int i = 0; i < A; i++) {
    lcd.write(5); 
  }
  if (A < 16) {
    lcd.write(B); 
    for (int i = A + 1; i < 16; i++) {
      lcd.write(0); 
  }


}
}