Мигание светодиодов по частотам от кнопки

#include <avr/io.h>
 
#include <util/delay.h>
 
#include <avr/interrupt.h>
 
#define LED_PIN_MASK (1 << PD0) | (1 << PD1) | (1 << PD2)
 
#define BUTTON_PIN PB0
 
// Частота мигания в герцах
 
#define FREQ_1 0.2
 
#define FREQ_2 1.3
 
#define FREQ_3 3.0
 
volatile uint8_t mode = 0; // Переменная для хранения режима
 
void setup() {
 
    DDRD |= LED_PIN_MASK;    // Настроить LED_PIN_MASK как выход
 
    PORTD &= ~LED_PIN_MASK;  // Выключить светодиоды
 
    DDRB &= ~(1 << BUTTON_PIN);    // Настроить BUTTON_PIN как вход
 
    PORTB |= (1 << BUTTON_PIN);    // Включить подтягивающий резистор на кнопке
 
    // Настроить прерывание на CHANGE уровня для кнопки
 
    PCICR |= (1 << PCIE0);   // Enable pin change interrupt for PORTB
 
    PCMSK0 |= (1 << PCINT0); // Enable pin change interrupt for PB0
 
    sei();                   // Включить глобальные прерывания
 
}
 
ISR(PCINT0_vect) {
 
    if (!(PINB & (1 << BUTTON_PIN))) { // Проверка, нажата ли кнопка
 
        mode = (mode + 1) % 3;         // Переключение между режимами 0, 1 и 2
 
        _delay_ms(20);                 // Анти-дребезг
 
        while (!(PINB & (1 << BUTTON_PIN))); // Ждать отпускания кнопки
 
        _delay_ms(20);                 // Анти-дребезг
 
    }
 
}
 
void blink_leds(double frequency) {
 
    double period = 1 / frequency;
 
    PORTD ^= LED_PIN_MASK;  // Переключение состояния светодиодов
 
    _delay_ms(period * 500); // Задержка согласно периоду (в миллисекундах)
 
}
 
int main(void) {
 
    setup();
 
    while (1) {
 
        switch (mode) {
 
            case 0:
 
                blink_leds(FREQ_1);
 
                break;
 
            case 1:
 
                blink_leds(FREQ_2);
 
                break;
 
            case 2:
 
                blink_leds(FREQ_3);
 
                break;
 
        }
 
    }
 
    return 0;
 
}