More GPIO control through CLI (#1271)
* Add more options * Change from one big command to three small commands These changes follow from the review. Instead of having to rely in GOTOs (which are forbidden :<( ) to ensure cleaning, I divided in smaller pieces. Since I had no feedback w.r.t the previously existing `gpio_set`, this fits more with the current implementation. I also tried to interpret "That's not how we do enums" as to not include a `enum EnumName` decl. when using typedefs. I also distanced the implementation from using LL_GPIO in favour of functions provided in `<furi_hal_gpio.h>` but there was nothing to get the mode, so I stuck with LL_GPIO for mode check. Co-authored-by: あく <alleteam@gmail.com>
This commit is contained in:
parent
9c9f66a30f
commit
2bd4efd044
@ -248,99 +248,183 @@ void cli_command_led(Cli* cli, string_t args, void* context) {
|
|||||||
furi_record_close("notification");
|
furi_record_close("notification");
|
||||||
}
|
}
|
||||||
|
|
||||||
void cli_command_gpio_set(Cli* cli, string_t args, void* context) {
|
char pin_names[][4] = {
|
||||||
UNUSED(context);
|
"PC0",
|
||||||
char pin_names[][4] = {
|
"PC1",
|
||||||
"PC0",
|
"PC3",
|
||||||
"PC1",
|
"PB2",
|
||||||
"PC3",
|
"PB3",
|
||||||
"PB2",
|
"PA4",
|
||||||
"PB3",
|
"PA6",
|
||||||
"PA4",
|
"PA7",
|
||||||
"PA6",
|
|
||||||
"PA7",
|
|
||||||
#ifdef FURI_DEBUG
|
#ifdef FURI_DEBUG
|
||||||
"PA0",
|
"PA0",
|
||||||
"PB7",
|
"PB7",
|
||||||
"PB8",
|
"PB8",
|
||||||
"PB9"
|
"PB9"
|
||||||
#endif
|
#endif
|
||||||
};
|
};
|
||||||
GpioPin gpio[] = {
|
GpioPin gpio[] = {
|
||||||
{.port = GPIOC, .pin = LL_GPIO_PIN_0},
|
{.port = GPIOC, .pin = LL_GPIO_PIN_0},
|
||||||
{.port = GPIOC, .pin = LL_GPIO_PIN_1},
|
{.port = GPIOC, .pin = LL_GPIO_PIN_1},
|
||||||
{.port = GPIOC, .pin = LL_GPIO_PIN_3},
|
{.port = GPIOC, .pin = LL_GPIO_PIN_3},
|
||||||
{.port = GPIOB, .pin = LL_GPIO_PIN_2},
|
{.port = GPIOB, .pin = LL_GPIO_PIN_2},
|
||||||
{.port = GPIOB, .pin = LL_GPIO_PIN_3},
|
{.port = GPIOB, .pin = LL_GPIO_PIN_3},
|
||||||
{.port = GPIOA, .pin = LL_GPIO_PIN_4},
|
{.port = GPIOA, .pin = LL_GPIO_PIN_4},
|
||||||
{.port = GPIOA, .pin = LL_GPIO_PIN_6},
|
{.port = GPIOA, .pin = LL_GPIO_PIN_6},
|
||||||
{.port = GPIOA, .pin = LL_GPIO_PIN_7},
|
{.port = GPIOA, .pin = LL_GPIO_PIN_7},
|
||||||
#ifdef FURI_DEBUG
|
#ifdef FURI_DEBUG
|
||||||
{.port = GPIOA, .pin = LL_GPIO_PIN_0}, // IR_RX (PA0)
|
{.port = GPIOA, .pin = LL_GPIO_PIN_0}, // IR_RX (PA0)
|
||||||
{.port = GPIOB, .pin = LL_GPIO_PIN_7}, // UART RX (PB7)
|
{.port = GPIOB, .pin = LL_GPIO_PIN_7}, // UART RX (PB7)
|
||||||
{.port = GPIOB, .pin = LL_GPIO_PIN_8}, // SPEAKER (PB8)
|
{.port = GPIOB, .pin = LL_GPIO_PIN_8}, // SPEAKER (PB8)
|
||||||
{.port = GPIOB, .pin = LL_GPIO_PIN_9}, // IR_TX (PB9)
|
{.port = GPIOB, .pin = LL_GPIO_PIN_9}, // IR_TX (PB9)
|
||||||
#endif
|
#endif
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static bool pin_name_to_int(string_t pin_name, uint8_t* result) {
|
||||||
uint8_t num = 0;
|
uint8_t num = 0;
|
||||||
bool pin_found = false;
|
bool pin_found = false;
|
||||||
|
|
||||||
// Get first word as pin name
|
|
||||||
string_t pin_name;
|
|
||||||
string_init(pin_name);
|
|
||||||
size_t ws = string_search_char(args, ' ');
|
|
||||||
if(ws == STRING_FAILURE) {
|
|
||||||
cli_print_usage("gpio_set", "<pin_name> <0|1>", string_get_cstr(args));
|
|
||||||
string_clear(pin_name);
|
|
||||||
return;
|
|
||||||
} else {
|
|
||||||
string_set_n(pin_name, args, 0, ws);
|
|
||||||
string_right(args, ws);
|
|
||||||
string_strim(args);
|
|
||||||
}
|
|
||||||
// Search correct pin name
|
|
||||||
for(num = 0; num < sizeof(pin_names) / sizeof(char*); num++) {
|
for(num = 0; num < sizeof(pin_names) / sizeof(char*); num++) {
|
||||||
if(!string_cmp(pin_name, pin_names[num])) {
|
if(!string_cmp(pin_name, pin_names[num])) {
|
||||||
pin_found = true;
|
pin_found = true;
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
if(!pin_found) {
|
|
||||||
printf("Wrong pin name. Available pins: ");
|
*result = num;
|
||||||
for(uint8_t i = 0; i < sizeof(pin_names) / sizeof(char*); i++) {
|
return pin_found;
|
||||||
printf("%s ", pin_names[i]);
|
}
|
||||||
}
|
|
||||||
|
static void gpio_print_pins(void) {
|
||||||
|
printf("Wrong pin name. Available pins: ");
|
||||||
|
for(uint8_t i = 0; i < sizeof(pin_names) / sizeof(char*); i++) {
|
||||||
|
printf("%s ", pin_names[i]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
typedef enum { OK, ERR_CMD_SYNTAX, ERR_PIN, ERR_VALUE } GpioParseError;
|
||||||
|
|
||||||
|
static GpioParseError gpio_command_parse(string_t args, uint8_t* pin_num, uint8_t* value) {
|
||||||
|
string_t pin_name;
|
||||||
|
string_init(pin_name);
|
||||||
|
|
||||||
|
size_t ws = string_search_char(args, ' ');
|
||||||
|
if(ws == STRING_FAILURE) {
|
||||||
|
return ERR_CMD_SYNTAX;
|
||||||
|
}
|
||||||
|
|
||||||
|
string_set_n(pin_name, args, 0, ws);
|
||||||
|
string_right(args, ws);
|
||||||
|
string_strim(args);
|
||||||
|
|
||||||
|
if(!pin_name_to_int(pin_name, pin_num)) {
|
||||||
string_clear(pin_name);
|
string_clear(pin_name);
|
||||||
|
return ERR_PIN;
|
||||||
|
}
|
||||||
|
|
||||||
|
string_clear(pin_name);
|
||||||
|
|
||||||
|
if(!string_cmp(args, "0")) {
|
||||||
|
*value = 0;
|
||||||
|
} else if(!string_cmp(args, "1")) {
|
||||||
|
*value = 1;
|
||||||
|
} else {
|
||||||
|
return ERR_VALUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
void cli_command_gpio_mode(Cli* cli, string_t args, void* context) {
|
||||||
|
UNUSED(cli);
|
||||||
|
UNUSED(context);
|
||||||
|
|
||||||
|
uint8_t num = 0;
|
||||||
|
uint8_t value = 255;
|
||||||
|
|
||||||
|
GpioParseError err = gpio_command_parse(args, &num, &value);
|
||||||
|
|
||||||
|
if(ERR_CMD_SYNTAX == err) {
|
||||||
|
cli_print_usage("gpio_mode", "<pin_name> <0|1>", string_get_cstr(args));
|
||||||
|
return;
|
||||||
|
} else if(ERR_PIN == err) {
|
||||||
|
gpio_print_pins();
|
||||||
|
return;
|
||||||
|
} else if(ERR_VALUE == err) {
|
||||||
|
printf("Value is invalid. Enter 1 for input or 0 for output");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
string_clear(pin_name);
|
|
||||||
// Read "0" or "1" as second argument to set or reset pin
|
if(value == 0) { // output
|
||||||
if(!string_cmp(args, "0")) {
|
furi_hal_gpio_init_simple(gpio + num, GpioModeOutputPushPull);
|
||||||
LL_GPIO_SetPinMode(gpio[num].port, gpio[num].pin, LL_GPIO_MODE_OUTPUT);
|
furi_hal_gpio_write(gpio + num, false);
|
||||||
LL_GPIO_SetPinOutputType(gpio[num].port, gpio[num].pin, LL_GPIO_OUTPUT_PUSHPULL);
|
printf("Pin %s is now an output (low)", pin_names[num]);
|
||||||
LL_GPIO_ResetOutputPin(gpio[num].port, gpio[num].pin);
|
} else { // input
|
||||||
} else if(!string_cmp(args, "1")) {
|
furi_hal_gpio_init_simple(gpio + num, GpioModeInput);
|
||||||
|
printf("Pin %s is now an input", pin_names[num]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void cli_command_gpio_read(Cli* cli, string_t args, void* context) {
|
||||||
|
UNUSED(cli);
|
||||||
|
UNUSED(context);
|
||||||
|
|
||||||
|
uint8_t num = 0;
|
||||||
|
if(!pin_name_to_int(args, &num)) {
|
||||||
|
gpio_print_pins();
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(LL_GPIO_MODE_INPUT != LL_GPIO_GetPinMode(gpio[num].port, gpio[num].pin)) {
|
||||||
|
printf("Err: pin %s is not set as an input.", pin_names[num]);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t val = !!furi_hal_gpio_read(&gpio[num]);
|
||||||
|
|
||||||
|
printf("Pin %s <= %u", pin_names[num], val);
|
||||||
|
}
|
||||||
|
|
||||||
|
void cli_command_gpio_set(Cli* cli, string_t args, void* context) {
|
||||||
|
UNUSED(context);
|
||||||
|
|
||||||
|
uint8_t num = 0;
|
||||||
|
uint8_t value = 0;
|
||||||
|
GpioParseError err = gpio_command_parse(args, &num, &value);
|
||||||
|
|
||||||
|
if(ERR_CMD_SYNTAX == err) {
|
||||||
|
cli_print_usage("gpio_set", "<pin_name> <0|1>", string_get_cstr(args));
|
||||||
|
return;
|
||||||
|
} else if(ERR_PIN == err) {
|
||||||
|
gpio_print_pins();
|
||||||
|
return;
|
||||||
|
} else if(ERR_VALUE == err) {
|
||||||
|
printf("Value is invalid. Enter 1 for high or 0 for low");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(LL_GPIO_MODE_OUTPUT != LL_GPIO_GetPinMode(gpio[num].port, gpio[num].pin)) {
|
||||||
|
printf("Err: pin %s is not set as an output.", pin_names[num]);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
#ifdef FURI_DEBUG
|
#ifdef FURI_DEBUG
|
||||||
if(num == 8) { // PA0
|
if(value && num == 8) { // PA0
|
||||||
printf(
|
printf(
|
||||||
"Setting PA0 pin HIGH with TSOP connected can damage IR receiver. Are you sure you want to continue? (y/n)?\r\n");
|
"Setting PA0 pin HIGH with TSOP connected can damage IR receiver. Are you sure you want to continue? (y/n)?\r\n");
|
||||||
char c = cli_getc(cli);
|
char c = cli_getc(cli);
|
||||||
if(c != 'y' && c != 'Y') {
|
if(c != 'y' && c != 'Y') {
|
||||||
printf("Cancelled.\r\n");
|
printf("Cancelled.\r\n");
|
||||||
return;
|
return;
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
}
|
||||||
#else
|
#else
|
||||||
UNUSED(cli);
|
UNUSED(cli);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
LL_GPIO_SetPinMode(gpio[num].port, gpio[num].pin, LL_GPIO_MODE_OUTPUT);
|
furi_hal_gpio_write(gpio + num, !!value);
|
||||||
LL_GPIO_SetPinOutputType(gpio[num].port, gpio[num].pin, LL_GPIO_OUTPUT_PUSHPULL);
|
printf("Pin %s => %u", pin_names[num], !!value);
|
||||||
LL_GPIO_SetOutputPin(gpio[num].port, gpio[num].pin);
|
|
||||||
} else {
|
|
||||||
printf("Wrong 2nd argument. Use \"1\" to set, \"0\" to reset");
|
|
||||||
}
|
|
||||||
return;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void cli_command_ps(Cli* cli, string_t args, void* context) {
|
void cli_command_ps(Cli* cli, string_t args, void* context) {
|
||||||
@ -424,6 +508,8 @@ void cli_commands_init(Cli* cli) {
|
|||||||
|
|
||||||
cli_add_command(cli, "vibro", CliCommandFlagDefault, cli_command_vibro, NULL);
|
cli_add_command(cli, "vibro", CliCommandFlagDefault, cli_command_vibro, NULL);
|
||||||
cli_add_command(cli, "led", CliCommandFlagDefault, cli_command_led, NULL);
|
cli_add_command(cli, "led", CliCommandFlagDefault, cli_command_led, NULL);
|
||||||
|
cli_add_command(cli, "gpio_mode", CliCommandFlagDefault, cli_command_gpio_mode, NULL);
|
||||||
|
cli_add_command(cli, "gpio_read", CliCommandFlagDefault, cli_command_gpio_read, NULL);
|
||||||
cli_add_command(cli, "gpio_set", CliCommandFlagDefault, cli_command_gpio_set, NULL);
|
cli_add_command(cli, "gpio_set", CliCommandFlagDefault, cli_command_gpio_set, NULL);
|
||||||
cli_add_command(cli, "i2c", CliCommandFlagDefault, cli_command_i2c, NULL);
|
cli_add_command(cli, "i2c", CliCommandFlagDefault, cli_command_i2c, NULL);
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user