S5info_H14 / Mbed 2 deprecated App6

app6

Dependencies:   mbed

main.cpp

Committer:
joGenie
Date:
2014-04-01
Revision:
1:770d7fd69e4f
Parent:
0:ac91697dd6e0

File content as of revision 1:770d7fd69e4f:

#include "mbed.h"

AnalogIn in(p20);
Serial pc(USBTX, USBRX);

double facteur[6] = { 111.38, 0.1759, 0.0002, -1*pow(10, -7), 4*pow(10, -11), -4*pow(10, -15) }

unsigned short calculDistance(unsigned short volt)
{
    unsigned short distance;
    
    for (int i = 0; i < 5; i++)
        distance += facteur[i]*pow(volt, i);
    
    return distance; 
}

int main()
{
    unsigned short volt;
    int d;
     
    while(1)
    {
        volt = in.read_u16();
        d = calculDistance(volt);
        pc.printf("V: %d, d: %d", volt, d);
        wait(0.1);
    }
}