38 lines
613 B
C
38 lines
613 B
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#if 0
|
|
#include <libopencm3/stm32/gpio.h>
|
|
#endif
|
|
|
|
#include <console.h>
|
|
#include <led.h>
|
|
|
|
extern struct led leds[];
|
|
extern size_t nleds;
|
|
|
|
int shell_led(struct console *con, size_t argc, const char **argv)
|
|
{
|
|
size_t led_id = 0;
|
|
int state = 0;
|
|
|
|
if (argc >= 2)
|
|
state = (strcmp(argv[1], "on") == 0);
|
|
|
|
if (argc >= 1)
|
|
led_id = strtoul(argv[0], NULL, 0);
|
|
|
|
if (led_id >= nleds) {
|
|
fprintf(con->fp, "error: unknown LED ID %d\n", led_id);
|
|
return -1;
|
|
}
|
|
|
|
if (state) {
|
|
led_enable(leds + led_id);
|
|
} else {
|
|
led_disable(leds + led_id);
|
|
}
|
|
|
|
return 0;
|
|
}
|