From a5d0e4d928f86ae3a8f158e19b6917488aa811f2 Mon Sep 17 00:00:00 2001
From: liu <387636706@qq.com>
Date: Fri, 28 Apr 2023 14:04:25 +0800
Subject: [PATCH] V0.2

---
 tcp4.py | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/tcp4.py b/tcp4.py
index b52f2a5..f940e98 100644
--- a/tcp4.py
+++ b/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)