function [ out,N1,N2,D ] = f3( theta ) x1=5; x2=0; y2=6; L1=3; L3=3; L2=3*sqrt(2); gamma=pi/4; p1=5; p2=7.0000007; p3=3; A2=L3*cos(theta)-x1; B2=L3*sin(theta); A3=L2*cos(theta+gamma)-x2; B3=L2*sin(theta+gamma)-y2; N1=B3*(p2^2-p1^2-A2^2-B2^2)-B2*(p3^2-p1^2-A3^2-B3^2); N2=-A3*(p2^2-p1^2-A2^2-B2^2)+A2*(p3^2-p1^2-A3^2-B3^2); D=2*(A2*B3-B2*A3); out=N1^2+N2^2-p1^2*D^2; end