V0.2

tcp4.py

@@ -65,7 +65,9 @@ def zuo_biao():
         # heading_qual = beidou[11]  # GNSS定向质量指示符 0 = 定位不可用或无效 1 = 单点定位 2 = RTK 浮点解 3 = RTK 固定解
         # solnsvsh = beidou[12]  # 前天线使用卫星数 前天线当前参与解算的卫星数量
         # solnsvsb = beidou[13]  # 后天线使用卫星数 前天线当前参与解算的卫星数量
-
+        if abs(x_car-float(east))>10 or abs(y_car-float(north))>10:
+            x_car=float(east)
+            y_car=float(north)
         east = beidou[14]  # 东向位置坐标：以基站为原点的地理坐标系下的东向位置，单位：米，小数点后 3 位
         x_car = np.cos(yaw) * 2.3 + float(east)
         x_car = round(x_car, 3)