Debug & trigonometric verification

Now working