Add warning for agents who have been stationary for too long

Author: Grufoony

src/dsm/dsm.hpp

@@ -6,7 +6,7 @@
 
 static constexpr uint8_t DSM_VERSION_MAJOR = 2;
 static constexpr uint8_t DSM_VERSION_MINOR = 6;
-static constexpr uint8_t DSM_VERSION_PATCH = 19;
+static constexpr uint8_t DSM_VERSION_PATCH = 20;
 
 static auto const DSM_VERSION =
     std::format("{}.{}.{}", DSM_VERSION_MAJOR, DSM_VERSION_MINOR, DSM_VERSION_PATCH);

src/dsm/headers/RoadDynamics.hpp

@@ -603,6 +603,23 @@ namespace dsm {
           Logger::debug("Skipping due to time");
           continue;
         }
+        {
+          auto const timeDiff{this->time() - pAgentTemp->freeTime()};
+          if (timeDiff > 120) {
+            Logger::warning(std::format(
+                "Time {} - Agent currently on {} ({} -> {}), targetting {} ({} turn - "
+                "Traffic "
+                "Light? {}), has been still for more than 120 seconds ({} seconds)",
+                this->time(),
+                pStreet->id(),
+                pStreet->source(),
+                pStreet->target(),
+                pAgentTemp->nextStreetId().value_or(-1),
+                directionToString.at(pStreet->laneMapping().at(queueIndex)),
+                this->graph().node(pStreet->target())->isTrafficLight(),
+                timeDiff));
+          }
+        }
         pAgentTemp->setSpeed(0.);
         const auto& destinationNode{this->graph().node(pStreet->target())};
         if (destinationNode->isFull()) {