FRC - Hackathon
Sharp GP2 familly distance sensor library
Dependents: FRC_2018 0hackton_08_06_18 0hackton_08_06_18_publish Kenya_2019 ... more
Diff: GP2A.cpp
- Revision:
- 0:17de10d278c2
- Child:
- 2:5e591a5b8edd
diff -r 000000000000 -r 17de10d278c2 GP2A.cpp
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/GP2A.cpp Fri May 18 16:47:44 2018 +0000
@@ -0,0 +1,22 @@
+#include "GP2A.h"
+
+GP2A::GP2A(PinName vmes, float dMin, float dMax, float slope) : _sensor(vmes)
+{
+ m_dMin = dMin;
+ m_dMax = dMax;
+ m_slope = slope;
+}
+
+float GP2A::getDistance (void)
+{
+ float vDist = _sensor.read()* 3.3;
+ float distance = m_slope/vDist;
+ if (distance > m_dMax) return m_dMax;
+ if (distance < m_dMin) return m_dMin;
+ return distance;
+}
+
+float GP2A::getVoltage (void)
+{
+ return _sensor.read()* 3.3;
+}
\ No newline at end of file