70 lines
1.4 KiB
C
70 lines
1.4 KiB
C
#include <stdint.h>
|
|
|
|
#include "config.h"
|
|
#include "twinkl.h"
|
|
|
|
|
|
uint8_t twinkl_channels[TWINKL_LEVEL_COUNT][TWINKL_CHANNEL_COUNT];
|
|
uint8_t twinkl_masks[TWINKL_LEVEL_COUNT][TWINKL_MASK_BYTES];
|
|
|
|
uint8_t twinkl_has_changed;
|
|
|
|
|
|
void twinkl_init() {
|
|
memset(twinkl_channels, 0, TWINKL_LEVEL_COUNT * TWINKL_CHANNEL_COUNT);
|
|
memset(twinkl_masks, 0, TWINKL_LEVEL_COUNT * TWINKL_MASK_BYTES);
|
|
|
|
twinkl_has_changed = 0;
|
|
}
|
|
|
|
|
|
void twinkl_process_message(struct twinkl_message *msg) {
|
|
if(msg->priority < TWINKL_LEVEL_COUNT) {
|
|
memcpy(twinkl_channels[msg->priority], msg->values, TWINKL_CHANNEL_COUNT);
|
|
memcpy(twinkl_masks[msg->priority], msg->mask, TWINKL_MASK_BYTES);
|
|
|
|
twinkl_has_changed = 1;
|
|
}
|
|
}
|
|
|
|
|
|
uint8_t twinkl_has_changes() {
|
|
return twinkl_has_changed;
|
|
}
|
|
|
|
|
|
uint8_t get_mask_bit(uint8_t level, uint16_t channel) {
|
|
if(level >= TWINKL_LEVEL_COUNT && channel >= TWINKL_CHANNEL_COUNT) {
|
|
return 0;
|
|
}
|
|
|
|
uint16_t byte = channel / 8;
|
|
uint8_t bit = channel % 8;
|
|
|
|
if((twinkl_masks[level][byte] & (1 << bit)) != 0) {
|
|
return 1;
|
|
}
|
|
else {
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
void twinkl_render(uint8_t *channels) {
|
|
uint16_t chan;
|
|
uint8_t level;
|
|
|
|
for(chan = 0; chan < TWINKL_CHANNEL_COUNT; chan++) {
|
|
channels[chan] = 0;
|
|
for(level = 0; level < TWINKL_LEVEL_COUNT; level++) {
|
|
if(get_mask_bit(level,chan)) {
|
|
channels[chan] = twinkl_channels[level][chan];
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
twinkl_has_changed = 0;
|
|
}
|
|
|