Commit 8ca175d2 authored by Eric Duminil's avatar Eric Duminil
Browse files
parent ab3e5689
...@@ -79,7 +79,7 @@ namespace mqtt { ...@@ -79,7 +79,7 @@ namespace mqtt {
command[i] = message[i]; command[i] = message[i];
} }
command[length] = 0; command[length] = 0;
sensor_console::runCommand(command); sensor_console::execute(command);
led_effects::onBoardLEDOff(); led_effects::onBoardLEDOff();
} }
......
...@@ -6,75 +6,111 @@ namespace sensor_console { ...@@ -6,75 +6,111 @@ namespace sensor_console {
uint8_t commands_count = 0; uint8_t commands_count = 0;
enum input_type {
NONE,
INT32,
STRING
};
struct Command { struct Command {
const char *name; const char *name;
union { union {
void (*voidFunction)();
void (*intFunction)(int32_t); void (*intFunction)(int32_t);
void (*voidFunction)(void); void (*strFunction)(char*);
}; };
const char *doc; const char *doc;
bool has_parameter; input_type parameter_type;
};
struct CommandLine {
char function_name[MAX_COMMAND_SIZE];
input_type argument_type;
int32_t int_argument;
char str_argument[MAX_COMMAND_SIZE];
}; };
Command commands[MAX_COMMANDS]; Command commands[MAX_COMMANDS];
//NOTE: Probably possible to DRY (with templates?) bool addCommand(const char *name, const __FlashStringHelper *doc_fstring) {
void defineCommand(const char *name, void (*function)(void), const __FlashStringHelper *doc_fstring) {
const char *doc = (const char*) doc_fstring;
if (commands_count < MAX_COMMANDS) { if (commands_count < MAX_COMMANDS) {
commands[commands_count].name = name; commands[commands_count].name = name;
commands[commands_count].voidFunction = function; commands[commands_count].doc = (const char*) doc_fstring;
commands[commands_count].doc = doc; return true;
commands[commands_count].has_parameter = false;
commands_count++;
} else { } else {
Serial.println(F("Too many commands have been defined.")); Serial.println(F("Too many commands have been defined."));
return false;
}
}
void defineCommand(const char *name, void (*function)(), const __FlashStringHelper *doc_fstring) {
if (addCommand(name, doc_fstring)) {
commands[commands_count].voidFunction = function;
commands[commands_count++].parameter_type = NONE;
} }
} }
void defineIntCommand(const char *name, void (*function)(int32_t), const __FlashStringHelper *doc_fstring) { void defineIntCommand(const char *name, void (*function)(int32_t), const __FlashStringHelper *doc_fstring) {
const char *doc = (const char*) doc_fstring; if (addCommand(name, doc_fstring)) {
if (commands_count < MAX_COMMANDS) {
commands[commands_count].name = name;
commands[commands_count].intFunction = function; commands[commands_count].intFunction = function;
commands[commands_count].doc = doc; commands[commands_count++].parameter_type = INT32;
commands[commands_count].has_parameter = true; }
commands_count++; }
} else {
Serial.println(F("Too many commands have been defined.")); void defineStringCommand(const char *name, void (*function)(char*), const __FlashStringHelper *doc_fstring) {
if (addCommand(name, doc_fstring)) {
commands[commands_count].strFunction = function;
commands[commands_count++].parameter_type = STRING;
} }
} }
/* /*
* Tries to split a string command (e.g. 'mqtt 60' or 'show_csv') into a function_name and an argument. * Tries to split a string command (e.g. 'mqtt 60' or 'show_csv') into
* Returns 0 if both are found, 1 if there is a problem and 2 if no argument is found. * a CommandLine struct (function_name, argument_type and argument)
*/ */
uint8_t parseCommand(const char *command, char *function_name, int32_t &argument) { void parseCommand(const char *command, CommandLine &command_line) {
char split_command[MAX_COMMAND_SIZE]; if (strlen(command) == 0) {
strlcpy(split_command, command, MAX_COMMAND_SIZE);
char *arg;
char *part1;
part1 = strtok(split_command, " ");
if (!part1) {
Serial.println(F("Received empty command")); Serial.println(F("Received empty command"));
// Empty string command_line.argument_type = NONE;
return 1; return;
} }
strlcpy(function_name, part1, MAX_COMMAND_SIZE);
arg = strtok(NULL, " "); char *first_space;
uint8_t code = 0; first_space = strchr(command, ' ');
if (arg) {
char *end; if (first_space == NULL) {
argument = strtol(arg, &end, 10); command_line.argument_type = NONE;
if (*end) { strlcpy(command_line.function_name, command, MAX_COMMAND_SIZE);
// Second argument isn't a number return;
code = 2; }
}
strlcpy(command_line.function_name, command, first_space - command + 1);
strlcpy(command_line.str_argument, first_space + 1, MAX_COMMAND_SIZE - (first_space - command) - 1);
char *end;
command_line.int_argument = strtol(command_line.str_argument, &end, 0); // Accepts 123 or 0xFF00FF
if (*end) {
command_line.argument_type = STRING;
} else { } else {
// No argument command_line.argument_type = INT32;
code = 2; }
}
int compareCommandNames(const void *s1, const void *s2) {
struct Command *c1 = (struct Command*) s1;
struct Command *c2 = (struct Command*) s2;
return strcmp(c1->name, c2->name);
}
void listAvailableCommands() {
qsort(commands, commands_count, sizeof(commands[0]), compareCommandNames);
for (uint8_t i = 0; i < commands_count; i++) {
Serial.print(F(" "));
Serial.print(commands[i].name);
Serial.print(commands[i].doc);
Serial.println(F("."));
} }
return code;
} }
/* /*
...@@ -88,7 +124,7 @@ namespace sensor_console { ...@@ -88,7 +124,7 @@ namespace sensor_console {
case '\n': // end of text case '\n': // end of text
Serial.println(); Serial.println();
input_line[input_pos] = 0; input_line[input_pos] = 0;
runCommand(input_line); execute(input_line);
input_pos = 0; input_pos = 0;
break; break;
case '\r': // discard carriage return case '\r': // discard carriage return
...@@ -112,50 +148,40 @@ namespace sensor_console { ...@@ -112,50 +148,40 @@ namespace sensor_console {
} }
} }
int compareName(const void *s1, const void *s2) {
struct Command *c1 = (struct Command*) s1;
struct Command *c2 = (struct Command*) s2;
return strcmp(c1->name, c2->name);
}
void listAvailableCommands() {
qsort(commands, commands_count, sizeof(commands[0]), compareName);
for (uint8_t i = 0; i < commands_count; i++) {
Serial.print(" ");
Serial.print(commands[i].name);
Serial.print(commands[i].doc);
Serial.println(".");
}
}
/* /*
* Tries to find the corresponding callback for a given command. Name and number of argument should fit. * Tries to find the corresponding callback for a given command. Name and parameter type should fit.
*/ */
void runCommand(const char *command) { void execute(const char *command_str) {
char function_name[MAX_COMMAND_SIZE]; CommandLine input;
int32_t argument = 0; parseCommand(command_str, input);
bool has_argument;
has_argument = (parseCommand(command, function_name, argument) == 0);
for (uint8_t i = 0; i < commands_count; i++) { for (uint8_t i = 0; i < commands_count; i++) {
if (!strcmp(function_name, commands[i].name) && has_argument == commands[i].has_parameter) { if (!strcmp(input.function_name, commands[i].name) && input.argument_type == commands[i].parameter_type) {
Serial.print(F("Calling : ")); Serial.print(F("Calling : "));
Serial.print(function_name); Serial.print(input.function_name);
if (has_argument) { switch (input.argument_type) {
Serial.print(F("(")); case NONE:
Serial.print(argument);
Serial.println(F(")"));
commands[i].intFunction(argument);
} else {
Serial.println(F("()")); Serial.println(F("()"));
commands[i].voidFunction(); commands[i].voidFunction();
return;
case INT32:
Serial.print(F("("));
Serial.print(input.int_argument);
Serial.println(F(")"));
commands[i].intFunction(input.int_argument);
return;
case STRING:
Serial.print(F("('"));
Serial.print(input.str_argument);
Serial.println(F("')"));
commands[i].strFunction(input.str_argument);
return;
} }
return;
} }
} }
Serial.print(F("'")); Serial.print(F("'"));
Serial.print(command); Serial.print(command_str);
Serial.println(F("' not supported. Available commands :")); Serial.println(F("' not supported. Available commands :"));
listAvailableCommands(); listAvailableCommands();
} }
} }
...@@ -8,11 +8,13 @@ ...@@ -8,11 +8,13 @@
*/ */
namespace sensor_console { namespace sensor_console {
void defineCommand(const char *command, void (*function)(void), const __FlashStringHelper *ifsh); void defineCommand(const char *name, void (*function)(), const __FlashStringHelper *doc_fstring);
void defineIntCommand(const char *command, void (*function)(int32_t), const __FlashStringHelper *ifsh); void defineIntCommand(const char *name, void (*function)(int32_t), const __FlashStringHelper *doc_fstring);
void defineStringCommand(const char *name, void (*function)(char*), const __FlashStringHelper *doc_fstring);
void processSerialInput(const byte in_byte); void processSerialInput(const byte in_byte);
void runCommand(const char *command);
void execute(const char *command_line);
} }
#endif #endif
...@@ -292,7 +292,7 @@ namespace web_server { ...@@ -292,7 +292,7 @@ namespace web_server {
} }
http.sendHeader("Location", "/"); http.sendHeader("Location", "/");
http.send(303); http.send(303);
sensor_console::runCommand(http.arg("send").c_str()); sensor_console::execute(http.arg("send").c_str());
} }
void handlePageNotFound() { void handlePageNotFound() {
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment