added handling of pid error response

socs/agents/hwp_pid/agent.py

@@ -28,9 +28,14 @@ def parse_action_result(res):
         return {'result': res}
 
 
-def get_pid_state(pid: pd.PID):
+def get_pid_state(pid: pd.PID, num_attempts: int = 3):
+    for _ in range(num_attempts):
+        freq = pid.get_freq()
+        if freq != 9.999:
+            break
+        time.sleep(1)
     return {
-        "current_freq": pid.get_freq(),
+        "current_freq": freq,
         "target_freq": pid.get_target(),
         "direction": pid.get_direction(),
     }

socs/agents/hwp_pid/drivers/pid_controller.py

@@ -536,7 +536,7 @@ def _decode_measure(string):
             measure_type = end_string[1:3]
         else:
             measure_type = '00'
-        if measure_type == '01':
+        if measure_type == '01' and end_string[3:] != '?+9999.':
             return float(end_string[3:])
         else:
             return 9.999