void delay_and_flash_100ms(uint8_t ms_100)
{
bool green_status = ISSET_LED_GREEN();
bool red_status = ISSET_LED_RED();
bool yellow_status = ISSET_LED_YELLOW();
while(ms_100--) {
all_leds_on();
_delay_ms(50);
all_leds_off();
_delay_ms(50);
}
if(green_status) {
SET_LED_GREEN();
}
if(red_status) {
SET_LED_RED();
}
if(yellow_status) {
SET_LED_YELLOW();
}
}
void select_led(int led) {
all_leds_off();
switch (led) {
case 0:
palSetPad(GPIOE, GPIOE_PIN7);
break;
case 1:
palSetPad(GPIOE, GPIOE_PIN9);
break;
case 2:
palSetPad(GPIOE, GPIOE_PIN11);
break;
case 3:
palSetPad(GPIOE, GPIOE_PIN13);
break;
case 4:
palSetPad(GPIOE, GPIOE_PIN15);
break;
case 5:
palSetPad(GPIOB, GPIOB_PIN11);
break;
case 6:
palSetPad(GPIOB, GPIOB_PIN13);
break;
case 7:
palSetPad(GPIOB, GPIOB_PIN15);
break;
case 8:
palSetPad(GPIOE, GPIOE_PIN12);
break;
case 9:
palSetPad(GPIOE, GPIOE_PIN10);
break;
case 10:
palSetPad(GPIOE, GPIOE_PIN8);
break;
case 11:
palSetPad(GPIOB, GPIOB_PIN2);
break;
case 12:
palSetPad(GPIOB, GPIOB_PIN0);
break;
case 13:
palSetPad(GPIOC, GPIOC_PIN4);
break;
case 14:
palSetPad(GPIOB, GPIOB_PIN1);
break;
case 15:
palSetPad(GPIOC, GPIOC_PIN5);
break;
}
};
void led_init(void) {
all_leds_init();
all_leds_off();
};
