#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <Keypad.h>

LiquidCrystal_I2C lcd(0x27, 16, 2);

const byte ROWS = 4;
const byte COLS = 4;
char keys[ROWS][COLS] = {
  {'1','2','3','A'},
  {'4','5','6','B'},
  {'7','8','9','C'},
  {'*','0','#','D'}
};
byte rowPins[ROWS] = {1, 2, 3, 4};
byte colPins[COLS] = {5, 6, 7, 8};
Keypad keypad = Keypad(makeKeymap(keys), rowPins, colPins, ROWS, COLS);

const int trigPin = 10;
const int echoPin = 11;

int distanceCible = 50;
int angleLancement = 45;
int vitesseInitiale = 20;

void setup() {
  Serial.begin(9600);
  lcd.begin(16, 2);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
}

void loop() {
  jouerLancerDeProjectile();
}

void afficherInterfaceUtilisateur() {
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Distance Cible:");
  lcd.setCursor(0, 1);
  lcd.print(distanceCible);
  delay(2000);
}

void configurerDistanceCible() {
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Config. Distance");
  lcd.setCursor(0, 1);
  lcd.print("Utilisez le clavier");
  delay(2000);

  char key = keypad.getKey();
  while (key != '#') {
    if (key >= '0' && key <= '9') {
      distanceCible = distanceCible * 10 + (key - '0');
      lcd.setCursor(0, 1);
      lcd.print(distanceCible);
    }
    key = keypad.getKey();
  }
}

void ajusterAngleEtVitesse() {
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Ajuster Tir");
  lcd.setCursor(0, 1);
  lcd.print("Angl/Vitesse:");
  delay(2000);

  char key = keypad.getKey();
  while (key != '#') {
    if (key == 'A') {
      angleLancement++;
      lcd.setCursor(12, 1);
      lcd.print(angleLancement);
    } else if (key == 'B') {
      angleLancement--;
      lcd.setCursor(12, 1);
      lcd.print(angleLancement);
    } else if (key == 'C') {
      vitesseInitiale++;
      lcd.setCursor(12, 1);
      lcd.print(vitesseInitiale);
    } else if (key == 'D') {
      vitesseInitiale--;
      lcd.setCursor(12, 1);
      lcd.print(vitesseInitiale);
    }
    key = keypad.getKey();
  }
}

int lancerProjectile() {
  const float g = 9.81;  // Accélération due à la gravité en m/s^2
  const float radianConversion = 0.0174533;  // Conversion d'angle de degrés à radians

  float angleRad = angleLancement * radianConversion;  // Conversion degrés en radians
  float vitesseX = vitesseInitiale * cos(angleRad);  // Composante horizontale de la vitesse initiale
  float vitesseY = vitesseInitiale * sin(angleRad);  // Composante verticale de la vitesse initiale

  float tempsVol = (2 * vitesseY) / g;  // Calcul du temps de vol
  float distanceSimulee = vitesseX * tempsVol;  // Calcul de la distance simulée

  // Simuler la mesure de la distance réelle avec le capteur de distance
  int distanceReelle = distanceCible + random(-5, 5);

  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Lancement...");
  delay(2000);

  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Vol termine");
  delay(1000);

  return distanceReelle;
}

void afficherResultats(int distanceReelle) {
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Resultats:");
  lcd.setCursor(0, 1);
  lcd.print("Distance: ");
  lcd.print(distanceReelle);
  delay(5000);
}
void jouerLancerDeProjectile() {
  afficherInterfaceUtilisateur();
  configurerDistanceCible();
  ajusterAngleEtVitesse();
  int distanceReelle = lancerProjectile();
  afficherResultats(distanceReelle);
}