坐标系转换

import math

# 定义原始坐标系中的两个点
A = (2, 3)
B = (5, 7)

# 定义相对角度 heading（以弧度为单位）
heading = -math.pi / 4

# 计算正弦和余弦值
sin_heading = math.sin(abs(heading))
cos_heading = math.cos(abs(heading))

# 根据 heading 的正负号选择加减号
if heading >= 0:
    x_new = (B[0]-A[0]) * cos_heading + (B[1]-A[1]) * sin_heading + A[0]
    y_new = -(B[0]-A[0]) * sin_heading + (B[1]-A[1]) * cos_heading + A[1]
else:
    x_new = (B[0]-A[0]) * cos_heading - (B[1]-A[1]) * sin_heading + A[0]
    y_new = (B[0]-A[0]) * sin_heading + (B[1]-A[1]) * cos_heading + A[1]

# 输出点 B 在新坐标系中的坐标
print("B 在新坐标系中的坐标为：({}, {})".format(x_new, y_new))