blob: 1c6e0fb8b82efbf467942b108f4a3dc865b93d43 [file] [log] [blame]
/*
* 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);