You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
50 lines
1.2 KiB
50 lines
1.2 KiB
8 years ago
|
#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
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|