feat: add setUSPins() to allow overriding distance sensor pins (#5)

library.properties

@@ -1,5 +1,5 @@
 name=Leaphy Original Extension
-version=0.0.2
+version=0.0.3
 author=Leaphy Robotics
 maintainer=Leaphy Robotics <[email protected]>
 sentence=Provides functionality to program Leaphy Original robots

src/Leaphyoriginal1.cpp

@@ -16,18 +16,25 @@ void setMotorPins(int m1_pwm, int m1_dir, int m2_pwm, int m2_dir)
 }
 
 
+void setUSPins(int echo, int trig) 
+{
+    us_pins.echo = echo;
+    us_pins.trig = trig;
+}
+
+
 float getDistance()
 {
     float duration, distance;
     int tries = 0;
 
-    pinMode(US_TRIG, OUTPUT);
-    digitalWrite(US_TRIG, LOW);
+    pinMode(us_pins.trig, OUTPUT);
+    digitalWrite(us_pins.trig, LOW);
     delayMicroseconds(2);
-    digitalWrite(US_TRIG, HIGH);
+    digitalWrite(us_pins.trig, HIGH);
     delayMicroseconds(10);
-    digitalWrite(US_TRIG, LOW);
-        duration = pulseIn(US_ECHO, HIGH, 30000);
+    digitalWrite(us_pins.trig, LOW);
+        duration = pulseIn(us_pins.echo, HIGH, 30000);
         distance = 0.034 * duration / 2;
     if(distance == 0 ){
       distance = distance + 1313;

src/Leaphyoriginal1.h

@@ -32,8 +32,6 @@
 #define LED1_BLUE       (3)     // PWM-OUT
 #define LINE_LEFT       (16)    // DIG-IN       A2 tinkerkit In2
 #define LINE_RIGHT      (17)    // DIG-IN       A3 tinkerkit In3
-#define US_ECHO         (8)     // DIG-IN/OUT
-#define US_TRIG         (7)     // DIG-OUT
 
 struct {
     int m1_pwm = 10;
@@ -42,7 +40,13 @@ struct {
     int m2_dir = 13;
 } motor_pins;
 
+struct {
+    int echo = 8;
+    int trig = 7;
+} us_pins;
+
 void setMotorPins(int m1_pwm, int m1_dir, int m2_pwm, int m2_dir);
+void setUSPins(int echo, int trig);
 float getDistance();
 int getLineFollower(int fpSide);
 void setTone( int fpTone, int fpBeat);