GPS and RW handler improvements

mission/devices/RwHandler.cpp

@@ -184,6 +184,7 @@ ReturnValue_t RwHandler::scanForReply(const uint8_t *start, size_t remainingSize
     default: {
         sif::warning << "RwHandler::scanForReply: Reply contains invalid command code" <<
                 std::endl;
+        *foundLen = remainingSize;
         return RETURN_FAILED;
     }
     }