diff --git a/controller_teensy/src/main.cpp b/controller_teensy/src/main.cpp index 9a0bbb9..6b456aa 100644 --- a/controller_teensy/src/main.cpp +++ b/controller_teensy/src/main.cpp @@ -437,7 +437,7 @@ void failChecks() { controllerFront_connected=false; writeLogComment(Serial1,loopmillis, "Controller Front feedback timeout"); } - }else if(!controllerFront_connected) { //not timeouted but was before + }else if(!controllerFront_connected && loopmillis > FEEDBACKRECEIVETIMEOUT) { //not timeouted but was before controllerFront_connected=true; writeLogComment(Serial1,loopmillis, "Controller Front connected"); } @@ -447,7 +447,7 @@ void failChecks() { controllerRear_connected=false; writeLogComment(Serial1,loopmillis, "Controller Rear feedback timeout"); } - }else if(!controllerRear_connected) { //not timeouted but was before + }else if(!controllerRear_connected && loopmillis > FEEDBACKRECEIVETIMEOUT) { //not timeouted but was before controllerRear_connected=true; writeLogComment(Serial1,loopmillis, "Controller Rear connected"); }