wip

selfdrive/debug/check_lag.py

@@ -0,0 +1,27 @@
+#!/usr/bin/env python3
+
+import cereal.messaging as messaging
+from cereal.services import SERVICE_LIST
+
+TO_CHECK = ['carState']
+
+
+if __name__ == "__main__":
+  sm = messaging.SubMaster(TO_CHECK)
+
+  prev_t: dict[str, float] = {}
+
+  while True:
+    sm.update()
+
+    for s in TO_CHECK:
+      if sm.updated[s]:
+        t = sm.logMonoTime[s] / 1e9
+
+        if s in prev_t:
+          expected = 1.0 / (SERVICE_LIST[s].frequency)
+          dt = t - prev_t[s]
+          if dt > 10 * expected:
+            print(t, s, dt)
+
+        prev_t[s] = t