Correct gpsNav function to compute distance to point Angle is working for 270° to 90°
Correct gpsNav function to compute distance to point
Angle is working for 270° to 90°

Signed-off-by: TeaPackCZ <a78d8486eff6e2cb08b2d9907449b92187b8e215@gmail.com>

TeaPackCZ/RobotZed,TeaPackCZ/RobotZed