Updated control constants to perform better on bare metal

src/cs4313_utilities/robot.py

@@ -102,8 +102,8 @@ class SimpleRobot(object):
 
 
     def setControlConstants(self, newCaptureDist=1.5, newMaxXDot=1.0, \
-                            newMaxThetaDot=0.77, newXCmdC1=2.0, newXCmdC2=1.0, \
-                            newPDThetaC1=3.0, newPDThetaC2=1.0):
+                            newMaxThetaDot=0.52, newXCmdC1=2.0, newXCmdC2=1.25, \
+                            newPDThetaC1=2.2, newPDThetaC2=1.0):
         '''Used to change the vehicle control constants from the default value 
         (ensures value validity as well)
         @param newCaptureDist: updated distance to consider a waypoint "achieved"