Fixed some navigation calculations - angle to target