/*
Copyright 2022, Savanni D'Gerinel <savanni@luminescent-dreams.com>

This file is part of Savanni's AVR library.

Lumeto is free software: you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation, either version 3 of the License, or (at your option) any later version.

Lumeto is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.

You should have received a copy of the GNU General Public License along with Lumeto. If not, see <https://www.gnu.org/licenses/>.
*/

#include "sk9822.h"

void send_byte(io_pin_t data_pin, io_pin_t clock_pin, uint8_t byte) {
    for (int i = 7; i >= 0; i--) {
        if (byte & _BV(i)) {
            (*data_pin.port) |= _BV(data_pin.pin);
        } else {
            (*data_pin.port) &= ~(_BV(data_pin.pin));
        }
        (*clock_pin.port) |= _BV(clock_pin.pin);
        (*clock_pin.port) &= ~(_BV(clock_pin.pin));
    }
}

void send_start(io_pin_t data_pin, io_pin_t clock_pin) {
    send_byte(data_pin, clock_pin, 0);
    send_byte(data_pin, clock_pin, 0);
    send_byte(data_pin, clock_pin, 0);
    send_byte(data_pin, clock_pin, 0);
}

void send_term(io_pin_t data_pin, io_pin_t clock_pin) {
    send_byte(data_pin, clock_pin, 0xff);
    send_byte(data_pin, clock_pin, 0xff);
    send_byte(data_pin, clock_pin, 0xff);
    send_byte(data_pin, clock_pin, 0xff);
}

void send_pixels(io_pin_t data_pin, io_pin_t clock_pin, rgb_t * pixels, uint8_t count) {
    send_start(data_pin, clock_pin);
    for (uint8_t i = 0; i < count; i++) {
        send_byte(data_pin, clock_pin, 0xe0 + pixels[i].brightness);
        send_byte(data_pin, clock_pin, pixels[i].r);
        send_byte(data_pin, clock_pin, pixels[i].b);
        send_byte(data_pin, clock_pin, pixels[i].g);
    }
    send_term(data_pin, clock_pin);
}