PES2_R2D2.0 / Mbed 2 deprecated MicroMouse_MASTER_THREE

mit pathdingsbums

Dependencies:   mbed

Fork of MicroMouse_MASTER_TWO by PES2_R2D2.0

IRSensor.cpp@8:1c8a747c49c8, 2018-05-16 (annotated)

Committer:
TheDarkDurzo
Date:
Wed May 16 12:15:23 2018 +0000
Revision:
8:1c8a747c49c8
Parent:
1:d9e840c48b1e 
mit pathfinding

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ruesipat 0:a9fe4ef404bf 1 #include <cmath>
ruesipat 0:a9fe4ef404bf 2 #include "IRSensor.h"
ruesipat 0:a9fe4ef404bf 3
ruesipat 0:a9fe4ef404bf 4 using namespace std;
ruesipat 0:a9fe4ef404bf 5
ruesipat 1:d9e840c48b1e 6
ruesipat 1:d9e840c48b1e 7 IRSensor::IRSensor(AnalogIn& distance) :
ruesipat 1:d9e840c48b1e 8 distance(distance)
ruesipat 1:d9e840c48b1e 9 {}
ruesipat 0:a9fe4ef404bf 10
ruesipat 0:a9fe4ef404bf 11 IRSensor::~IRSensor() {}
ruesipat 0:a9fe4ef404bf 12
ruesipat 0:a9fe4ef404bf 13 float IRSensor::read()
ruesipat 0:a9fe4ef404bf 14 {
ruesipat 1:d9e840c48b1e 15 double d = distance * 3.3f; // Change the value to be in the 0 to 3300 range
ruesipat 1:d9e840c48b1e 16
ruesipat 1:d9e840c48b1e 17 //DONT TOUCH
ruesipat 1:d9e840c48b1e 18 //y = 14.098x6 - 147.35x5 + 627.68x4 - 1403.5x3 + 1765.1x2 - 1236.9x + 430.44 POLYNOMFUNKTION AUS EXCEL
ruesipat 1:d9e840c48b1e 19 float f = 14.098f*((d)*(d)*(d)*(d)*(d)*(d)) - 147.35f*((d)*(d)*(d)*(d)*(d)) + 627.68*((d)*(d)*(d)*(d)) - 1403.5f*((d)*(d)*(d)) + 1765.1f*((d)*(d)) - 1236.9f*(d) + 430.44f; // Lesen der Distanz in [mm]
ruesipat 1:d9e840c48b1e 20
ruesipat 1:d9e840c48b1e 21 return f;
ruesipat 0:a9fe4ef404bf 22 }