TOA__Python————带数据集

import math
import pandas as pd
import math
import matplotlib.pyplot as plt
import numpy as np
from scipy.spatial.transform import Rotation as Rot

show_animation = True

def toa_():
        for i in range(10):
            xls_name = 'TOA.xlsx'
            # pandas读取表格内容保存至data
            data = pd.read_excel(xls_name)

            X1 = 0  # 坐标数据值
            Y1 = 0
            X2 = 160
            Y2 = 0
            X3 = 0
            Y3 = 80

            D1 = data.values[i][9]
            D2 = data.values[i][10]
            D3 = data.values[i][11]

            # 将((-2)*X1+2*X2)定义为A
            A = (-2) * X1 + 2 * X2
            # 将((-2)*Y1+2*Y2)定义为B
            B = (-2) * Y1 + 2 * Y2
            # 将D1^2-D2^2-X1^2+X2^2-Y1^2+Y2^2定义为C
            C = D1 ** 2 - D2 ** 2 - X1 ** 2 + X2 ** 2 - Y1 ** 2 + Y2 ** 2
            # 将((-2)*X2+2*X3)定义为D
            D = (-2) * X2 + 2