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

#define pinoCLK 7
#define pinoDT 6

LiquidCrystal_I2C lcd(0x27, 16, 2);

float contador = 0;
int estadoAtualCLK;
int estadoAnteriorCLK;
unsigned long lastRotationTime = 0;

String encdir = "";

void setup () 
{
  pinMode (pinoCLK, INPUT);
  pinMode (pinoDT, INPUT);
  
  estadoAnteriorCLK = digitalRead(pinoCLK);

  lcd.init();
  lcd.setBacklight(HIGH);
}

void loop()
{
  estadoAtualCLK = digitalRead(pinoCLK);

  if (estadoAtualCLK != estadoAnteriorCLK)
  {

    if (digitalRead(pinoDT) != estadoAtualCLK) 
    {
      contador -=0.5;
      encdir = "HOR";
    }
    else 
    {
      contador +=0.5;
      encdir = "ANTH";
    }
    
    unsigned long currentTime = millis(); // Get the current time in milliseconds

    // Calculate the time elapsed since the last full rotation
    unsigned long rotationTime = currentTime - lastRotationTime;

    // Calculate speed in rotations per minute (RPM)
    float rpm = 60000.0 / rotationTime;

    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("Valor: ");
    lcd.print(contador, 1); // Display value with one decimal place

    lcd.setCursor(0, 1);
    lcd.print("Speed (RPM): ");
    lcd.print(rpm, 2); // Display speed with two decimal places

    lastRotationTime = currentTime; // Update the last rotation time
  }
  estadoAnteriorCLK = estadoAtualCLK;
}