here is my code and thanks for your help in advance!
double theta, A1, A2, phi, C, A0, L ;
theta = 1;
A0 = 0.7;
L = 0.160;
C = sqrt(A0*A0 + L*L);
phi = atan(A0/L);
//**************************************************************************
if (C*C + L*L -...