uint8_t RNETA_ParseCommand(const unsigned char *cmd, bool *handled, const CLS1_StdIOType *io) {
uint8_t res = ERR_OK;
const uint8_t *p;
uint16_t val16;
if (UTIL1_strcmp((char*)cmd, (char*)CLS1_CMD_HELP)==0 || UTIL1_strcmp((char*)cmd, (char*)"app help")==0) {
PrintHelp(io);
*handled = TRUE;
} else if (UTIL1_strcmp((char*)cmd, (char*)CLS1_CMD_STATUS)==0 || UTIL1_strcmp((char*)cmd, (char*)"app status")==0) {
*handled = TRUE;
return PrintStatus(io);
} else if (UTIL1_strncmp((char*)cmd, (char*)"app saddr", sizeof("app saddr")-1)==0) {
p = cmd + sizeof("app saddr")-1;
*handled = TRUE;
if (UTIL1_ScanHex16uNumber(&p, &val16)==ERR_OK) {
(void)RNWK_SetThisNodeAddr((RNWK_ShortAddrType)val16);
} else {
CLS1_SendStr((unsigned char*)"ERR: wrong address\r\n", io->stdErr);
return ERR_FAILED;
}
} else if (UTIL1_strncmp((char*)cmd, (char*)"app daddr", sizeof("app daddr")-1)==0) {
p = cmd + sizeof("app daddr")-1;
*handled = TRUE;
if (UTIL1_ScanHex16uNumber(&p, &val16)==ERR_OK) {
APP_dstAddr = val16;
} else {
CLS1_SendStr((unsigned char*)"ERR: wrong address\r\n", io->stdErr);
return ERR_FAILED;
}
#if PL_HAS_RSTDIO
} else if (UTIL1_strncmp((char*)cmd, (char*)"app send", sizeof("app send")-1)==0) {
unsigned char buf[32];
RSTDIO_QueueType queue;
if (UTIL1_strncmp((char*)cmd, (char*)"app send in", sizeof("app send in")-1)==0) {
queue = RSTDIO_QUEUE_TX_IN;
cmd += sizeof("app send in");
} else if (UTIL1_strncmp((char*)cmd, (char*)"app send out", sizeof("app send out")-1)==0) {
queue = RSTDIO_QUEUE_TX_OUT;
cmd += sizeof("app send out");
} else if (UTIL1_strncmp((char*)cmd, (char*)"app send err", sizeof("app send err")-1)==0) {
queue = RSTDIO_QUEUE_TX_ERR;
cmd += sizeof("app send err");
} else {
return ERR_OK; /* not handled */
}
UTIL1_strcpy(buf, sizeof(buf), cmd);
UTIL1_chcat(buf, sizeof(buf), '\n');
buf[sizeof(buf)-2] = '\n'; /* have a '\n' in any case */
if (RSTDIO_SendToTxStdio(queue, buf, UTIL1_strlen((char*)buf))!=ERR_OK) {
CLS1_SendStr((unsigned char*)"failed!\r\n", io->stdErr);
}
*handled = TRUE;
#endif
}
return res;
}
byte MPC4728_ParseCommand(const unsigned char *cmd, bool *handled, const CLS1_StdIOType *io) {
const unsigned char *p;
if (UTIL1_strcmp((char*)cmd, CLS1_CMD_HELP)==0 || UTIL1_strcmp((char*)cmd, "MPC4728 help")==0) {
*handled = TRUE;
return PrintHelp(io);
} else if ((UTIL1_strcmp((char*)cmd, CLS1_CMD_STATUS)==0) || (UTIL1_strcmp((char*)cmd, "MPC4728 status")==0)) {
*handled = TRUE;
return PrintStatus(io);
} else if (UTIL1_strcmp((char*)cmd, "MPC4728 reset")==0) {
*handled = TRUE;
if (MPC4728_Reset()!=ERR_OK) {
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strcmp((char*)cmd, "MPC4728 wakeup")==0) {
*handled = TRUE;
if (MPC4728_Wakeup()!=ERR_OK) {
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strcmp((char*)cmd, "MPC4728 update")==0) {
*handled = TRUE;
if (MPC4728_Update()!=ERR_OK) {
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strncmp((char*)cmd, "MPC4728 fastwrite ", sizeof("MPC4728 fastwrite ")-1)==0) {
uint16_t dac[4];
uint8_t pd[4];
int i;
*handled = TRUE;
p = cmd+sizeof("I2CSPY1 fastwrite ")-1;
for(i=0;i<4;i++) { /* init */
dac[i] = 0;
pd[i] = 0;
}
for(i=0;i<4;i++) {
if (UTIL1_ScanHex16uNumber(&p, &dac[i])!=ERR_OK) {
break;
}
dac[i] &= 0xFFF; /* ensure it is 12 bits */
}
if (i!=4) {
CLS1_SendStr((unsigned char*)"**** Not enough values, 4 expected.\r\n", io->stdErr);
return ERR_FAILED;
}
if (MPC4728_FastWrite(dac, sizeof(dac), pd, sizeof(pd))!=ERR_OK) {
CLS1_SendStr((unsigned char*)"**** FastWrite failed.\r\n", io->stdErr);
return ERR_FAILED;
} else {
return ERR_OK;
}
}
return ERR_OK;
}
byte MCP4728_ParseCommand(const unsigned char *cmd, bool *handled, const CLS1_StdIOType *io) {
const unsigned char *p;
if (UTIL1_strcmp((char*)cmd, CLS1_CMD_HELP)==0 || UTIL1_strcmp((char*)cmd, "MCP4728 help")==0) {
*handled = TRUE;
return PrintHelp(io);
} else if ((UTIL1_strcmp((char*)cmd, CLS1_CMD_STATUS)==0) || (UTIL1_strcmp((char*)cmd, "MCP4728 status")==0)) {
*handled = TRUE;
return PrintStatus(io);
} else if (UTIL1_strcmp((char*)cmd, "MCP4728 reset")==0) {
*handled = TRUE;
if (MCP4728_Reset()!=ERR_OK) {
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strcmp((char*)cmd, "MCP4728 wakeup")==0) {
*handled = TRUE;
if (MCP4728_Wakeup()!=ERR_OK) {
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strcmp((char*)cmd, "MCP4728 update")==0) {
*handled = TRUE;
if (MCP4728_Update()!=ERR_OK) {
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strncmp((char*)cmd, "MCP4728 fastwrite all ", sizeof("MCP4728 fastwrite all ")-1)==0) {
uint16_t dac[4];
uint8_t pd[4];
int i;
*handled = TRUE;
p = cmd+sizeof("MCP4728 fastwrite all ")-1;
for(i=0;i<4;i++) { /* init */
dac[i] = 0;
pd[i] = 0;
}
for(i=0;i<4;i++) {
if (UTIL1_ScanHex16uNumber(&p, &dac[i])!=ERR_OK) {
break;
}
dac[i] &= MCP4728_MAX_DAC_VAL; /* ensure it is 12 bits */
}
if (i!=4) {
CLS1_SendStr((unsigned char*)"**** Not enough values, 4 expected!\r\n", io->stdErr);
return ERR_FAILED;
}
if (MCP4728_FastWriteAllDAC(dac, sizeof(dac), pd, sizeof(pd))!=ERR_OK) {
CLS1_SendStr((unsigned char*)"**** FastWrite failed.\r\n", io->stdErr);
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strncmp((char*)cmd, "MCP4728 fastwrite ", sizeof("MCP4728 fastwrite ")-1)==0) {
/* e.g. MCP4728 fastwrite 2 0x512 */
uint16_t dac=0;
uint8_t channel=0;
*handled = TRUE;
p = cmd+sizeof("MCP4728 fastwrite ")-1;
if (UTIL1_ScanDecimal8uNumber(&p, &channel)!=ERR_OK || channel>3) {
CLS1_SendStr((unsigned char*)"**** error parsing channel, must be 0, 1, 2 or 3!\r\n", io->stdErr);
return ERR_FAILED;
}
if (UTIL1_ScanHex16uNumber(&p, &dac)!=ERR_OK || dac>MCP4728_MAX_DAC_VAL) {
CLS1_SendStr((unsigned char*)"**** error parsing 12bit hex value, must start with 0x!\r\n", io->stdErr);
return ERR_FAILED;
}
dac &= MCP4728_MAX_DAC_VAL; /* ensure it is 12 bits */
if (MCP4728_FastWriteDAC(channel, dac)!=ERR_OK) {
CLS1_SendStr((unsigned char*)"**** Write channel DAC failed!\r\n", io->stdErr);
return ERR_FAILED;
} else {
return ERR_OK;
}
} else if (UTIL1_strncmp((char*)cmd, "MCP4728 write ", sizeof("MCP4728 write ")-1)==0) {
uint16_t dac;
uint8_t ch, res;
*handled = TRUE;
res = ERR_OK;
p = cmd+sizeof("MCP4728 write ")-1;
if (UTIL1_ScanDecimal8uNumber(&p, &ch)!=ERR_OK || ch>3) {
CLS1_SendStr((unsigned char*)"**** Failed reading channel. Must be 0, 1, 2 or 3\r\n", io->stdErr);
res = ERR_FAILED;
} else {
if (UTIL1_ScanHex16uNumber(&p, &dac)!=ERR_OK) {
CLS1_SendStr((unsigned char*)"**** Failed DAC value, must start with 0x\r\n", io->stdErr);
res = ERR_FAILED;
} else {
if (MCP4728_WriteDACandEE(ch, dac)!=ERR_OK) {
CLS1_SendStr((unsigned char*)"**** Write failed.\r\n", io->stdErr);
res = ERR_FAILED;
}
}
}
return res;
}
return ERR_OK;
}
uint8_t RNETA_ParseCommand(const unsigned char *cmd, bool *handled, const CLS1_StdIOType *io) {
uint8_t res = ERR_OK;
const uint8_t *p;
uint16_t val16;
uint8_t val8;
if (UTIL1_strcmp((char*)cmd, (char*)CLS1_CMD_HELP)==0 || UTIL1_strcmp((char*)cmd, (char*)"rapp help")==0) {
PrintHelp(io);
*handled = TRUE;
} else if (UTIL1_strcmp((char*)cmd, (char*)CLS1_CMD_STATUS)==0 || UTIL1_strcmp((char*)cmd, (char*)"rapp status")==0) {
*handled = TRUE;
return PrintStatus(io);
} else if (UTIL1_strncmp((char*)cmd, (char*)"rapp saddr", sizeof("rapp saddr")-1)==0) {
p = cmd + sizeof("rapp saddr")-1;
*handled = TRUE;
if (UTIL1_ScanHex16uNumber(&p, &val16)==ERR_OK) {
(void)RNWK_SetThisNodeAddr((RNWK_ShortAddrType)val16);
} else {
CLS1_SendStr((unsigned char*)"ERR: wrong address\r\n", io->stdErr);
return ERR_FAILED;
}
} else if (UTIL1_strncmp((char*)cmd, (char*)"rapp send val", sizeof("rapp send val")-1)==0) {
p = cmd + sizeof("rapp send val")-1;
*handled = TRUE;
if (UTIL1_ScanDecimal8uNumber(&p, &val8)==ERR_OK) {
(void)RAPP_SendPayloadDataBlock(&val8, sizeof(val8), (uint8_t)RAPP_MSG_TYPE_DATA, APP_dstAddr, RPHY_PACKET_FLAGS_NONE); /* only send low byte */
} else {
CLS1_SendStr((unsigned char*)"ERR: wrong number format\r\n", io->stdErr);
return ERR_FAILED;
}
} else if (UTIL1_strncmp((char*)cmd, (char*)"rapp daddr", sizeof("rapp daddr")-1)==0) {
p = cmd + sizeof("rapp daddr")-1;
*handled = TRUE;
if (UTIL1_ScanHex16uNumber(&p, &val16)==ERR_OK) {
APP_dstAddr = val16;
} else {
CLS1_SendStr((unsigned char*)"ERR: wrong address\r\n", io->stdErr);
return ERR_FAILED;
}
#if RNET_CONFIG_REMOTE_STDIO
} else if (UTIL1_strncmp((char*)cmd, (char*)"rapp send", sizeof("rapp send")-1)==0) {
unsigned char buf[32];
RSTDIO_QueueType queue;
if (UTIL1_strncmp((char*)cmd, (char*)"rapp send in", sizeof("rapp send in")-1)==0) {
queue = RSTDIO_QUEUE_TX_IN;
cmd += sizeof("rapp send in");
} else if (UTIL1_strncmp((char*)cmd, (char*)"rapp send out", sizeof("rapp send out")-1)==0) {
queue = RSTDIO_QUEUE_TX_OUT;
cmd += sizeof("rapp send out");
} else if (UTIL1_strncmp((char*)cmd, (char*)"rapp send err", sizeof("rapp send err")-1)==0) {
queue = RSTDIO_QUEUE_TX_ERR;
cmd += sizeof("rapp send err");
} else {
return ERR_OK; /* not handled */
}
UTIL1_strcpy(buf, sizeof(buf), cmd);
UTIL1_chcat(buf, sizeof(buf), '\n');
buf[sizeof(buf)-2] = '\n'; /* have a '\n' in any case */
if (RSTDIO_SendToTxStdio(queue, buf, UTIL1_strlen((char*)buf))!=ERR_OK) {
CLS1_SendStr((unsigned char*)"failed!\r\n", io->stdErr);
}
*handled = TRUE;
#endif
}
return res;
}
