created simple waypoint-follower program--no PID
added precise angle functions