rebase master

Author: deanlee

selfdrive/boardd/boardd.cc

@@ -9,9 +9,11 @@
 #include <bitset>
 #include <cassert>
 #include <cerrno>
+#include <chrono>
 #include <cstdint>
 #include <cstdio>
 #include <cstdlib>
+#include <future>
 #include <thread>
 #include <unordered_map>
 
@@ -35,12 +37,13 @@
 #define SATURATE_IL 1600
 #define NIBBLE_TO_HEX(n) ((n) < 10 ? (n) + '0' : ((n) - 10) + 'a')
 
-std::atomic<bool> safety_setter_thread_running(false);
 std::atomic<bool> ignition(false);
 
 ExitHandler do_exit;
 
-void safety_setter_thread(Panda *panda) {
+using namespace std::chrono_literals;
+
+bool safety_setter_thread(Panda *panda) {
   LOGD("Starting safety setter thread");
   // diagnostic only is the default, needed for VIN query
   panda->set_safety_model(cereal::CarParams::SafetyModel::ELM327);
@@ -50,8 +53,7 @@ void safety_setter_thread(Panda *panda) {
   // switch to SILENT when CarVin param is read
   while (true) {
     if (do_exit || !panda->connected) {
-      safety_setter_thread_running = false;
-      return;
+      return false;
     };
 
     std::string value_vin = p.get("CarVin");
@@ -71,8 +73,7 @@ void safety_setter_thread(Panda *panda) {
   LOGW("waiting for params to set safety model");
   while (true) {
     if (do_exit || !panda->connected) {
-      safety_setter_thread_running = false;
-      return;
+      return false;
     };
 
     if (p.getBool("ControlsReady")) {
@@ -94,8 +95,7 @@ void safety_setter_thread(Panda *panda) {
   LOGW("setting safety model: %d with param %d", (int)safety_model, safety_param);
 
   panda->set_safety_model(safety_model, safety_param);
-
-  safety_setter_thread_running = false;
+  return true;
 }
 
 
@@ -265,6 +265,7 @@ void panda_state_thread(Panda *&panda, bool spoofing_started) {
     util::sleep_for(500);
   }
 
+  std::future<bool> safety_future;
   // run at 2hz
   while (!do_exit && panda->connected) {
     health_t pandaState = panda->get_state();
@@ -301,10 +302,8 @@ void panda_state_thread(Panda *&panda, bool spoofing_started) {
     // clear VIN, CarParams, and set new safety on car start
     if (ignition && !ignition_last) {
       params.clearAll(CLEAR_ON_IGNITION_ON);
-
-      if (!safety_setter_thread_running) {
-        safety_setter_thread_running = true;
-        std::thread(safety_setter_thread, panda).detach();
+      if (!safety_future.valid() || safety_future.wait_for(0ms) == std::future_status::ready) {
+        safety_future = std::async(std::launch::async, safety_setter_thread, panda);
       } else {
         LOGW("Safety setter thread already running");
       }