d

Dependencies:   mbed

Fork of MyClass by Roboshark

Committer:
fluckmi1
Date:
Thu Apr 19 11:53:52 2018 +0000
Revision:
0:af3f2e5c9cd4
peace

Who changed what in which revision?

UserRevisionLine numberNew contents of line
fluckmi1 0:af3f2e5c9cd4 1 #include <cmath>
fluckmi1 0:af3f2e5c9cd4 2 #include "IRSensor.h"
fluckmi1 0:af3f2e5c9cd4 3
fluckmi1 0:af3f2e5c9cd4 4 using namespace std;
fluckmi1 0:af3f2e5c9cd4 5
fluckmi1 0:af3f2e5c9cd4 6 IRSensor::IRSensor(AnalogIn& distance, DigitalOut& bit0, DigitalOut& bit1,
fluckmi1 0:af3f2e5c9cd4 7 DigitalOut& bit2, int number) :
fluckmi1 0:af3f2e5c9cd4 8 distance(distance), bit0(bit0), bit1(bit1), bit2(bit2) {
fluckmi1 0:af3f2e5c9cd4 9
fluckmi1 0:af3f2e5c9cd4 10 this->number = number;
fluckmi1 0:af3f2e5c9cd4 11 }
fluckmi1 0:af3f2e5c9cd4 12
fluckmi1 0:af3f2e5c9cd4 13 IRSensor::~IRSensor() {}
fluckmi1 0:af3f2e5c9cd4 14
fluckmi1 0:af3f2e5c9cd4 15 float IRSensor::read() {
fluckmi1 0:af3f2e5c9cd4 16
fluckmi1 0:af3f2e5c9cd4 17 bit0 = (number >>0) & 1;
fluckmi1 0:af3f2e5c9cd4 18 bit1 = (number >>1) & 1;
fluckmi1 0:af3f2e5c9cd4 19 bit2 = (number >>2) & 1;
fluckmi1 0:af3f2e5c9cd4 20
fluckmi1 0:af3f2e5c9cd4 21 float d = -0.58f*sqrt(distance)+0.58f; //Lesen der Distanz in Meter
fluckmi1 0:af3f2e5c9cd4 22
fluckmi1 0:af3f2e5c9cd4 23 return d;
fluckmi1 0:af3f2e5c9cd4 24
fluckmi1 0:af3f2e5c9cd4 25 }