Fix: ensure movement and proper servo frequency.

Author: Wilbert Alberts

Raspberry/eclipse/RoverBin/src/main.cpp

@@ -28,9 +28,9 @@ int main(int argc, char* argv[])
 
     RV_loggingOff();
     RV_loopLoggingOff();
-    RV_setFrequency(1);
+    RV_setFrequency(100);
     RV_start();
-    RV_move(RV_FORWARD, RV_FORWARD, 0,0);
+    RV_move(RV_BACKWARD, RV_FORWARD, 20, 70);
     for (int i=0; 1 || i<10000; i++) {
       RV_getPosition(&left, &right);
       //printf("left: %ld, right: %ld\n", left, right);
@@ -39,10 +39,10 @@ int main(int argc, char* argv[])
       //printf("left: %ld, right: %ld, NE: %d, SE: %d, SW: %d, NW: %d\n", 
       // 	     left, right, sig[0], sig[1], sig[2], sig[3]);
 
-      if (mustStop(&collisionSensors)) {
-        RV_move(RV_FORWARD, RV_FORWARD, 0, 0);
-        i=100000;
-      }      
+      //if (mustStop(&collisionSensors)) {
+      //  RV_move(RV_FORWARD, RV_FORWARD, 0, 0);
+      //  i=100000;
+      //}      
 
       RV_getLineSensors(&lineSensors);
       printf("left: %ld, right: %ld, active: N: %d, E: %d, S: %d, W: %d, ambient: N: %d, E: %d, S: %d, W: %d\n",