remove unused backup and turn_around in follow
[challenge-bot] / build-stages / g_follow / g_follow.ino
index 3c01a4d7cf0c2c3282d927d9f853978b220a8d87..6588dd6ef19702fa0b22ae04d0f4fa0a5841a5fb 100644 (file)
@@ -28,10 +28,6 @@ int left_motor_speed_pin = 10;
 int left_echo_pin = 11;
 int left_trigger_pin = 12;
 
-// you'll need to adjust these based on your sonar sensor's behavior
-int desired_right_ping_time = 800;
-int desired_left_ping_time = 800;
-
 void on(int pin){
   digitalWrite(pin, HIGH);}
 
@@ -85,14 +81,6 @@ int ping(int trigger, int echo){
   delay(50);
   return ping_time;}
 
-void backup(int backup_time){
-  go(-250, -250);
-  delay(backup_time);}
-
-void turn_around(int turn_around_time){
-  go(-250, 250);
-  delay(turn_around_time);}
-
 void setup(){
   Serial.begin(9600);
 
@@ -118,14 +106,15 @@ void setup(){
   off(right_motor_speed_pin);
   off(right_motor_forward_pin);
   off(right_motor_backward_pin);
-  off(right_trigger_pin);}
+  off(right_trigger_pin); }
 
-void loop(){
+void loop() {
   int left_speed;
   int right_speed;
 
-  int forward_speed = 250;
-  int stop_speed = 0;
+  // you'll need to adjust these based on your sonar sensor's behavior
+  int desired_right_ping_time = 800;
+  int desired_left_ping_time = 800;
 
   unsigned int actual_left_ping_time = ping(left_trigger_pin, left_echo_pin);
   unsigned int actual_right_ping_time = ping(right_trigger_pin, right_echo_pin);
@@ -140,6 +129,7 @@ void loop(){
   Serial.print(" right: ping = ");
   Serial.print(actual_right_ping_time);
   Serial.print(" speed = ");
-  Serial.println(right_speed);
+  Serial.print(right_speed);
+  Serial.println();
 
-  go(left_speed, right_speed);}
+  go(left_speed, right_speed); }