diff --git a/debug-app/module/handler/main-handler/src/main-handler.cpp b/debug-app/module/handler/main-handler/src/main-handler.cpp index 8f7248bc6b5353e28e1c9c130b16ba282fa4acb7..d05d0408f0d26fbd896067439362da64c0c83f90 100644 --- a/debug-app/module/handler/main-handler/src/main-handler.cpp +++ b/debug-app/module/handler/main-handler/src/main-handler.cpp @@ -85,16 +85,19 @@ void MainHandler::MainThread(MainHandler *context){ configVector.type = REQUEST_SET; configVector.value.push_back(0); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); configVector.number = SERVO; configVector.type = REQUEST_SET; configVector.value.push_back(0); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); configVector.number = BLUETOOTH; configVector.type = REQUEST_SET; configVector.value.push_back(0); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); break; } @@ -105,6 +108,7 @@ void MainHandler::MainThread(MainHandler *context){ configVector.type = REQUEST_SET; configVector.value.push_back(1); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); break; case USER_1: @@ -113,11 +117,13 @@ void MainHandler::MainThread(MainHandler *context){ configVector.type = REQUEST_SET; configVector.value.push_back(1); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); configVector.number = SERVO; configVector.type = REQUEST_SET; configVector.value.push_back(0); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); context->currentState = SCANNING; break; @@ -128,11 +134,13 @@ void MainHandler::MainThread(MainHandler *context){ configVector.type = REQUEST_SET; configVector.value.push_back(0); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); configVector.number = SERVO; configVector.type = REQUEST_SET; configVector.value.push_back(100); context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); + configVector.value.clear(); context->currentState = SCANNING; break;