def ETMY(QPD1,QPD2):#ETMY
    print("Sensor of ETMY")
    print("     factor of QPD1:",(-1*QPD2[0]/QPD1[0]))#QPD1[0]
    print("     factor of QPD2:",(1))#QPD1[0]
    print("     ITMY:",(-1*QPD2[0]/QPD1[0])*QPD1[0]+QPD2[0])
    print("     ETMY:",(-1*QPD2[0]/QPD1[0])*QPD1[1]+QPD2[1])
    ETMY_factor=(-1*QPD2[0]/QPD1[0])*QPD1[1]+QPD2[1]
    print("     factor of QPD1:",(-1*QPD2[0]/QPD1[0])/ETMY_factor)#QPD1[0]
    print("     factor of QPD2:",(1)/ETMY_factor)#QPD1[0]
    print("     ITMY:",((-1*QPD2[0]/QPD1[0])*QPD1[0]+QPD2[0])/ETMY_factor)
    print("     ETMY:",((-1*QPD2[0]/QPD1[0])*QPD1[1]+QPD2[1])/ETMY_factor)
    return
def ITMY(QPD1,QPD2):#ITMY
    print("Sensor of ITMY")
    print("     factor of QPD1:",(-1*QPD2[1]/QPD1[1]))#QPD1[0]
    print("     factor of QPD2:",(1))#QPD1[0]
    print("     ITMY:",(-1*QPD2[1]/QPD1[1])*QPD1[0]+QPD2[0])
    print("     ETMY:",(-1*QPD2[1]/QPD1[1])*QPD1[1]+QPD2[1])
    ITMY_factor=(-1*QPD2[1]/QPD1[1])*QPD1[0]+QPD2[0]
    print("     factor of QPD1:",(-1*QPD2[1]/QPD1[1])/ITMY_factor)#QPD1[0]
    print("     factor of QPD2:",(1)/ITMY_factor)#QPD1[0]
    print("     ITMY:",((-1*QPD2[1]/QPD1[1])*QPD1[0]+QPD2[0])/ITMY_factor)
    print("     ETMY:",((-1*QPD2[1]/QPD1[1])*QPD1[1]+QPD2[1])/ITMY_factor)
    return


##coherence
#ITMY_P,ITMY_Y,ETMY_P,ETMY_Y
#QPD1=[0.99,0.99,0.999,0.99]
#QPD2=[0.91,0.99,0.999,0.88]
#TF_ASC
#ITMY_P,ITMY_Y,ETMY_P,ETMY_Y
QPD1=[775.671,-1359.92,-1339.92,-1486.03]
QPD2=[-1944.91,2472.84,119.116,911.573]
#QPD2=[0.0376037,0.1278,-0.104595,0]

#PIT
QPD1=[QPD1[0],QPD1[2]]
QPD2=[QPD2[0],QPD2[2]]
print("            ITMY_PIT,ETMY_PIT")
print("QPDA1_PIT:",QPD1)
print("QPDA2_PIT:",QPD2)
ETMY(QPD1,QPD2)
ITMY(QPD1,QPD2)

#YAW
QPD1=[QPD1[1],QPD1[3]]
QPD2=[QPD2[1],QPD2[3]]
print("            ITMY_YAW,ETMY_YAW")
print("QPD1_PIT:",QPD1)
print("QPD2_PIT:",QPD2)
ETMY(QPD1,QPD2)
ITMY(QPD1,QPD2)