IMTQ dipole actuation command, wip

This commit is contained in:
2021-03-19 15:33:43 +01:00
parent c3a3394c8a
commit 6ec4d22a14
2 changed files with 34 additions and 10 deletions

View File

@ -47,9 +47,16 @@ ReturnValue_t IMTQHandler::buildCommandFromCommand(
return RETURN_OK;
}
case(IMTQ::START_ACTUATION_DIPOLE): {
/* IMTQ expects low byte first */
commandBuffer[0] = IMTQ::CC::START_ACTUATION_DIPOLE;
commandBuffer[1] = *(commandData + 1);
commandBuffer[2] = *(commandData + 2);
commandBuffer[2] = *(commandData);
commandBuffer[3] = *(commandData + 3);
commandBuffer[4] = *(commandData + 2);
commandBuffer[5] = *(commandData + 5);
commandBuffer[6] = *(commandData + 4);
commandBuffer[7] = *(commandData + 7);
commandBuffer[8] = *(commandData + 6);
rawPacket = commandBuffer;
return RETURN_OK;
}