#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>

#include "Potenciometr.h"
#include "servo.h"
#include "Controller.h"


//Pot min 163
//Pot max 820

//L max - 113°
//L min - 86°

//P max - 113°
//P min - 86°

int main(void)

{
    sei();

    for(;;)
    {
        controller.L_handler();
        controller.R_handler();

        controller.send_debug();

        _delay_ms(20);
    }
}