(* ::Package:: *)

A1=15600;
B1=7540;
C1=20140;
A2=18760;
B2=2750;
C2=18610;
A3=17610;
B3=14630;
C3=13480;
A4=19170;
B4=610;
C4=18390;
t1=0.07074;
t2=0.07220;
t3=0.07690;
t4=0.07242;
c=299792.458;

ux=[2*A2-2*A1;2*A3-2*A1;2*A4-2*A1];
uy=[2*B2-2*B1;2*B3-2*B1;2*B4-2*B1];
uz=[2*C2-2*C1;2*C3-2*C1;2*C4-2*C1];
ud=[2*t1*c^2-2*t2*c^2;2*t1*c^2-2*t3*c^2;2*t1*c^2-2*t4*c^2];
w=[A1^2-A2^2+-B2^2+B1^2+-C2^2+C1^2+-c^2*t1^2+c^2*t2^2;-A3^2+A1^2-B3^2+B1^2-C3^2+C1^2+-c^2*t1^2+c^2*t3^2;-A4^2+A1^2+-B4^2+B1^2+-C4^2+C1^2+-c^2*t1^2+c^2*t4^2];

e=det([uy uz ud]);
f=det([uy uz w]);
g=det([uy uz ux]);

h=det([uz ux ud]);
q=det([uz ux w]);
j=det([uy uz ux]);
j=g;

k=det([ux uy ud]);
m=det([ux uy w]);
n=det([uy uz ux]);
n=g;




suma=(e^2+h^2+k^2)/(g^2)-(c^2);
sumb=((2*A1*e)+(2*B1*h)+(2*C1*k))/g+((2*e*f)+(2*h*q)+(2*k*m))/g^2+(2*c^2*t1);
sumc=A1^2+((2*A1*f)+(2*B1*q)+(2*C1*m))/g+(f^2+q^2+m^2)/(g^2)+B1^2+C1^2-(c^2*t1^2);
d1=(-sumb+sqrt(sumb^2-4*suma*sumc))/(2*suma);
d2=(-sumb-sqrt(sumb^2-4*suma*sumc))/(2*suma);

d=[d1 d2]

x= (-d*e-f)/g;
y= (-d*h-q)/g;
z= (-d*k-m)/g;

CurrrentLocation=[x; y; z]
