tester: cnt_cmd % 16 and simplification

dzid26 · Apr 17, 2024 · 8e70d9a · 8e70d9a
1 parent f3e35b8
commit 8e70d9a
Showing 1 changed file with 3 additions and 8 deletions.
diff --git a/firmware/test/motor_tester.py b/firmware/test/motor_tester.py
@@ -110,16 +110,11 @@ def CAN_tx_thread(p:Panda, bus):
   global _angle
   global _mode
   cnt_cmd = 0
-  dat = steering_msg_cmd_data(cnt_cmd, _mode, _torque, _angle)
-  p.can_send(MSG_STEERING_COMMAND_FRAME_ID, dat, bus)
-
-  t_prev =0
   while True:
-    time.sleep(MOTOR_MSG_TS)
-    cnt_cmd += 1
-    dat = steering_msg_cmd_data(cnt_cmd % 0xF, _mode, _torque, _angle)
+    dat = steering_msg_cmd_data(cnt_cmd, _mode, _torque, _angle)
     p.can_send(MSG_STEERING_COMMAND_FRAME_ID, dat, bus)
-
+    cnt_cmd = (cnt_cmd + 1) % 16
+    time.sleep(MOTOR_MSG_TS)
 
 def CAN_rx_thread(p, bus):
   t_status_msg_prev =0