Update wheeledbase.py

Author: LeProblemeEDMN

raspberrypi/daughter_cards/wheeledbase.py

@@ -342,6 +342,8 @@ def goto_stop(self, x, y,sensors, theta=None, direction=None, finalangle=None, l
 
         # Get the setpoint orientation
         if theta is not None:
+            if(theta<0):
+                theta+=2*math.pi
             rPos=self.get_position()
             radiusRobot=370
             ang=rPos[2]%(2*math.pi)