X-Git-Url: http://challenge-bot.com/repos/?p=challenge-bot;a=blobdiff_plain;f=build-stages%2Fh_stay_on_table%2Fh_stay_on_table.ino;fp=build-stages%2Fh_stay_on_table%2Fh_stay_on_table.ino;h=fcdfa34315ab83cd214dbfb4434b7958c36a7f14;hp=e2838f5536af086fecbe2dea168cc0b68983c4e2;hb=ce941be740b45737d19eaa5c726b2f99efabe0b9;hpb=e8e5701429b510a164ee9cac12920913692fac75 diff --git a/build-stages/h_stay_on_table/h_stay_on_table.ino b/build-stages/h_stay_on_table/h_stay_on_table.ino index e2838f5..fcdfa34 100644 --- a/build-stages/h_stay_on_table/h_stay_on_table.ino +++ b/build-stages/h_stay_on_table/h_stay_on_table.ino @@ -13,30 +13,7 @@ along with this program. If not, see . */ -// define which pins are connected to which components -// blue wire -int right_motor_forward_pin = 3; -// orange wire -int right_motor_backward_pin = 4; -// white wire -int right_motor_speed_pin = 5; - -// yellow wire -int right_echo_pin = 6; -// blue wire -int right_trigger_pin = 7; - -// blue wire -int left_motor_forward_pin = 8; -// orange wire -int left_motor_backward_pin = 9; -// white wire -int left_motor_speed_pin = 10; - -// yellow wire -int left_echo_pin = 11; -// blue wire -int left_trigger_pin = 12; +#include "bot_map.h" void on(int pin){ digitalWrite(pin, HIGH);} @@ -138,7 +115,7 @@ void loop(){ // larger values mean larger distance. default is 800 int right_max_ping_time_over_table = 800; int left_max_ping_time_over_table = 800; - int backup_time = 2000; + int backup_time = 1000; // the exact amount of time for turning around might need // twerking for your robot. the default value is 3200 int turn_around_time = 3200; @@ -146,6 +123,17 @@ void loop(){ int actual_left_ping_time = ping(left_trigger_pin, left_echo_pin); int actual_right_ping_time = ping(right_trigger_pin, right_echo_pin); + /* int left_led_value = (int)(actual_left_ping_time / 16.0); */ + /* int right_led_value = (int)(actual_right_ping_time / 16.0); */ + + /* Serial.print("left led value = "); */ + /* Serial.print(left_led_value); */ + /* Serial.print(", right led value = "); */ + /* Serial.print(right_led_value); */ + + /* analogWrite(left_led_pin, left_led_value); */ + /* analogWrite(right_led_pin, right_led_value); */ + Serial.print("left ping = "); Serial.print(actual_left_ping_time); Serial.print("\tright_ping = ");