various syntax fixes
[challenge-bot] / build-stages / g_follow / g_follow.ino
index facaf06c43130a7329bc31dd12a74b40e399b8b1..e9e62503ce4500e197f0648b2ba6e35e21906827 100644 (file)
  */
 
 // define which pins are connected to which components
-int right_motor_speed_pin = 3; // orange wire
-int right_motor_forward_pin = 4; // brown
-int right_motor_backward_pin = 5; // purple
+int right_motor_forward_pin = 3;
+int right_motor_backward_pin = 4;
+int right_motor_speed_pin = 5;
 
-int right_echo_pin = 6; // white
-int right_trigger_pin = 7; // blue
+int right_echo_pin = 6;
+int right_trigger_pin = 7;
 
-int left_motor_speed_pin = 8; // orange
-int left_motor_forward_pin = 9; // brown
-int left_motor_backward_pin = 10; // purple
+int left_motor_forward_pin = 8;
+int left_motor_backward_pin = 9;
+int left_motor_speed_pin = 10;
 
-int left_echo_pin = 11; // white
-int left_trigger_pin = 12; // blue
-
-// 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;
+int left_echo_pin = 11;
+int left_trigger_pin = 12;
 
 void on(int pin){
   digitalWrite(pin, HIGH);}
@@ -118,14 +114,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 +137,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); }