fixes in imqt

This commit is contained in:
2021-03-29 16:40:14 +02:00
parent be9d11afff
commit eee73f46c5
4 changed files with 7 additions and 4 deletions

View File

@ -18,7 +18,8 @@ IMTQHandler::~IMTQHandler() {
void IMTQHandler::doStartUp(){
if(mode == _MODE_START_UP){
setMode(MODE_ON);
//TODO: Set to MODE_ON again
setMode(MODE_NORMAL);
}
}
@ -44,6 +45,7 @@ ReturnValue_t IMTQHandler::buildCommandFromCommand(
case(IMTQ::GET_ENG_HK_DATA): {
commandBuffer[0] = IMTQ::CC::GET_ENG_HK_DATA;
rawPacket = commandBuffer;
rawPacketLen = 1;
return RETURN_OK;
}
case(IMTQ::START_ACTUATION_DIPOLE): {
@ -58,6 +60,7 @@ ReturnValue_t IMTQHandler::buildCommandFromCommand(
commandBuffer[7] = *(commandData + 7);
commandBuffer[8] = *(commandData + 6);
rawPacket = commandBuffer;
rawPacketLen = 9;
return RETURN_OK;
}
default: