#include <avr/io.h>
#include <avr/interrupt.h>
#include <stdint.h>
#include "led_driver.h"
#include "system_ticker.h"
#include "status_leds.h"

// timer1 setup
// // set prescaler to 8 for a PWM frequency of about 1kHz (F_CPU = 8000000)
// TCCR1B &= ~(_BV(CS12) | _BV(CS10));
// TCCR1B |= _BV(CS11);
// // set WGM mode 7: FAST PWM 10bit
// TCCR1B &= ~_BV(WGM13);
// TCCR1B |= _BV(WGM12);
// TCCR1A |= (_BV(WGM11) | _BV(WGM10));
// // connect OC1A (PB3) to the PWM generator (wired to the /ENABLE pin of the led driver)
// TCCR1A |= _BV(COM1A1);
// TCCR1A &= ~_BV(COM1A0);

// default value of TCCR1A: 00000000
#define TCCR1A_val ( _BV(WGM11) + _BV(WGM10) + _BV(COM1A1) )
// default value of TCCR1B: 00000000
#define TCCR1B_val ( _BV(CS11) + _BV(WGM12) )

void led_driver_setup(void)
{
    OCR1A = OCR1A_MAX;      // set compare match value for TCNT1 - 100% duty cycle - all off

    TCCR1A = _BV(COM1A0);   // toggle OC1A on compare match to prevent a FLASHING of the leds after reset
    TCCR1C = _BV(FOC1A);    // force a compare match to flip OC1A from 0 (after reset) to 1

    TCCR1A = TCCR1A_val;    // doing it this way saves flash space ;-)
    TCCR1B = TCCR1B_val;

    DDRB |= _BV(PB3);       // make OC1A (PB3) an output at the very end, or the LEDs flash briefly
}

void fade_in(uint16_t start_at, uint16_t fade_delay)
{
    S_LED_ON;

    uint16_t ctr1;
    for (ctr1 = start_at; (ctr1 > 0); ctr1--) {
        OCR1A = ctr1;
        delay(fade_delay);
    }
}

void fade_out(uint16_t start_at, uint16_t fade_delay)
{
    S_LED_OFF;

    uint16_t ctr1;
    for (ctr1 = start_at; ctr1 <= OCR1A_MAX; ctr1++) {
        OCR1A = ctr1;
        delay(fade_delay);
    }
}

void up(uint16_t fade_delay)
{
    S_LED_ON;

    if (OCR1A > (0 + MANUAL_FADE_STEPSIZE)) {
        OCR1A = OCR1A - MANUAL_FADE_STEPSIZE;
    } else {
        OCR1A = 0;
    }

    delay(fade_delay); // manually fading in
}

void down(uint16_t fade_delay)
{
    S_LED_OFF;

    if (OCR1A < (OCR1A_MAX - MANUAL_FADE_STEPSIZE)) {
        OCR1A = OCR1A + MANUAL_FADE_STEPSIZE;
    } else {
        OCR1A = OCR1A_MAX;
    }

    delay(fade_delay); // manually fading out
}

uint16_t get_brightness(void)
{
    return OCR1A;
}