Robot code for searching an object and charging at it.

Dependencies:   HCSR04 Motor mbed

Revision:
20:37a89edd1cde
Parent:
19:67ea4e8be9e1
Child:
21:42c0db071a7f
Child:
22:e808fb71847d
diff -r 67ea4e8be9e1 -r 37a89edd1cde functions.cpp
--- a/functions.cpp	Sat May 30 19:08:26 2015 +0000
+++ b/functions.cpp	Sun Jun 07 14:18:00 2015 +0000
@@ -151,7 +151,6 @@
     int fwd_bck;
     int fwd;
     float random_time;
-    float random_speed;
 
     printf("Moving randomly\n");
     counter = rand() % 5;
@@ -161,15 +160,6 @@
         random_time = rand() % 1000 + 1000;
 
         fwd_bck = rand()%2;
-        //random_speed = (float)rand()/(float)(RAND_MAX);
-        
-        //if (random_speed < 0.6) {
-            //random_speed = 0.5;
-        //} else if (random_speed >= 0.8) {
-            //random_speed = 0.8;
-        //}
-        
-        random_speed = 0.5;
         
         // If fwd_back == 1 move forward or backwards
         if (fwd_bck == 1) {
@@ -177,16 +167,16 @@
             // If fwd == 1 move forward
             if  (fwd == 1) { 
                 printf("Moving forward\n");
-                move_detect(random_speed, fwd_bck, random_time);
+                move_detect(move_forwardspeed, fwd_bck, random_time);
             // If fwd == 0 move bacward
             } else {
                 printf("Moving bacwards\n");
-                move_detect(-random_speed, fwd_bck, random_time);
+                move_detect(-move_forwardspeed, fwd_bck, random_time);
             }   
         // Turn
         } else {
             printf("Turning\n");
-            move_detect(random_speed, fwd_bck, random_time);
+            move_detect(move_forwardspeed, fwd_bck, random_time);
         }
     }
 }
@@ -260,14 +250,14 @@
         if(detect == 1) {
             stop();
             turn_leds_on();
-            move_detect(-0.5,1,1000);
+            move_detect(-move_forwardspeed,1,1000);
             stop();
             break;
         // If line is detected from back just keep on moving forward
         } else if (detect == -1) {
             stop();
             turn_leds_on();
-            move_detect(0.5,1,1000);
+            move_detect(move_forwardspeed,1,1000);
             stop();
             break;
         }