152 lines
3.2 KiB
C
152 lines
3.2 KiB
C
/*
|
|
* Copyright (c) 2018 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <sys/printk.h>
|
|
#include <shell/shell.h>
|
|
#include <init.h>
|
|
#include <string.h>
|
|
#include <stdio.h>
|
|
#include <drivers/gpio.h>
|
|
#include <stdlib.h>
|
|
#include <ctype.h>
|
|
#include <logging/log.h>
|
|
|
|
#define LOG_LEVEL CONFIG_LOG_DEFAULT_LEVEL
|
|
|
|
LOG_MODULE_REGISTER(gpio_shell);
|
|
|
|
struct args_index {
|
|
u8_t port;
|
|
u8_t index;
|
|
u8_t mode;
|
|
u8_t value;
|
|
};
|
|
|
|
struct args_number {
|
|
u8_t conf;
|
|
u8_t set;
|
|
u8_t get;
|
|
u8_t listen;
|
|
};
|
|
|
|
static const struct args_index args_indx = {
|
|
.port = 1,
|
|
.index = 2,
|
|
.mode = 3,
|
|
.value = 3,
|
|
};
|
|
|
|
static const struct args_number args_no = {
|
|
.conf = 4,
|
|
.set = 4,
|
|
.get = 3,
|
|
.listen = 7
|
|
};
|
|
|
|
static int cmd_gpio_conf(const struct shell *shell, size_t argc, char **argv)
|
|
{
|
|
u8_t index = 0U;
|
|
int type = GPIO_OUTPUT;
|
|
struct device *dev;
|
|
|
|
if (argc == args_no.conf &&
|
|
isdigit((unsigned char)argv[args_indx.index][0]) &&
|
|
isalpha((unsigned char)argv[args_indx.mode][0])) {
|
|
index = (u8_t)atoi(argv[args_indx.index]);
|
|
if (!strcmp(argv[args_indx.mode], "in")) {
|
|
type = GPIO_INPUT;
|
|
} else if (!strcmp(argv[args_indx.mode], "out")) {
|
|
type = GPIO_OUTPUT;
|
|
} else {
|
|
return 0;
|
|
}
|
|
} else {
|
|
shell_error(shell, "Wrong parameters for conf");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
dev = device_get_binding(argv[args_indx.port]);
|
|
|
|
if (dev != NULL) {
|
|
index = (uint8_t)atoi(argv[args_indx.index]);
|
|
shell_print(shell, "Configuring %s pin %d",
|
|
argv[args_indx.port], index);
|
|
gpio_pin_configure(dev, index, type);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cmd_gpio_get(const struct shell *shell,
|
|
size_t argc, char **argv)
|
|
{
|
|
struct device *dev;
|
|
u8_t index = 0U;
|
|
int rc;
|
|
|
|
if (argc == args_no.get && isdigit((unsigned char)argv[args_indx.index][0])) {
|
|
index = (uint8_t)atoi(argv[args_indx.index]);
|
|
} else {
|
|
shell_error(shell, "Wrong parameters for get");
|
|
return -EINVAL;
|
|
}
|
|
|
|
dev = device_get_binding(argv[args_indx.port]);
|
|
|
|
if (dev != NULL) {
|
|
index = (u8_t)atoi(argv[2]);
|
|
shell_print(shell, "Reading %s pin %d",
|
|
argv[args_indx.port], index);
|
|
rc = gpio_pin_get(dev, index);
|
|
if (rc >= 0) {
|
|
shell_print(shell, "Value %d", rc);
|
|
} else {
|
|
shell_error(shell, "Error %d reading value", rc);
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cmd_gpio_set(const struct shell *shell,
|
|
size_t argc, char **argv)
|
|
{
|
|
struct device *dev;
|
|
u8_t index = 0U;
|
|
u8_t value = 0U;
|
|
|
|
if (argc == args_no.set &&
|
|
isdigit((unsigned char)argv[args_indx.index][0]) &&
|
|
isdigit((unsigned char)argv[args_indx.value][0])) {
|
|
index = (uint8_t)atoi(argv[args_indx.index]);
|
|
value = (uint8_t)atoi(argv[args_indx.value]);
|
|
} else {
|
|
shell_print(shell, "Wrong parameters for set");
|
|
return -EINVAL;
|
|
}
|
|
dev = device_get_binding(argv[args_indx.port]);
|
|
|
|
if (dev != NULL) {
|
|
index = (u8_t)atoi(argv[2]);
|
|
shell_print(shell, "Writing to %s pin %d",
|
|
argv[args_indx.port], index);
|
|
gpio_pin_set(dev, index, value);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
SHELL_STATIC_SUBCMD_SET_CREATE(sub_gpio,
|
|
SHELL_CMD(conf, NULL, "Configure GPIO", cmd_gpio_conf),
|
|
SHELL_CMD(get, NULL, "Get GPIO value", cmd_gpio_get),
|
|
SHELL_CMD(set, NULL, "Set GPIO", cmd_gpio_set),
|
|
SHELL_SUBCMD_SET_END /* Array terminated. */
|
|
);
|
|
|
|
SHELL_CMD_REGISTER(gpio, &sub_gpio, "GPIO commands", NULL);
|