diff --git a/robots/rmcd/pilotConnection.c b/robots/rmcd/pilotConnection.c
index 142966dcc98fa8ac531afdce80db09b52a8b924d..10290f84a5439513df5da83a48acb46c7458973b 100644
--- a/robots/rmcd/pilotConnection.c
+++ b/robots/rmcd/pilotConnection.c
@@ -502,7 +502,8 @@ void pc_plot_waypoint(struct pilot_connection *pc)
 			if (!flipped_bearing) {
 			    flipped_bearing = 1;
 			    /* flip it */
-			    bearing = -bearing;
+			    /* bearing = -bearing; */
+			    bearing = 2.0f * M_PI - bearing;
 			    info("flipped bearing in waypoint gen\n");
 			}
 			else {