Michael Fluck
/
MyClass
d
Fork of MyClass by
IRSensor.cpp@0:af3f2e5c9cd4, 2018-04-19 (annotated)
- Committer:
- fluckmi1
- Date:
- Thu Apr 19 11:53:52 2018 +0000
- Revision:
- 0:af3f2e5c9cd4
peace
Who changed what in which revision?
User | Revision | Line number | New 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 | } |