From 5a98bf2e85ccae49a29e1ede9bb7276a0d620e6c Mon Sep 17 00:00:00 2001 From: linyimin <18316471919@139.com> Date: Fri, 26 Dec 2025 14:04:43 +0800 Subject: [PATCH] =?UTF-8?q?pref:=20=E8=AE=A1=E7=AE=97=E7=8E=AF=E6=95=B0?= =?UTF-8?q?=E4=BB=A3=E7=A0=81?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- main.py | 15 +++++++++++++-- 1 file changed, 13 insertions(+), 2 deletions(-) diff --git a/main.py b/main.py index a812796..5c39bfa 100644 --- a/main.py +++ b/main.py @@ -588,7 +588,18 @@ def compute_laser_position(circle_center, laser_point, radius, method): dy = ly - cy return dx / (circle_r / 100.0), -dy / (circle_r / 100.0) - +def compute_laser_position_v2(circle_center, laser_point): + print(f"circle_center : {circle_center}") + cx, cy = circle_center + lx, ly = 320,230 + # lx, ly = laser_point + dx = lx - cx + dy = ly - cy + r = 22.16 * 5 + target_x = dx/r*100 + target_y = dy/r*100 + print(f"lx:{lx} ly: {ly} cx: {cx} cy: {cy} dx: {dx} dy: {dy} result_x: {target_x} result_y: {-target_y}") + return (target_x, -target_y) # ==================== TCP 通信线程 ==================== def connect_server(): @@ -851,7 +862,7 @@ def cmd_str(): disp.show(result_img) # 计算偏移与距离 - dx, dy = compute_laser_position(center, (x, y), radius, method) + dx, dy = compute_laser_position_v2(center, (x, y)) distance_m = estimate_distance(best_radius1) # 读取电量