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
--- /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