Added uncertainty estimates to the main
Added test for uncertainty estimates
Changed the vector math to use atan2, which determines the correct quadrant for the angle
added printout of degrees to the main.cpp, for human readability