Jea Du Kim / FSR

personal changes

Dependents:   Smart_Car_Seat_v1

Fork of FSR by Chenkai Shao

FSR.cpp

Committer:
jd0205
Date:
2017-05-03
Revision:
6:71a6328709ea
Parent:
2:3a5f5cc5b35c

File content as of revision 6:71a6328709ea:

#include "FSR.h"
#include "mbed.h"

FSR::FSR(PinName pin, float resistance) : _ain(pin), _r(resistance)
{
}

float FSR::readRaw()
{
    float read = _ain;
    return read;
}

float FSR::readFSRResistance()
{
    float read = _ain;
    return _r * (1 - read) / read;
}

float FSR::readWeight()
{
    float read = _ain;
    float rfsr = _r * (1 - read) / read;
    float slope = (4 - 2) / (log10(6.2) - log10(0.25));
    float a = log10(rfsr);
    if (a < log10(6.2))
    {
        return pow(10, ((log10(6.2) - a) * slope + 2));
    }
    else
    {
        return 0;
    }
}