byte BL_ParseCommand(const unsigned char *cmd, bool *handled, CLS1_ConstStdIOType *io) {
if (UTIL1_strcmp((char*)cmd, CLS1_CMD_HELP)==0 || UTIL1_strcmp((char*)cmd, "BL help")==0) {
BL_PrintHelp(io);
*handled = TRUE;
return ERR_OK;
} else if ((UTIL1_strcmp((char*)cmd, CLS1_CMD_STATUS)==0) || (UTIL1_strcmp((char*)cmd, "BL status")==0)) {
BL_PrintStatus(io);
*handled = TRUE;
return ERR_OK;
} else if ((UTIL1_strcmp((char*)cmd, "BL erase")==0)) {
*handled = TRUE;
return BL_EraseAppFlash(io);
} else if ((UTIL1_strcmp((char*)cmd, "BL restart")==0)) {
#if 0
uint32_t startup;
*handled = TRUE;
startup = ((uint32_t*)BL_FLASH_VECTOR_TABLE)[1];
((void(*)(void))startup)(); /* Jump to startup code */
#else
KIN1_SoftwareReset();
#endif
/* will never get here! */
return ERR_OK;
} else if ((UTIL1_strcmp((char*)cmd, "BL load s19")==0)) {
*handled = TRUE;
return BL_LoadS19(io);
}
return ERR_OK; /* no error */
}
byte BL_ParseCommand(const unsigned char *cmd, bool *handled, CLS1_ConstStdIOType *io) {
if (UTIL1_strcmp((char*)cmd, CLS1_CMD_HELP)==0 || UTIL1_strcmp((char*)cmd, "BL help")==0) {
BL_PrintHelp(io);
*handled = TRUE;
return ERR_OK;
} else if ((UTIL1_strcmp((char*)cmd, CLS1_CMD_STATUS)==0) || (UTIL1_strcmp((char*)cmd, "BL status")==0)) {
BL_PrintStatus(io);
*handled = TRUE;
return ERR_OK;
} else if ((UTIL1_strcmp((char*)cmd, "BL erase")==0)) {
*handled = TRUE;
return BL_EraseAppFlash(io);
} else if ((UTIL1_strcmp((char*)cmd, "BL restart")==0)) {
KIN1_SoftwareReset();
/* will never get here! */
return ERR_OK;
} else if ((UTIL1_strcmp((char*)cmd, "BL load s19")==0)) {
*handled = TRUE;
return BL_LoadS19(io);
}
return ERR_OK; /* no error */
}
static uint8_t BL_LoadS19(CLS1_ConstStdIOType *io) {
unsigned char buf[16];
uint8_t res = ERR_OK;
/* first, erase flash */
if (BL_EraseAppFlash(io)!=ERR_OK) {
return ERR_FAILED;
}
/* load S19 file */
CLS1_SendStr((unsigned char*)"Waiting for the S19 file...", io->stdOut);
parserInfo.GetCharIterator = GetChar;
parserInfo.voidP = (void*)io;
parserInfo.S19Flash = BL_onS19Flash;
parserInfo.status = S19_FILE_STATUS_NOT_STARTED;
parserInfo.currType = 0;
parserInfo.currAddress = 0;
parserInfo.codeSize = 0;
parserInfo.codeBuf = codeBuf;
parserInfo.codeBufSize = sizeof(codeBuf);
while (AS1_GetCharsInRxBuf()>0) { /* clear any pending characters in rx buffer */
AS1_ClearRxBuf();
WAIT1_Waitms(100);
}
do {
if (S19_ParseLine(&parserInfo)!=ERR_OK) {
CLS1_SendStr((unsigned char*)"ERROR!\r\nFailed at address 0x", io->stdErr);
buf[0] = '\0';
UTIL1_strcatNum32Hex(buf, sizeof(buf), parserInfo.currAddress);
CLS1_SendStr(buf, io->stdErr);
CLS1_SendStr((unsigned char*)"\r\n", io->stdErr);
res = ERR_FAILED;
break;
} else {
CLS1_SendStr((unsigned char*)"\r\nS", io->stdOut);
buf[0] = parserInfo.currType;
buf[1] = '\0';
CLS1_SendStr(buf, io->stdOut);
CLS1_SendStr((unsigned char*)" address 0x", io->stdOut);
buf[0] = '\0';
UTIL1_strcatNum32Hex(buf, sizeof(buf), parserInfo.currAddress);
CLS1_SendStr(buf, io->stdOut);
}
if (parserInfo.currType=='7' || parserInfo.currType=='8' || parserInfo.currType=='9') {
/* end of records */
break;
}
} while (1);
if (res==ERR_OK) {
CLS1_SendStr((unsigned char*)"\r\ndone!\r\n", io->stdOut);
} else {
while (AS1_GetCharsInRxBuf()>0) {/* clear buffer */
AS1_ClearRxBuf();
WAIT1_Waitms(100);
}
CLS1_SendStr((unsigned char*)"\r\nfailed!\r\n", io->stdOut);
/* erase flash again to be sure we do not have illegal application image */
if (BL_EraseAppFlash(io)!=ERR_OK) {
res = ERR_FAILED;
}
}
return res;
}
