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;h=fcdfa34315ab83cd214dbfb4434b7958c36a7f14;hp=26ecf2c40a6f072dd6a459cad7a92626890105ed;hb=ce941be740b45737d19eaa5c726b2f99efabe0b9;hpb=b3ab14a78f73759705c9b7db3300b94b4b206ce6 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 26ecf2c..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,20 +13,7 @@ along with this program. If not, see . */ -// define which pins are connected to which components -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_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; +#include "bot_map.h" void on(int pin){ digitalWrite(pin, HIGH);} @@ -128,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; @@ -136,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 = ");