Updated go_to method, and some localization and angle calculations to define that the angle is starting in 0 at 12 o'clock and augmenting clockwise. Needed to check the real difference between the angle of the point and the actual tetha of the robot.