Alter lightTest.rs to comply with 4-pin model, add ultrasonicTest.rs, add motorTest.rs with raslib::L298n library

src/moduleTests/ultrasonicTest.rs

@@ -0,0 +1,45 @@
+use hc_sr04::{HcSr04, Unit};
+
+let mut ultrasonicFront = HcSr04::new(
+    7,          // TRIGGER
+    1,          // ECHO
+    Some(23_f32) 
+).unwrap();
+
+let mut ultrasonicLeft = HcSr04::new(
+    0,
+    4,
+    Some(23_f32) 
+).unwrap();
+
+let mut ultrasonicRight = HcSr04::new(
+    2,
+    5,
+    Some(23_f32) 
+).unwrap();
+
+let mut ultrasonicBack = HcSr04::new(
+    3,
+    6,
+    Some(23_f32) 
+).unwrap();
+
+match ultrasonicFront.measure_distance(Unit::Meters).unwrap() {
+    Some(dist) => println!("[FRONT] Distance: {.2}m", dist),
+    None => println!("Object out of range"),
+}
+
+match ultrasonicLeft.measure_distance(Unit::Meters).unwrap() {
+    Some(dist) => println!("[LEFT] Distance: {.2}m", dist),
+    None => println!("Object out of range"),
+}
+
+match ultrasonicRight.measure_distance(Unit::Meters).unwrap() {
+    Some(dist) => println!("[RIGHT] Distance: {.2}m", dist),
+    None => println!("Object out of range"),
+}
+
+match ultrasonicBack.measure_distance(Unit::Meters).unwrap() {
+    Some(dist) => println!("[BACK] Distance: {.2}m", dist),
+    None => println!("Object out of range"),
+}