#include <avr/io.h>
#include <stdbool.h>

#include "debounce.h"
#include "calc.h"
#include "iopins.h"

/** Debounce data array */
uint8_t debo_next_slot = 0;

/** bit - range 0-63 */
uint8_t debo_register(PORT_P reg, uint8_t bit, bool invert, DebouncerCallback callback)
{
	debo_slots[debo_next_slot] = (debo_slot_t) {
		.reg = reg,
		.bit = bit | ((invert & 1) << 7) | (get_bit_p(reg, bit) << 6), // bit 7 = invert, bit 6 = state
		.count = 0,
		.callback = callback,
	};

	return debo_next_slot++;
}

/** Check debounced pins, should be called periodically. */
void debo_tick(void)
{
	for (uint8_t i = 0; i < debo_next_slot; i++) {
		// current pin value
		bool value = get_bit_p(debo_slots[i].reg, debo_slots[i].bit & 0x3F)
					 ^get_bit(debo_slots[i].bit, 7);

		if (value != get_bit(debo_slots[i].bit, 6)) {
			// different pin state than last recorded state
			if (debo_slots[i].count < DEBO_TICKS) {
				debo_slots[i].count++;
			} else {
				// overflown -> latch value
				set_bit(debo_slots[i].bit, 6, value); // set state bit
				debo_slots[i].count = 0;
				// Fire the callback, if not NULL
				if (debo_slots[i].callback) {
					debo_slots[i].callback(i, value);
				}
			}
		} else {
			debo_slots[i].count = 0; // reset the counter
		}
	}
}