From 8a033999b3952c9b7103bb8bd6a2227aa2c7601d Mon Sep 17 00:00:00 2001 From: daniel watson Date: Wed, 25 Jan 2017 17:57:55 -0800 Subject: [PATCH] add LEDs to visually indicate distance sensed --- build-stages/g_follow/g_follow.ino | 24 ++++++++++++++++++++---- 1 file changed, 20 insertions(+), 4 deletions(-) diff --git a/build-stages/g_follow/g_follow.ino b/build-stages/g_follow/g_follow.ino index f0ba76c..02f6d96 100644 --- a/build-stages/g_follow/g_follow.ino +++ b/build-stages/g_follow/g_follow.ino @@ -13,9 +13,12 @@ along with this program. If not, see . */ +// right side LED, white wire +int right_led_pin = 3; + // define which pins are connected to which components // blue wire -int right_motor_forward_pin = 3; +int right_motor_forward_pin = 2; // orange wire int right_motor_backward_pin = 4; // white wire @@ -26,11 +29,10 @@ 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; +int left_motor_backward_pin = 13; // white wire int left_motor_speed_pin = 10; @@ -39,6 +41,9 @@ int left_echo_pin = 11; // blue wire int left_trigger_pin = 12; +// left side LED, blue wire +int left_led_pin = 9; + void on(int pin){ digitalWrite(pin, HIGH);} @@ -130,10 +135,21 @@ void loop() { 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); + 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); + left_speed = actual_left_ping_time - desired_left_ping_time; right_speed = actual_right_ping_time - desired_right_ping_time; - Serial.print("left: ping = "); + Serial.print(", left: ping = "); Serial.print(actual_left_ping_time); Serial.print(" speed = "); Serial.print(left_speed); -- 2.30.2