Python 三维坐标反算代码 - 计算点坐标

以下是一个使用 Python 编写的三维坐标反算代码：

import math

def calculate_distance(x1, y1, z1, x2, y2, z2):
    return math.sqrt((x2 - x1) ** 2 + (y2 - y1) ** 2 + (z2 - z1) ** 2)

def calculate_angle(x1, y1, z1, x2, y2, z2):
    dot_product = x1 * x2 + y1 * y2 + z1 * z2
    magnitude_1 = math.sqrt(x1 ** 2 + y1 ** 2 + z1 ** 2)
    magnitude_2 = math.sqrt(x2 ** 2 + y2 ** 2 + z2 ** 2)
    return math.degrees(math.acos(dot_product / (magnitude_1 * magnitude_2)))

def calculate_coordinates(distance_AB, angle_ACD, angle_BCX, angle_ACB):
    x = - distance_AB * math.sin(math.radians(angle_BCX))
    y = distance_AB * math.cos(math.radians(angle_BCX)) * math.sin(math.radians(angle_ACB))
    z = distance_AB * math.cos(math.radians(angle_BCX)) * math.cos(math.radians(angle_ACB))
    return (x, y, z)

# Example usage
distance_AB = 5
angle_ACD = 30
angle_BCX = 60
angle_ACB = 45

# Calculate coordinates of point C
distance_CD = distance_AB * math.sin(math.radians(angle_ACD))
distance_AD = distance_AB * math.cos(math.radians(angle_ACD))
distance_AC = calculate_distance(0, 0, 0, distance_AD, 0, distance_CD)
angle_ACB_rad = math.atan(distance_CD / distance_AD)
angle_ACB_deg = math.degrees(angle_ACB_rad)
coordinates_C = calculate_coordinates(distance_AC, angle_ACD, angle_BCX, angle_ACB_deg)
print('Coordinates of point C: ', coordinates_C)

# Calculate coordinates of point D
angle_BCD_rad = math.radians(180 - angle_ACB - angle_ACB)
angle_BCD_deg = math.degrees(angle_BCD_rad)
coordinates_D = calculate_coordinates(distance_CD, angle_BCD_deg, angle_BCX, angle_ACB)
print('Coordinates of point D: ', coordinates_D)

此代码假设您已经知道以下内容：

• AB线段的长度
• ACD角度
• BCX角度
• ACB角度

它使用三角函数和向量运算来计算C点和D点的坐标。