Skip to content
Snippets Groups Projects
Commit ed627b59 authored by DAsamhan's avatar DAsamhan
Browse files

fix sensor use previous config

parent c8cf06aa
1 merge request!6Implement main application
...@@ -85,16 +85,19 @@ void MainHandler::MainThread(MainHandler *context){ ...@@ -85,16 +85,19 @@ void MainHandler::MainThread(MainHandler *context){
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(0); configVector.value.push_back(0);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
configVector.number = SERVO; configVector.number = SERVO;
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(0); configVector.value.push_back(0);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
configVector.number = BLUETOOTH; configVector.number = BLUETOOTH;
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(0); configVector.value.push_back(0);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
break; break;
} }
...@@ -105,6 +108,7 @@ void MainHandler::MainThread(MainHandler *context){ ...@@ -105,6 +108,7 @@ void MainHandler::MainThread(MainHandler *context){
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(1); configVector.value.push_back(1);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
break; break;
case USER_1: case USER_1:
...@@ -113,11 +117,13 @@ void MainHandler::MainThread(MainHandler *context){ ...@@ -113,11 +117,13 @@ void MainHandler::MainThread(MainHandler *context){
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(1); configVector.value.push_back(1);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
configVector.number = SERVO; configVector.number = SERVO;
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(0); configVector.value.push_back(0);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
context->currentState = SCANNING; context->currentState = SCANNING;
break; break;
...@@ -128,11 +134,13 @@ void MainHandler::MainThread(MainHandler *context){ ...@@ -128,11 +134,13 @@ void MainHandler::MainThread(MainHandler *context){
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(0); configVector.value.push_back(0);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
configVector.number = SERVO; configVector.number = SERVO;
configVector.type = REQUEST_SET; configVector.type = REQUEST_SET;
configVector.value.push_back(100); configVector.value.push_back(100);
context->DriverRequest(&configVector, &responseVector, K_MSEC(200)); context->DriverRequest(&configVector, &responseVector, K_MSEC(200));
configVector.value.clear();
context->currentState = SCANNING; context->currentState = SCANNING;
break; break;
......
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment