Python三圆交点计算异常：城市噪声雷达定位问题排查

核心问题根源 #

你的核心错误在于破坏了声源到三个麦克风的距离差约束：

• 时差对应的是固定的距离差（$\Delta d = v \times \Delta t$，$v$为声速），因此三个半径间的差值是固定的（比如你示例中$r_1 - r_2 = 2m$，$r_3 - r_2 = 4m$）。
• 你循环给三个半径统一增加0.01m的操作，相当于强制让三个距离的增量相同，但这不符合实际的时差逻辑，导致优化后的三圆无法交于预期点。

修正方案 #

1. 明确约束关系

根据时差确定固定距离差：

• 设首个检测到噪声的麦克风为麦2（对应$r_2$初始为0），则$r_1 = r_2 + \Delta d_{12}$，$r_3 = r_2 + \Delta d_{32}$（$\Delta d_{12}$是麦1与麦2的距离差，$\Delta d_{32}$是麦3与麦2的距离差，由硬件实测时差计算）。
• 你的示例中$\Delta d_{12}=2m$，$\Delta d_{32}=4m$，因此始终保持$r_1 = r_2 + 2$，$r_3 = r_2 + 4$。

2. 重构优化目标函数

将$x$、$y$、$r_2$作为优化变量，构建基于三圆方程的残差函数，用scipy.optimize.least_squares一次求解，无需循环调整半径。

3. 代码修正示例

import numpy as np
from scipy.optimize import least_squares

# 麦克风物理坐标（根据你的硬件实际安装位置修改）
mic1 = np.array([0, 0])    # 麦1坐标
mic2 = np.array([0, 0])    # 麦2坐标（首个检测到噪声的麦克风）
mic3 = np.array([0, 0])    # 麦3坐标

# 固定距离差（由时差×声速计算，示例中为2m和4m）
delta_d12 = 2.0
delta_d32 = 4.0

def residuals(params):
    x, y, r2 = params
    r1 = r2 + delta_d12
    r3 = r2 + delta_d32
    
    # 三圆方程的残差（理想情况下残差应为0）
    res1 = (x - mic1[0])**2 + (y - mic1[1])**2 - r1**2
    res2 = (x - mic2[0])**2 + (y - mic2[1])**2 - r2**2
    res3 = (x - mic3[0])**2 + (y - mic3[1])**2 - r3**2
    
    return [res1, res2, res3]

# 初始猜测（可设为麦2坐标，r2=0）
initial_guess = [mic2[0], mic2[1], 0.0]

# 求解
result = least_squares(residuals, initial_guess)

# 输出结果
print("定位结果：")
print(f"声源坐标(x,y): ({result.x[0]:.2f}, {result.x[1]:.2f})")
print(f"r2: {result.x[2]:.2f}m, r1: {result.x[2]+delta_d12:.2f}m, r3: {result.x[2]+delta_d32:.2f}m")
print(f"最终残差: {np.round(result.fun, 4)}")

额外注意事项 #

• 麦克风坐标准确性：必须精确测量三个麦克风的物理位置，坐标误差会直接导致定位偏差。
• 噪声鲁棒性：实际环境中存在测量噪声，可在残差函数中加入正则项，或使用loss='huber'参数让优化更鲁棒。
• 时差计算精度：确保Arduino端的时差检测精度（比如使用外部中断或高精度定时器），这是距离差计算的基础。

内容的提问来源于stack exchange，提问作者Silvio Junior