Calibrated Sharp distance sensors

Dependents:   steppertest R5 2016 Robotics Team 1

Revision:
1:aed20a8e1da0
Parent:
0:c8c67fabc804
Child:
2:ed1f0f09eb5b
--- a/LongRangeSensor.cpp	Tue Mar 22 03:00:35 2016 +0000
+++ b/LongRangeSensor.cpp	Wed Apr 06 22:02:15 2016 +0000
@@ -162,4 +162,34 @@
                 + 3.1692;
                 
     return float(distMeas + readError);
-}
\ No newline at end of file
+}
+
+// FUNCTION:
+//      distInchesLOne()
+// IN-PARAMETERS:
+//      None
+// OUT-PARAMETERS:
+//      Returns distance in inches
+// DESCRIPTION:
+//      Returns 1 reading in inches.
+float LongRangeSensor::distInchesLOne()
+{
+    double sensorRead = sensor.read();
+    
+    return 0.393701*(3.5097*pow(sensorRead, -1.425));
+}
+
+// FUNCTION:
+//      distInchesROne()
+// IN-PARAMETERS:
+//      None
+// OUT-PARAMETERS:
+//      Returns distance in inches
+// DESCRIPTION:
+//      Returns average of 3 readings in inches.
+float LongRangeSensor::distInchesROne()
+{
+    double sensorRead = sensor.read();
+    
+    return 0.393701*(3.4617*pow(sensorRead, -1.506));
+}