Pathfinding nach rechts funktioniert noch nicht...der rest schon

Dependencies:   mbed

Fork of MicroMouse_MASTER_THREE by PES2_R2D2.0

Committer:
ruesipat
Date:
Wed May 16 16:41:44 2018 +0000
Revision:
9:ab19796bf14a
Parent:
1:d9e840c48b1e
;

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 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 17
ruesipat 1:d9e840c48b1e 18 return f;
ruesipat 0:a9fe4ef404bf 19 }