Sharp GP2 familly distance sensor library
Dependents: FRC_2018 0hackton_08_06_18 0hackton_08_06_18_publish Kenya_2019 ... more
GP2A.cpp@0:17de10d278c2, 2018-05-18 (annotated)
- Committer:
- haarkon
- Date:
- Fri May 18 16:47:44 2018 +0000
- Revision:
- 0:17de10d278c2
- Child:
- 2:5e591a5b8edd
Untested first release of SHARP GP2 familly distance sensor
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
haarkon | 0:17de10d278c2 | 1 | #include "GP2A.h" |
haarkon | 0:17de10d278c2 | 2 | |
haarkon | 0:17de10d278c2 | 3 | GP2A::GP2A(PinName vmes, float dMin, float dMax, float slope) : _sensor(vmes) |
haarkon | 0:17de10d278c2 | 4 | { |
haarkon | 0:17de10d278c2 | 5 | m_dMin = dMin; |
haarkon | 0:17de10d278c2 | 6 | m_dMax = dMax; |
haarkon | 0:17de10d278c2 | 7 | m_slope = slope; |
haarkon | 0:17de10d278c2 | 8 | } |
haarkon | 0:17de10d278c2 | 9 | |
haarkon | 0:17de10d278c2 | 10 | float GP2A::getDistance (void) |
haarkon | 0:17de10d278c2 | 11 | { |
haarkon | 0:17de10d278c2 | 12 | float vDist = _sensor.read()* 3.3; |
haarkon | 0:17de10d278c2 | 13 | float distance = m_slope/vDist; |
haarkon | 0:17de10d278c2 | 14 | if (distance > m_dMax) return m_dMax; |
haarkon | 0:17de10d278c2 | 15 | if (distance < m_dMin) return m_dMin; |
haarkon | 0:17de10d278c2 | 16 | return distance; |
haarkon | 0:17de10d278c2 | 17 | } |
haarkon | 0:17de10d278c2 | 18 | |
haarkon | 0:17de10d278c2 | 19 | float GP2A::getVoltage (void) |
haarkon | 0:17de10d278c2 | 20 | { |
haarkon | 0:17de10d278c2 | 21 | return _sensor.read()* 3.3; |
haarkon | 0:17de10d278c2 | 22 | } |