数据机房人员定位

import numpy as np

def calculate_distance(rssi, tx_power, n_value):
    """计算距离"""
    return 10 ** ((tx_power - rssi) / (10 * n_value))

def trilateration(locations, distances):
    """三边测量法确定位置"""
    A = 2 * (locations[1][0] - locations[0][0])
    B = 2 * (locations[1][1] - locations[0][1])
    C = distances[0]**2 - distances[1]**2 + locations[1][0]**2 - locations[0][0]**2 + locations[1][1]**2 - locations[0][1]**2
    D = 2 * (locations[2][0] - locations[1][0])
    E = 2 * (locations[2][1] - locations[1][1])
    F = distances[1]**2 - distances[2]**2 + locations[2][0]**2 - locations[1][0]**2 + locations[2][1]**2 - locations[1][1]**2
    
    x = (C*E - F*B) / (E*A - B*D)
    y = (C*D - A*F) / (B*D - A*E)
    
    return x, y

# 示例数据
wifi_access_points = [(0, 0), (5, 0), (0, 5)]
rssi_values = [-50, -60, -70]
tx_power = -30
n_value = 2

distances = [calculate_distance(rssi, tx_power, n_value) for rssi in rssi_values]
position = trilateration(wifi_access_points, distances)

print(f"Estimated Position: {position}")