Lauren Alexander / FSRCookieJar

FSRforCookieJar

Fork of FSR by Chenkai Shao

FSR.cpp

Committer:
cshao06
Date:
2015-10-21
Revision:
2:3a5f5cc5b35c
Parent:
1:6b702226a5d3
Child:
6:78279e66b1a0

File content as of revision 2:3a5f5cc5b35c:

#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 - _r;
}

float FSR::readWeight()
{
    float read = _ain;
    float rfsr = _r * 1 / read - _r;
    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;
    }
}