#ITMY_P,ITMY_Y,ETMY_P,ETMY_Y
WFS1_17=[686.349,-983.19,-1284.18,-1274.39]
WFS1_45=[975.513,-1356.06,-1636.12,-1734.94]
WFS2_17=[-1632.88,1473.49,246.23,400.167]
WFS2_45=[-1949.31,1651.52,283.14,418.658]

def ETMY(WFS1,WFS2):#ETMY
    print("Sensor of ETMY")
    print("     factor of WFS1:",(-1*WFS2[0]/WFS1[0]))#WFS1[0]
    print("     ITMY:",(-1*WFS2[0]/WFS1[0])*WFS1[0]+WFS2[0])
    print("     ETMY:",(-1*WFS2[0]/WFS1[0])*WFS1[1]+WFS2[1])
    return
def ITMY(WFS,WFS2):#ITMY
    print("Sensor of ITMY")
    print("     factor of WFS1:",(-1*WFS2[1]/WFS1[1]))#WFS1[0]
    print("     ITMY:",(-1*WFS2[1]/WFS1[1])*WFS1[0]+WFS2[0])
    print("     ETMY:",(-1*WFS2[1]/WFS1[1])*WFS1[1]+WFS2[1])
    return


#PIT
WFS1=[WFS1_17[0],WFS1_17[2]]
WFS2=[WFS2_17[0],WFS2_17[2]]
print("            ITMY_P,ETMY_P")
print("WFS1_17_PIT:",WFS1)
print("WFS2_17_PIT:",WFS2)
#PIT
WFS1=[WFS1_45[0],WFS1_45[2]]
WFS2=[WFS2_45[0],WFS2_45[2]]
#print("            ITMY_P,ETMY_P")
print("WFS1_45_PIT:",WFS1)
print("WFS2_45_PIT:",WFS2)
WFS1=[WFS1_17[1],WFS1_17[3]]
WFS2=[WFS2_17[1],WFS2_17[3]]
print("            ITMY_YAW,ETMY_YAW")
print("WFS1_17_YAW:",WFS1)
print("WFS2_17_YAW:",WFS2)

WFS1=[WFS1_45[1],WFS1_45[3]]
WFS2=[WFS2_45[1],WFS2_45[3]]
#print("            ITMY_YAW,ETMY_YAW")
print("WFS1_45_YAW:",WFS1)
print("WFS2_45_YAW:",WFS2)



WFS1=[WFS1_17[0],WFS1_17[2]]
WFS2=[WFS2_17[0],WFS2_17[2]]
print("PIT")
ETMY(WFS1,WFS2)
ITMY(WFS1,WFS2)
WFS1=[WFS1_17[1],WFS1_17[3]]
WFS2=[WFS2_17[1],WFS2_17[3]]
print("YAW")
ETMY(WFS1,WFS2)
ITMY(WFS1,WFS2)