update 增加速度设置，点位比对，启动警报等

2024-12-05 20:29:27 +08:00
parent a884e241d3
commit 6f22ef051a
10 changed files with 795 additions and 640 deletions
--- a/Util/util_math.py
+++ b/Util/util_math.py
@ -8,4 +8,7 @@ def get_distance(p1, p2):
    :param p2:
    :return:
    """
-    return math.sqrt((p1.X - p2.X) ** 2 + (p1.Y - p2.Y) ** 2+ (p1.Z - p2.Z)**2)
+    return math.sqrt((p1.X - p2.X) ** 2 + (p1.Y - p2.Y) ** 2+ (p1.Z - p2.Z)**2)
+
+def is_bit_set(n, position):
+    return (n >> position) & 1 == 1