Fixed issue with -ve angles using atan function
Removed print line from testing