Frecuencimetro

/*
Antonio Villanueva Segura F4LEC
Frecuencimetro Chino
Utiliza la CPU Atmel48P y normalmentes el preescaler MB501
con un ratio 1:64 , en mi caso el fabricante Chino habia utilizado
el MB505 con un ratio 1:128 por lo que la frecuencia leida era la mitad
es por eso que me decidi a escribir este codigo
PC0(ADC0)23 ->RS
PC1(ADC1)24 ->EN
PC2(ADC2)25 ->D4
PC3(ADC3)26 ->D6
PC4(ADC4/SDA) 27 ->D7
PC5(ADC5/SCL) 28 ->D5
LCD, 2 lignes * 8, 0802A

Estos pines los utilizo para ajustar el error de medidas
cuando los cortocircuitamos espera que se le introduzca la frecuencia
de referencia en mi caso ajusto con estas frecuencias

PD1(3) -> JP1 7Mhz
PD2(4) -> JP2 14Mhz
PD3(5) -> JP3 28Mhz


*/

#include <EEPROM.h>
#include <Arduino.h>
#include <LiquidCrystal.h>

#define F_CPU 20000000UL  // Frecuencia del cristal: 20 MHz
#define PRESCALER 1024
#define OCR1A_VALUE 19531  // (F_CPU / PRESCALER) - 1

#define MB505_PIN PD5      // Pin donde llega la señal del MB505 (Pin 11)
#define MB505_PORT PIND    // Puerto donde está el pin del MB505
#define MB505_BIT  5       // Bit del pin del MB505 en el puerto

#define JP1
#define JP2
#define JP3

// LCD 802A paralelo  pins
#define LCD_RS_PIN   A0  // PC0
#define LCD_EN_PIN   A1  // PC1
#define LCD_D4_PIN   A2  // PC2
#define LCD_D5_PIN   A5  // PC5
#define LCD_D6_PIN   A3  // PC3
#define LCD_D7_PIN   A4  // PC4

// LiquidCrystal object
LiquidCrystal lcd(LCD_RS_PIN, LCD_EN_PIN, LCD_D4_PIN, LCD_D5_PIN, LCD_D6_PIN, LCD_D7_PIN);

volatile uint32_t pulse_count = 0;
volatile bool timer_flag = false;
float frequency_MHz = 0.0; //Frecuencia Mhz
float offset_freq =1.0 ;//Correccion de error de Medida

// Interrupción por cambio de estado en el pin PD5
ISR(PCINT2_vect) {
  if (PIND & (1 << PD5)) {
    // Flanco ascendente
    pulse_count++;
  }
}

// Interrupción del Timer1 Compare Match A
ISR(TIMER1_COMPA_vect) {
  timer_flag = true;
}


float correccion_frecuencia(float fref ,float freq){
    /*factor_correccion = frecuencia_real / frecuencia_medida
    frecuencia_compensada = frecuencia_medida * factor_correccion
    factor_correccion =7.000000 /6.931456=1.009888831
    frecuencia compensada =frecuencia medida *factor correccion=
    */
    return fref/freq;
}
/*
// Función para escribir un float en la EEPROM
void writeFloatToEEPROM(int address, float value) {
  if (value <=0 || value>2.1){value =1.0;}
  byte* p = (byte*)(void*)&value;
  for (int i = 0; i < sizeof(float); i++) {
    EEPROM.write(address + i, *p++);
  }
}

// Función para leer un float de la EEPROM
float readFloatFromEEPROM(int address) {
  float value;
  byte* p = (byte*)(void*)&value;
  for (int i = 0; i < sizeof(float); i++) {
    *p++ = EEPROM.read(address + i);
  }
  if (value <=0 || value>2.1){return 1.0;}
  return value;
}
*/
void setup() {

  // Configurar JP1(PD1),JP2(PD2),JP3(PD3)   como entradas
  DDRD &= ~((1 << DDD1) | (1 << DDD2) | (1 << DDD3));
  // Habilitar resistencias pull-up internas
  PORTD |= ((1 << PORTD1) | (1 << PORTD2) | (1 << PORTD3));

  //Leer EPROM factor offset
  //offset_freq=readFloatFromEEPROM(0 );

  // Configurar LCD
  lcd.begin(8, 2);
  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print(" F4LEC");
  delay(3000);
  lcd.clear();


  // Configurar PD5 (MB505_PIN) como entrada
  DDRD &= ~(1 << MB505_PIN);

  // Habilitar interrupciones por cambio de estado en el grupo de pines donde está PD5
  PCICR |= (1 << PCIE2);   // Habilitar PCIE2 (para PD0-PD7)
  PCMSK2 |= (1 << PCINT5); // Habilitar interrupción para el pin PD5

  // Configurar Timer1
  cli();
  TCCR1A = 0;
  TCCR1B = 0;
  TCCR1B |= (1 << WGM12);
  OCR1A = OCR1A_VALUE;
  TCCR1B |= (1 << CS10) | (1 << CS12);
  TIMSK1 |= (1 << OCIE1A);
  sei();
}

void loop() {

  // Leer JP1 ,JP2,JP3 para ajustar frecuencia
  uint8_t jp1 = (PIND & (1 << PIND1)) >> PIND1;
  //uint8_t jp2 = (PIND & (1 << PIND2)) >> PIND2;
  //uint8_t jp3 = (PIND & (1 << PIND3)) >> PIND3;


  if (timer_flag) {
    timer_flag = false;

    // Calcular la frecuencia en MHz
    frequency_MHz = (float)pulse_count * 128.0 / 1000000.0; // * 128 por el divisor del MB505, / 1000000 para MHz

    //Si el JP de correccion esta activado crea la correccion
    if (jp1 == 0) { offset_freq = correccion_frecuencia(10.0 ,frequency_MHz);}

    if (jp1==0){

         lcd.clear();
         lcd.setCursor(0, 0);
         lcd.print("Adjust !");
         delay(1000);

         //writeFloatToEEPROM(0,offset_freq );

    }

    frequency_MHz *=offset_freq;//Correccion frecuencia


    //frequency_MHz *=1.009888831;
    // Mostrar la frecuencia en el LCD 802a
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print(frequency_MHz, 8); // Mostrar hasta 8 decimales
    lcd.setCursor(0, 1);
    lcd.print("MHz");

    pulse_count = 0; // Reiniciar el contador de pulsos
  }
}