You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
76 lines
2.7 KiB
76 lines
2.7 KiB
/*
|
|
* Copyright (c) 2021, Erich Styger
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include "platform.h"
|
|
#if PL_CONFIG_USE_ROBO_REMOTE
|
|
#include "robot.h"
|
|
#include "udp_server.h"
|
|
#include "wifi.h"
|
|
#include "McuShell.h"
|
|
#include "McuUtility.h"
|
|
#include "Shell.h"
|
|
|
|
#if PL_CONFIG_USE_SHELL
|
|
|
|
static uint8_t PrintStatus(const McuShell_StdIOType *io) {
|
|
McuShell_SendStatusStr((unsigned char*)"robo", (unsigned char*)"ESP32 robo status\r\n", io->stdOut);
|
|
return ERR_OK;
|
|
}
|
|
|
|
static uint8_t PrintHelp(const McuShell_StdIOType *io) {
|
|
McuShell_SendHelpStr((unsigned char*)"robo", (unsigned char*)"Group of robot commands\r\n", io->stdOut);
|
|
McuShell_SendHelpStr((unsigned char*)" help|status", (unsigned char*)"Shows robot help or status\r\n", io->stdOut);
|
|
McuShell_SendHelpStr((unsigned char*)" send <text>", (unsigned char*)"Send a text to the robot\r\n", io->stdOut);
|
|
McuShell_SendHelpStr((unsigned char*)" sendcmd <cmd>", (unsigned char*)"Send a command to the robot, e.g. '#buzzer buz 100 200'\r\n", io->stdOut);
|
|
return ERR_OK;
|
|
}
|
|
|
|
uint8_t ROBOT_ParseCommand(const unsigned char* cmd, bool *handled, const McuShell_StdIOType *io) {
|
|
if (McuUtility_strcmp((char*)cmd, (char*)McuShell_CMD_HELP)==0 || McuUtility_strcmp((char*)cmd, (char*)"robo help")==0) {
|
|
*handled = TRUE;
|
|
return PrintHelp(io);
|
|
} else if (McuUtility_strcmp((char*)cmd, (char*)McuShell_CMD_STATUS)==0 || McuUtility_strcmp((char*)cmd, (char*)"robo status")==0) {
|
|
*handled = TRUE;
|
|
return PrintStatus(io);
|
|
} else if (McuUtility_strncmp((char*)cmd, (char*)"robo send ", sizeof("robo send ")-1)==0) {
|
|
const unsigned char *p;
|
|
|
|
*handled = TRUE;
|
|
p = cmd+sizeof("robo send ")-1;
|
|
McuShell_SendStr(p, io->stdOut); /* send to standard I/O which is the UART to the robot */
|
|
return ERR_OK;
|
|
} else if (McuUtility_strncmp((char*)cmd, (char*)"robo sendcmd ", sizeof("robo sendcmd ")-1)==0) {
|
|
static uint8_t response[10*1024];
|
|
unsigned char buffer[McuShell_CONFIG_DEFAULT_SHELL_BUFFER_SIZE];
|
|
const unsigned char *p;
|
|
|
|
*handled = TRUE;
|
|
p = cmd+sizeof("robo sendcmd ")-1;
|
|
while (*p==' ') { /* skip leading spaces */
|
|
p++;
|
|
}
|
|
if (*p=='"') { /* double-quoted command: it can contain multiple commands */
|
|
if (McuUtility_ScanDoubleQuotedString(&p, buffer, sizeof(buffer))!=ERR_OK) {
|
|
return ERR_FAILED;
|
|
}
|
|
p = buffer;
|
|
}
|
|
SHELL_SendToRobotAndGetResponse(p, response, sizeof(response));
|
|
McuShell_SendStr(response, io->stdOut); /* show result on console */
|
|
return ERR_OK;
|
|
}
|
|
return ERR_OK;
|
|
}
|
|
#endif /* PL_CONFIG_USE_SHELL */
|
|
|
|
void ROBOT_Deinit(void) {
|
|
/* nothing needed */
|
|
}
|
|
|
|
void ROBOT_Init(void) {
|
|
/* nothing needed */
|
|
}
|
|
#endif /* PL_CONFIG_USE_ROBO_REMOTE */
|
|
|