COMMAND_T cmd_led = {
.command = "led",
.function = func_led,
.next = &cmd_beep
};
void func_led(void)
{
char tab[12];
unsigned char i = 0;
char *p = buffer;
while((*p != ' ')&&(*p != '\r'))p ++;
if(*p == '\r')goto LOOP1;
while(*(++p) == '-')i++;
if( i != 2)goto LOOP1;
i = 0;
while(*p != '\r')
{
if( i > 10)goto LOOP1;
tab[i++] = *p++;
}
tab[i] = '\0';
if(strcmp(tab,"on") == 0){
led_flag = 3;
goto LOOP;
}
if(strcmp(tab,"flash high") == 0){
led_flag = 2;
goto LOOP;
}
if(strcmp(tab,"flash low") == 0){
led_flag = 1;
goto LOOP;
}
if(strcmp(tab,"off") == 0){
led_flag =0;
goto LOOP;
}
goto LOOP1;
LOOP: uart.printf("\r\n\033[1;35;40mLED is %s\r\n",tab);
return;
LOOP1: uart.printf("\r\n\033[1;31;40mBad command!\r\n");
}