3D Trigonometry problem