eive/eive-obsw
13
4
Fork 0
Code Issues 4 Pull Requests 1 Releases 121 Wiki Activity

read module config and read hk working

Browse Source
This commit is contained in:
Jakob Meier
2020-12-10 10:01:45 +01:00
parent b8dd7b74cd
commit fa0cdcf399
10 changed files with 84 additions and 52 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
mission/devices/P60DockHandler.cpp
View File

@ -40,19 +40,16 @@ ReturnValue_t P60DockHandler::buildCommandFromCommand(
DeviceCommandId_t deviceCommand, const uint8_t * commandData,
size_t commandDataLen) {
switch(deviceCommand) {
case(PING): {
p60DockCookie->setPingMessage();
break;
}
case(READ_MODULE_CFG):{
p60DockCookie->setReadModuleCfgMessage();
internalState = InternalStates::READ_MODULE_CFG;
this->pstStep = GET_READ;
break;
}
case(READ_HK):{
p60DockCookie->setReadHkMessage();
internalState = InternalStates::READ_HK;
this->pstStep = GET_READ;
break;
}
case(PING): {
break;
}
default:
@ -62,19 +59,25 @@ ReturnValue_t P60DockHandler::buildCommandFromCommand(
}
void P60DockHandler::fillCommandAndReplyMap(){
this->insertInCommandAndReplyMap(PING, 3);
this->insertInCommandAndReplyMap(READ_MODULE_CFG, 3);
this->insertInCommandAndReplyMap(READ_HK, 3);
}
ReturnValue_t P60DockHandler::scanForReply(const uint8_t *start,
size_t remainingSize, DeviceCommandId_t *foundId, size_t *foundLen) {
switch(internalState) {
case(InternalStates::READ_MODULE_CFG): {
MessageType_t messageType = p60DockCookie->getMessageType();
switch(messageType) {
case(PING):
*foundId = PING;
*foundLen = 4;
break;
case(READ_MODULE_CFG): {
*foundId = READ_MODULE_CFG;
*foundLen = moduleCfgTableSize;
break;
}
case(InternalStates::READ_HK): {
case(READ_HK): {
*foundId = READ_HK;
*foundLen = hkTableSize;
break;
@ -82,6 +85,7 @@ ReturnValue_t P60DockHandler::scanForReply(const uint8_t *start,
default:
return IGNORE_REPLY_DATA;
}
p60DockCookie->resetMessageType();
return HasReturnvaluesIF::RETURN_OK;
}