*/
// define which pins are connected to which components
-int right_motor_speed_pin = 3;
-int right_motor_forward_pin = 4;
-int right_motor_backward_pin = 5;
+int right_motor_forward_pin = 3;
+int right_motor_backward_pin = 4;
+int right_motor_speed_pin = 5;
int right_echo_pin = 6;
int right_trigger_pin = 7;
-int left_motor_speed_pin = 8;
-int left_motor_forward_pin = 9;
-int left_motor_backward_pin = 10;
+int left_motor_forward_pin = 8;
+int left_motor_backward_pin = 9;
+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);}
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);
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);
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); }