#define PATTERN_END { 0, 0 }
pattern_t off_pattern[] = {
- { 0, 5 },
+ { 0, 0x1F },
PATTERN_END
};
PATTERN_END
};
+pattern_t mode1_pattern[] = {
+ { 1, 0x1 },
+ { 0, 0x1 },
+ { 4, 0x1 },
+ { 0, 0x1 },
+ { 1, 0x1 },
+ PATTERN_END
+};
+
pattern_t boot_pattern[] = {
{ 1, 0x6 },
{ 0, 0x6 },
};
pattern_t pattern_num[] = {
- { 1, 0x1 },
+ { 1, 0x1 }, /* 10 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 9 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 8 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 7 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 6 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 5 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 4 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 3 */
{ 0, 0x4 },
- { 1, 0x1 },
+ { 1, 0x1 }, /* 2 */
+ { 0, 0x4 },
+ { 1, 0x1 }, /* 1 */
{ 0, 0x1F },
PATTERN_END
};
+static unsigned char test_running;
+
void pattern_init()
{
unsigned char i;
led_patterns[N_PWMLEDS] = boot_pattern;
led_counters[N_PWMLEDS] = boot_pattern->duration;
gpio_set(GPIO_LED2, 1);
+ test_running = 0;
}
static inline pattern_t *pattern_select(unsigned char n)
{
+ if (n < N_PWMLEDS && !pwmled_enabled(n))
+ return off_pattern; // Don't mess with non-enabled LEDs
+
+ if (n == 2) {
+ if (test_running) {
+ log_byte(0xF7);
+ log_flush();
+ return off_pattern;
+ } else {
+ test_running = 1;
+ log_byte(0xF6);
+ return mode1_pattern;
+ }
+ }
return pattern_num + sizeof(pattern_num)/sizeof(pattern_t)
- - 1 - 2*(1+ambient_zone);;
+ - 1 - 2*(1+ambient_zone);
}
-static void inline led_off(unsigned char n)
+static void led_set_mode(unsigned char n, unsigned char mode)
{
- if (n == N_PWMLEDS) {
- gpio_set(GPIO_LED2, 0);
+ if (n < N_PWMLEDS) {
+ pwmled_set_mode(n, mode);
+ } else if (n == N_PWMLEDS) {
+ gpio_set(GPIO_LED2, mode);
}
+ // TODO LED 1
}
static void inline led_set_level(unsigned char n, unsigned char level)
led_patterns[i] = pattern_select(i);
}
led_counters[i] = led_patterns[i]->duration;
- if (led_patterns[i]->mode == 0) {
- led_off(i);
- } else {
- led_set_level(i, led_patterns[i]->mode - 1);
- }
+ led_set_mode(i, led_patterns[i]->mode);
}
led_counters[i]--;