GPS取得が成功したときのみカウントするように改良

LYNCS-Keio · Jul 15, 2019 · c15f6ea · c15f6ea
1 parent cb75461
commit c15f6ea
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/raspberry_pi/gps_homing.py b/raspberry_pi/gps_homing.py
@@ -54,8 +54,8 @@ def cal_average(x):
     svL.rotate(dutyL)
     svR.rotate(dutyR)
 
-now = [None, None]
 for i in range(5):
+    now = [None, None]
     while now is None:
         now = GPS.lat_long_measurement()
     position_memo.put(GPS.convert_lat_long_to_r_theta(pre[0], pre[1], now[0], now[1]))
@@ -77,6 +77,7 @@ def cal_average(x):
 #goalとの距離が10m以下になったら画像での誘導
 while to_goal[0] > cam_dis:
 
+    now = [None, None]
     now = GPS.lat_long_measurement()
     if now[0] != None or now[1] != None: