Diff: main.cpp

Revision:

13:d49cb8b52a1e

Parent:

12:01250ea24795

Child:

14:82248fb06e53

--- a/main.cpp	Thu May 05 23:56:48 2016 +0000
+++ b/main.cpp	Fri May 06 00:18:02 2016 +0000
@@ -557,14 +557,14 @@
                     }
                     //deviation left from path
                     if(L.getAngle() - angle_init > 2 || (angle_init > 358 &&  L.getAngle() < 5 && (L.getAngle() + 360 - angle_init) > 2)){
-                        servo_left();
+                        servo_slowleft();
                         serial.printf("Angle Difference: %f\r\n",L.getAngle() - angle_init);
                         while(fmod(abs(L.getAngle() - angle_init),360)> 1);
                         servo_f();                        
                     }
                     //deviation right from path
                     if(angle_init - L.getAngle() > 2 ){
-                        servo_right();
+                        servo_slowright();
                         while(fmod(abs(L.getAngle() - angle_init),360)> 1);
                         servo_f();                        
                     }