Basic library for Pololu's Sharp GP2Y0A51SK0F

Dependencies:   mbed

Dependents:   GrabTest R5 2016 Robotics Team 1

DistanceSensor.cpp

Committer:
Hypna
Date:
2016-04-06
Revision:
0:d03df6dd14d6
Child:
1:8db052ec94f1

File content as of revision 0:d03df6dd14d6:

#include "DistanceSensor.h"
#include <cmath>

DistanceSensor::DistanceSensor(PinName ai) : voltage(ai) {}

float DistanceSensor::getDistance()
{   
    float v = voltage.read();
    //calibration curve for 2
    return 1044.8631*pow(v,5) - 1497.4521*pow(v,4) + 473.2921*pow(v,3)
         + 199.07*pow(v,2) - 147.1165*v + 28.1844;
}