Basic library for Pololu's Sharp GP2Y0A51SK0F
Dependencies: mbed
Dependents: GrabTest R5 2016 Robotics Team 1
DistanceSensor.cpp@0:d03df6dd14d6, 2016-04-06 (annotated)
- Committer:
- Hypna
- Date:
- Wed Apr 06 23:02:33 2016 +0000
- Revision:
- 0:d03df6dd14d6
- Child:
- 1:8db052ec94f1
first upload
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Hypna | 0:d03df6dd14d6 | 1 | #include "DistanceSensor.h" |
Hypna | 0:d03df6dd14d6 | 2 | #include <cmath> |
Hypna | 0:d03df6dd14d6 | 3 | |
Hypna | 0:d03df6dd14d6 | 4 | DistanceSensor::DistanceSensor(PinName ai) : voltage(ai) {} |
Hypna | 0:d03df6dd14d6 | 5 | |
Hypna | 0:d03df6dd14d6 | 6 | float DistanceSensor::getDistance() |
Hypna | 0:d03df6dd14d6 | 7 | { |
Hypna | 0:d03df6dd14d6 | 8 | float v = voltage.read(); |
Hypna | 0:d03df6dd14d6 | 9 | //calibration curve for 2 |
Hypna | 0:d03df6dd14d6 | 10 | return 1044.8631*pow(v,5) - 1497.4521*pow(v,4) + 473.2921*pow(v,3) |
Hypna | 0:d03df6dd14d6 | 11 | + 199.07*pow(v,2) - 147.1165*v + 28.1844; |
Hypna | 0:d03df6dd14d6 | 12 | } |