Index: firmware/App/Services/SystemCommMessages.c =================================================================== diff -u -r8377b4e6ed494cbfc5dfc2bd9ad3c89b85b333cd -r0b87f7e6142dc3710db5c32a0c7c6694343dd717 --- firmware/App/Services/SystemCommMessages.c (.../SystemCommMessages.c) (revision 8377b4e6ed494cbfc5dfc2bd9ad3c89b85b333cd) +++ firmware/App/Services/SystemCommMessages.c (.../SystemCommMessages.c) (revision 0b87f7e6142dc3710db5c32a0c7c6694343dd717) @@ -1399,13 +1399,16 @@ *************************************************************************/ void handleDGOpMode( MESSAGE_T *message ) { - if ( message->hdr.payloadLen == sizeof(U32) ) + U32 payloadSize = sizeof(U32) + sizeof(U32); + + if ( message->hdr.payloadLen == payloadSize ) { - U32 mode; + U32 mode, subMode; memcpy( &mode, message->payload, sizeof(U32) ); + memcpy( &subMode, &message->payload[sizeof(U32)], sizeof(U32) ); - setDGOpMode( mode ); + setDGOpMode( mode, subMode ); } else {