649 lines
12 KiB
C
649 lines
12 KiB
C
/*
|
|
* Copyright (c) 2015 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
/**
|
|
* @file
|
|
* @brief Console handler implementation of shell.h API
|
|
*/
|
|
|
|
#include <zephyr.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <version.h>
|
|
|
|
#include <console.h>
|
|
#include <drivers/console/console.h>
|
|
#include <misc/printk.h>
|
|
#include <misc/util.h>
|
|
#include "mgmt/serial.h"
|
|
|
|
#include <shell/shell.h>
|
|
|
|
#define ARGC_MAX 10
|
|
#define COMMAND_MAX_LEN 50
|
|
#define MODULE_NAME_MAX_LEN 20
|
|
/* additional chars are " >" (include '\0' )*/
|
|
#define PROMPT_SUFFIX 3
|
|
#define PROMPT_MAX_LEN (MODULE_NAME_MAX_LEN + PROMPT_SUFFIX)
|
|
|
|
/* command table is located in the dedicated memory segment (.shell_) */
|
|
extern struct shell_module __shell_module_start[];
|
|
extern struct shell_module __shell_module_end[];
|
|
|
|
extern struct shell_cmd __shell_cmd_start[];
|
|
extern struct shell_cmd __shell_cmd_end[];
|
|
|
|
#define NUM_OF_SHELL_ENTITIES (__shell_module_end - __shell_module_start)
|
|
#define NUM_OF_SHELL_CMDS (__shell_cmd_end - __shell_cmd_start)
|
|
|
|
static const char *prompt;
|
|
static char default_module_prompt[PROMPT_MAX_LEN];
|
|
static struct shell_module *default_module;
|
|
static bool no_promt;
|
|
|
|
#define STACKSIZE CONFIG_CONSOLE_SHELL_STACKSIZE
|
|
static K_THREAD_STACK_DEFINE(stack, STACKSIZE);
|
|
static struct k_thread shell_thread;
|
|
|
|
#define MAX_CMD_QUEUED CONFIG_CONSOLE_SHELL_MAX_CMD_QUEUED
|
|
static struct console_input buf[MAX_CMD_QUEUED];
|
|
|
|
static struct k_fifo avail_queue;
|
|
static struct k_fifo cmds_queue;
|
|
|
|
static shell_cmd_function_t app_cmd_handler;
|
|
static shell_prompt_function_t app_prompt_handler;
|
|
|
|
static shell_mcumgr_function_t mcumgr_cmd_handler;
|
|
static void *mcumgr_arg;
|
|
|
|
static const char *get_prompt(void)
|
|
{
|
|
if (app_prompt_handler) {
|
|
const char *str;
|
|
|
|
str = app_prompt_handler();
|
|
if (str) {
|
|
return str;
|
|
}
|
|
}
|
|
|
|
if (default_module) {
|
|
if (default_module->prompt) {
|
|
const char *ret;
|
|
|
|
ret = default_module->prompt();
|
|
if (ret) {
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return default_module_prompt;
|
|
}
|
|
|
|
return prompt;
|
|
}
|
|
|
|
static void line_queue_init(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < MAX_CMD_QUEUED; i++) {
|
|
k_fifo_put(&avail_queue, &buf[i]);
|
|
}
|
|
}
|
|
|
|
static size_t line2argv(char *str, char *argv[], size_t size)
|
|
{
|
|
size_t argc = 0;
|
|
|
|
if (!strlen(str)) {
|
|
return 0;
|
|
}
|
|
|
|
while (*str && *str == ' ') {
|
|
str++;
|
|
}
|
|
|
|
if (!*str) {
|
|
return 0;
|
|
}
|
|
|
|
argv[argc++] = str;
|
|
|
|
while ((str = strchr(str, ' '))) {
|
|
*str++ = '\0';
|
|
|
|
while (*str && *str == ' ') {
|
|
str++;
|
|
}
|
|
|
|
if (!*str) {
|
|
break;
|
|
}
|
|
|
|
argv[argc++] = str;
|
|
|
|
if (argc == size) {
|
|
printk("Too many parameters (max %zu)\n", size - 1);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
/* keep it POSIX style where argv[argc] is required to be NULL */
|
|
argv[argc] = NULL;
|
|
|
|
return argc;
|
|
}
|
|
|
|
static struct shell_module *get_destination_module(const char *module_str)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < NUM_OF_SHELL_ENTITIES; i++) {
|
|
if (!strncmp(module_str,
|
|
__shell_module_start[i].module_name,
|
|
MODULE_NAME_MAX_LEN)) {
|
|
return &__shell_module_start[i];
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static int show_cmd_help(const struct shell_cmd *cmd, bool full)
|
|
{
|
|
printk("Usage: %s %s\n", cmd->cmd_name, cmd->help ? cmd->help : "");
|
|
|
|
if (full && cmd->desc) {
|
|
printk("%s\n", cmd->desc);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void print_module_commands(struct shell_module *module)
|
|
{
|
|
int i;
|
|
|
|
printk("help\n");
|
|
|
|
for (i = 0; module->commands[i].cmd_name; i++) {
|
|
printk("%-28s %s\n",
|
|
module->commands[i].cmd_name,
|
|
module->commands[i].help ?
|
|
module->commands[i].help : "");
|
|
}
|
|
}
|
|
|
|
static const struct shell_cmd *get_cmd(const struct shell_cmd cmds[],
|
|
const char *cmd_str)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; cmds[i].cmd_name; i++) {
|
|
if (!strcmp(cmd_str, cmds[i].cmd_name)) {
|
|
return &cmds[i];
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static const struct shell_cmd *get_module_cmd(struct shell_module *module,
|
|
const char *cmd_str)
|
|
{
|
|
return get_cmd(module->commands, cmd_str);
|
|
}
|
|
|
|
static const struct shell_cmd *get_standalone(const char *command)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < NUM_OF_SHELL_CMDS; i++) {
|
|
if (!strcmp(command, __shell_cmd_start[i].cmd_name)) {
|
|
return &__shell_cmd_start[i];
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/**
|
|
* Handle internal 'help' command
|
|
*/
|
|
static int cmd_help(int argc, char *argv[])
|
|
{
|
|
struct shell_module *module = default_module;
|
|
|
|
/* help per command */
|
|
if (argc > 1) {
|
|
const struct shell_cmd *cmd;
|
|
const char *cmd_str;
|
|
|
|
module = get_destination_module(argv[1]);
|
|
if (module) {
|
|
if (argc == 2) {
|
|
goto module_help;
|
|
}
|
|
|
|
cmd_str = argv[2];
|
|
} else {
|
|
cmd_str = argv[1];
|
|
module = default_module;
|
|
}
|
|
|
|
if (!module) {
|
|
cmd = get_standalone(cmd_str);
|
|
if (cmd) {
|
|
return show_cmd_help(cmd, true);
|
|
} else {
|
|
printk("No help found for '%s'\n", cmd_str);
|
|
return -EINVAL;
|
|
}
|
|
} else {
|
|
cmd = get_module_cmd(module, cmd_str);
|
|
if (cmd) {
|
|
return show_cmd_help(cmd, true);
|
|
} else {
|
|
printk("Unknown command '%s'\n", cmd_str);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
}
|
|
|
|
module_help:
|
|
/* help per module */
|
|
if (module) {
|
|
print_module_commands(module);
|
|
printk("\nEnter 'exit' to leave current module.\n");
|
|
} else { /* help for all entities */
|
|
int i;
|
|
|
|
printk("[Modules]\n");
|
|
|
|
if (NUM_OF_SHELL_ENTITIES == 0) {
|
|
printk("No registered modules.\n");
|
|
}
|
|
|
|
for (i = 0; i < NUM_OF_SHELL_ENTITIES; i++) {
|
|
printk("%s\n", __shell_module_start[i].module_name);
|
|
}
|
|
|
|
printk("\n[Commands]\n");
|
|
|
|
if (NUM_OF_SHELL_CMDS == 0) {
|
|
printk("No registered commands.\n");
|
|
}
|
|
|
|
for (i = 0; i < NUM_OF_SHELL_CMDS; i++) {
|
|
printk("%s\n", __shell_cmd_start[i].cmd_name);
|
|
}
|
|
|
|
printk("\nTo select a module, enter 'select <module name>'.\n");
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int set_default_module(const char *name)
|
|
{
|
|
struct shell_module *module;
|
|
|
|
if (strlen(name) > MODULE_NAME_MAX_LEN) {
|
|
printk("Module name %s is too long, default is not changed\n",
|
|
name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
module = get_destination_module(name);
|
|
|
|
if (!module) {
|
|
printk("Illegal module %s, default is not changed\n", name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
default_module = module;
|
|
|
|
strncpy(default_module_prompt, name, MODULE_NAME_MAX_LEN);
|
|
strcat(default_module_prompt, "> ");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cmd_select(int argc, char *argv[])
|
|
{
|
|
if (argc == 1) {
|
|
default_module = NULL;
|
|
return 0;
|
|
}
|
|
|
|
return set_default_module(argv[1]);
|
|
}
|
|
|
|
static int cmd_exit(int argc, char *argv[])
|
|
{
|
|
if (argc == 1) {
|
|
default_module = NULL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cmd_noprompt(int argc, char *argv[])
|
|
{
|
|
no_promt = true;
|
|
return 0;
|
|
}
|
|
|
|
#define SHELL_CMD_NOPROMPT "noprompt"
|
|
SHELL_REGISTER_COMMAND(SHELL_CMD_NOPROMPT, cmd_noprompt,
|
|
"Disable shell prompt");
|
|
|
|
static const struct shell_cmd *get_internal(const char *command)
|
|
{
|
|
static const struct shell_cmd internal_commands[] = {
|
|
{ "help", cmd_help, "[command]" },
|
|
{ "select", cmd_select, "[module]" },
|
|
{ "exit", cmd_exit, NULL },
|
|
{ NULL },
|
|
};
|
|
|
|
return get_cmd(internal_commands, command);
|
|
}
|
|
|
|
void shell_register_mcumgr_handler(shell_mcumgr_function_t handler, void *arg)
|
|
{
|
|
mcumgr_cmd_handler = handler;
|
|
mcumgr_arg = arg;
|
|
}
|
|
|
|
int shell_exec(char *line)
|
|
{
|
|
char *argv[ARGC_MAX + 1], **argv_start = argv;
|
|
const struct shell_cmd *cmd;
|
|
int argc, err;
|
|
|
|
argc = line2argv(line, argv, ARRAY_SIZE(argv));
|
|
if (!argc) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
cmd = get_internal(argv[0]);
|
|
if (cmd) {
|
|
goto done;
|
|
}
|
|
|
|
cmd = get_standalone(argv[0]);
|
|
if (cmd) {
|
|
goto done;
|
|
}
|
|
|
|
if (argc == 1 && !default_module && NUM_OF_SHELL_CMDS == 0) {
|
|
printk("No module selected. Use 'select' or 'help'.\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (default_module) {
|
|
cmd = get_module_cmd(default_module, argv[0]);
|
|
}
|
|
|
|
if (!cmd && argc > 1) {
|
|
struct shell_module *module;
|
|
|
|
module = get_destination_module(argv[0]);
|
|
if (module) {
|
|
cmd = get_module_cmd(module, argv[1]);
|
|
if (cmd) {
|
|
argc--;
|
|
argv_start++;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (!cmd) {
|
|
if (app_cmd_handler) {
|
|
return app_cmd_handler(argc, argv);
|
|
}
|
|
|
|
printk("Unrecognized command: %s\n", argv[0]);
|
|
printk("Type 'help' for list of available commands\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
done:
|
|
err = cmd->cb(argc, argv_start);
|
|
if (err < 0) {
|
|
show_cmd_help(cmd, false);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static void shell(void *p1, void *p2, void *p3)
|
|
{
|
|
bool skip_prompt = false;
|
|
|
|
ARG_UNUSED(p1);
|
|
ARG_UNUSED(p2);
|
|
ARG_UNUSED(p3);
|
|
|
|
printk("Zephyr Shell, Zephyr version: %s\n", KERNEL_VERSION_STRING);
|
|
printk("Type 'help' for a list of available commands\n");
|
|
while (1) {
|
|
struct console_input *cmd;
|
|
|
|
if (!no_promt && !skip_prompt) {
|
|
printk("%s", get_prompt());
|
|
#if defined(CONFIG_NATIVE_POSIX_CONSOLE)
|
|
/* The native printk driver is line buffered */
|
|
posix_flush_stdout();
|
|
#endif
|
|
}
|
|
|
|
cmd = k_fifo_get(&cmds_queue, K_FOREVER);
|
|
|
|
/* If the received line is an mcumgr frame, divert it to the
|
|
* mcumgr handler. Don't print the shell prompt this time, as
|
|
* that will interfere with the mcumgr response.
|
|
*/
|
|
if (mcumgr_cmd_handler != NULL && cmd->is_mcumgr) {
|
|
mcumgr_cmd_handler(cmd->line, mcumgr_arg);
|
|
skip_prompt = true;
|
|
} else {
|
|
shell_exec(cmd->line);
|
|
skip_prompt = false;
|
|
}
|
|
|
|
k_fifo_put(&avail_queue, cmd);
|
|
}
|
|
}
|
|
|
|
static struct shell_module *get_completion_module(char *str,
|
|
char **command_prefix)
|
|
{
|
|
char dest_str[MODULE_NAME_MAX_LEN];
|
|
struct shell_module *dest;
|
|
char *start;
|
|
|
|
/* remove ' ' at the beginning of the line */
|
|
while (*str && *str == ' ') {
|
|
str++;
|
|
}
|
|
|
|
if (!*str) {
|
|
return NULL;
|
|
}
|
|
|
|
start = str;
|
|
|
|
if (default_module) {
|
|
dest = default_module;
|
|
/* caller function already checks str len and put '\0' */
|
|
*command_prefix = str;
|
|
} else {
|
|
dest = NULL;
|
|
}
|
|
|
|
/*
|
|
* In case of a default module: only one parameter is possible.
|
|
* Otherwise, only two parameters are possibles.
|
|
*/
|
|
str = strchr(str, ' ');
|
|
if (default_module) {
|
|
return str ? NULL : dest;
|
|
}
|
|
|
|
if (!str) {
|
|
return NULL;
|
|
}
|
|
|
|
if ((str - start + 1) >= MODULE_NAME_MAX_LEN) {
|
|
return NULL;
|
|
}
|
|
|
|
strncpy(dest_str, start, (str - start + 1));
|
|
dest_str[str - start] = '\0';
|
|
dest = get_destination_module(dest_str);
|
|
if (!dest) {
|
|
return NULL;
|
|
}
|
|
|
|
str++;
|
|
|
|
/* caller func has already checked str len and put '\0' at the end */
|
|
*command_prefix = str;
|
|
str = strchr(str, ' ');
|
|
|
|
/* only two parameters are possibles in case of no default module */
|
|
return str ? dest : NULL;
|
|
}
|
|
|
|
static u8_t completion(char *line, u8_t len)
|
|
{
|
|
const char *first_match = NULL;
|
|
int common_chars = -1, space = 0;
|
|
int i, command_len;
|
|
const struct shell_module *module;
|
|
char *command_prefix;
|
|
|
|
if (len >= (MODULE_NAME_MAX_LEN + COMMAND_MAX_LEN - 1)) {
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* line to completion is not ended by '\0' as the line that gets from
|
|
* k_fifo_get function
|
|
*/
|
|
line[len] = '\0';
|
|
module = get_completion_module(line, &command_prefix);
|
|
if (!module) {
|
|
return 0;
|
|
}
|
|
|
|
command_len = strlen(command_prefix);
|
|
|
|
for (i = 0; module->commands[i].cmd_name; i++) {
|
|
int j;
|
|
|
|
if (strncmp(command_prefix,
|
|
module->commands[i].cmd_name, command_len)) {
|
|
continue;
|
|
}
|
|
|
|
if (!first_match) {
|
|
first_match = module->commands[i].cmd_name;
|
|
continue;
|
|
}
|
|
|
|
/* more commands match, print first match */
|
|
if (first_match && (common_chars < 0)) {
|
|
printk("\n%s\n", first_match);
|
|
common_chars = strlen(first_match);
|
|
}
|
|
|
|
/* cut common part of matching names */
|
|
for (j = 0; j < common_chars; j++) {
|
|
if (first_match[j] != module->commands[i].cmd_name[j]) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
common_chars = j;
|
|
|
|
printk("%s\n", module->commands[i].cmd_name);
|
|
}
|
|
|
|
/* no match, do nothing */
|
|
if (!first_match) {
|
|
return 0;
|
|
}
|
|
|
|
if (common_chars >= 0) {
|
|
/* multiple match, restore prompt */
|
|
printk("%s", get_prompt());
|
|
printk("%s", line);
|
|
} else {
|
|
common_chars = strlen(first_match);
|
|
space = 1;
|
|
}
|
|
|
|
/* complete common part */
|
|
for (i = command_len; i < common_chars; i++) {
|
|
printk("%c", first_match[i]);
|
|
line[len++] = first_match[i];
|
|
}
|
|
|
|
/* for convenience add space after command */
|
|
if (space) {
|
|
printk(" ");
|
|
line[len] = ' ';
|
|
}
|
|
|
|
return common_chars - command_len + space;
|
|
}
|
|
|
|
|
|
void shell_init(const char *str)
|
|
{
|
|
k_fifo_init(&cmds_queue);
|
|
k_fifo_init(&avail_queue);
|
|
|
|
line_queue_init();
|
|
|
|
prompt = str ? str : "";
|
|
|
|
k_thread_create(&shell_thread, stack, STACKSIZE, shell, NULL, NULL,
|
|
NULL, K_PRIO_COOP(7), 0, K_NO_WAIT);
|
|
|
|
/* Register console handler */
|
|
console_register_line_input(&avail_queue, &cmds_queue, completion);
|
|
}
|
|
|
|
/** @brief Optionally register an app default cmd handler.
|
|
*
|
|
* @param handler To be called if no cmd found in cmds registered with
|
|
* shell_init.
|
|
*/
|
|
void shell_register_app_cmd_handler(shell_cmd_function_t handler)
|
|
{
|
|
app_cmd_handler = handler;
|
|
}
|
|
|
|
void shell_register_prompt_handler(shell_prompt_function_t handler)
|
|
{
|
|
app_prompt_handler = handler;
|
|
}
|
|
|
|
void shell_register_default_module(const char *name)
|
|
{
|
|
int err = set_default_module(name);
|
|
|
|
if (!err) {
|
|
printk("\n%s", default_module_prompt);
|
|
}
|
|
}
|