|
@ -5978,28 +5978,34 @@ void process_next_command() { |
|
|
char* starpos = strchr(current_command, '*'); // * should always be the last parameter
|
|
|
char* starpos = strchr(current_command, '*'); // * should always be the last parameter
|
|
|
if (starpos) while (*starpos == ' ' || *starpos == '*') *starpos-- = '\0'; // nullify '*' and ' '
|
|
|
if (starpos) while (*starpos == ' ' || *starpos == '*') *starpos-- = '\0'; // nullify '*' and ' '
|
|
|
|
|
|
|
|
|
|
|
|
char *cmd_ptr = current_command; |
|
|
|
|
|
|
|
|
// Get the command code, which must be G, M, or T
|
|
|
// Get the command code, which must be G, M, or T
|
|
|
char command_code = *current_command; |
|
|
char command_code = *cmd_ptr++; |
|
|
|
|
|
|
|
|
// Skip the letter-code and spaces to get the numeric part
|
|
|
// Skip spaces to get the numeric part
|
|
|
current_command_args = current_command + 1; |
|
|
while (*cmd_ptr == ' ') cmd_ptr++; |
|
|
while (*current_command_args == ' ') ++current_command_args; |
|
|
|
|
|
|
|
|
|
|
|
// The code must have a numeric value
|
|
|
// The code must have a numeric value
|
|
|
bool code_is_good = (*current_command_args >= '0' && *current_command_args <= '9'); |
|
|
bool code_is_good = false; |
|
|
|
|
|
|
|
|
|
|
|
int codenum = 0; // define ahead of goto
|
|
|
|
|
|
|
|
|
int codenum; // define ahead of goto
|
|
|
// Get and skip the code number
|
|
|
|
|
|
while (*cmd_ptr >= '0' && *cmd_ptr <= '9') { |
|
|
|
|
|
code_is_good = true; |
|
|
|
|
|
codenum = codenum * 10 + *cmd_ptr - '0'; |
|
|
|
|
|
cmd_ptr++; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
// Bail early if there's no code
|
|
|
// Bail early if there's no code
|
|
|
if (!code_is_good) goto ExitUnknownCommand; |
|
|
if (!code_is_good) goto ExitUnknownCommand; |
|
|
|
|
|
|
|
|
// Args pointer optimizes code_seen, especially those taking XYZEF
|
|
|
// Skip all spaces to get to the first argument
|
|
|
// This wastes a little cpu on commands that expect no arguments.
|
|
|
while (*cmd_ptr == ' ') cmd_ptr++; |
|
|
while (*current_command_args == ' ' || (*current_command_args >= '0' && *current_command_args <= '9')) ++current_command_args; |
|
|
|
|
|
|
|
|
|
|
|
// Interpret the code int
|
|
|
// The command's arguments start here, for sure!
|
|
|
seen_pointer = current_command; |
|
|
current_command_args = cmd_ptr; |
|
|
codenum = code_value_short(); |
|
|
|
|
|
|
|
|
|
|
|
KEEPALIVE_STATE(IN_HANDLER); |
|
|
KEEPALIVE_STATE(IN_HANDLER); |
|
|
|
|
|
|
|
|