fixes in imqt
This commit is contained in:
@ -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:
|
||||
|
Reference in New Issue
Block a user