di0ib
/
tmk_keyboard_custom
Watch 1
Star 0
Fork 0
Code Releases 0 Activity
Browse Source

Modify softpwm_led to support custom callback function

old_master
Kai Ryu 9 years ago
parent
df51c6b5ba
commit
90f6167e78
2 changed files with 67 additions and 41 deletions
Split View Show Diff Stats
  1. 61
    41
      common/softpwm_led.c
  2. 6
    0
      common/softpwm_led.h

+ 61
- 41
common/softpwm_led.c View File

@@ -12,6 +12,18 @@ static uint8_t softpwm_led_state = 0;
static uint8_t softpwm_led_ocr[LED_COUNT] = {0};
static uint8_t softpwm_led_ocr_buff[LED_COUNT] = {0};

#ifdef FADING_LED_ENABLE
static void fading_led_proc(void);
#else
#define fading_led_proc()
#endif

#ifdef BREATHING_LED_ENABLE
static void breathing_led_proc(void);
#else
#define fading_led_proc()
#endif

void softpwm_init(void)
{
#ifdef SOFTPWM_LED_TIMER3
@@ -266,63 +278,71 @@ ISR(TIMER1_COMPA_vect)
}
}

#if defined(FADING_LED_ENABLE) || defined(BREATHING_LED_ENABLE) || defined(CUSTOM_LED_ENABLE)
static uint8_t counter = 0;
if (++counter >= SOFTPWM_LED_FREQ) {
counter = 0;
fading_led_proc();
breathing_led_proc();
custom_led_proc();
}
#endif
}

#ifdef FADING_LED_ENABLE
static uint8_t fading_led_counter = 0;
static uint8_t fading_led_step = 0;
void fading_led_proc(void)
{
static uint8_t step = 0;
if (fading_led_state) {
if (++fading_led_counter > SOFTPWM_LED_FREQ) {
fading_led_counter = 0;
if (++fading_led_step > fading_led_duration) {
fading_led_step = 0;
for (uint8_t i = 0; i < LED_COUNT; i++) {
if (fading_led_state & LED_BIT(i)) {
if (fading_led_direction) {
softpwm_led_decrease(i, 1);
}
else {
softpwm_led_increase(i, 1);
}
if (++step > fading_led_duration) {
step = 0;
for (uint8_t i = 0; i < LED_COUNT; i++) {
if (fading_led_state & LED_BIT(i)) {
if (fading_led_direction) {
softpwm_led_decrease(i, 1);
}
else {
softpwm_led_increase(i, 1);
}
}
}
}
}
}
#endif

#ifdef BREATHING_LED_ENABLE
static uint8_t breathing_led_counter = 0;
static uint8_t breathing_led_step = 0;
static uint8_t breathing_led_index = 0;
static uint8_t breathing_led_direction = 0;
void breathing_led_proc(void)
{
static uint8_t step = 0;
static uint8_t index = 0;
static uint8_t direction = 0;
if (breathing_led_state) {
if (++breathing_led_counter > SOFTPWM_LED_FREQ) {
breathing_led_counter = 0;
if (++breathing_led_step > breathing_led_duration) {
breathing_led_step = 0;
uint8_t value = pgm_read_byte(&breathing_table[breathing_led_index]);
for (uint8_t i = 0; i < LED_COUNT; i++) {
if (breathing_led_state & LED_BIT(i)) {
softpwm_led_ocr_buff[i] = value;
}
if (++step > breathing_led_duration) {
step = 0;
uint8_t value = pgm_read_byte(&breathing_table[index]);
for (uint8_t i = 0; i < LED_COUNT; i++) {
if (breathing_led_state & LED_BIT(i)) {
softpwm_led_ocr_buff[i] = value;
}
if (breathing_led_direction) {
if (breathing_led_index == 0) {
breathing_led_direction = 0;
}
else {
breathing_led_index--;
}
}
if (direction) {
if (index == 0) {
direction = 0;
}
else {
if (breathing_led_index == 0x7F) {
breathing_led_direction = 1;
}
else {
breathing_led_index++;
}
index--;
}
}
else {
if (index == 0x7F) {
direction = 1;
}
else {
index++;
}
}
}
}
#endif
}
#endif

+ 6
- 0
common/softpwm_led.h View File

@@ -69,6 +69,12 @@ void breathing_led_set_duration(uint8_t dur);
#define breathing_led_set_duration_all()
#endif

#ifdef CUSTOM_LED_ENABLE
void custom_led_proc(void);
#else
#define custom_led_proc()
#endif

#else

#define softpwm_init()