P1 Fertig

Dependencies:   mbed

Fork of ROME2_P1_Fertig by St Knz

IRSensor.cpp

Committer:
kueenste
Date:
2018-02-23
Revision:
3:86f7471eaa79
Parent:
1:b87369992345

File content as of revision 3:86f7471eaa79:

#include <cmath>
#include "IRSensor.h"
using namespace std;
IRSensor::IRSensor(AnalogIn& distance, DigitalOut& bit0,
                   DigitalOut& bit1, DigitalOut& bit2, int number) :
    distance(distance), bit0(bit0), bit1(bit1), bit2(bit2)
{
    this->number = number;
}
IRSensor::~IRSensor() {}
float IRSensor::read()
{
    switch(number) {
        case 0: 
        bit0 = 0;
        bit1 = 0;
        bit2 = 0;
        break;
        
        case 1: 
        bit0 = 1;
        bit1 = 0;
        bit2 = 0;
        break;
        
        case 2: 
        bit0 = 0;
        bit1 = 1;
        bit2 = 0;
        break;
        
        case 3: 
        bit0 = 1;
        bit1 = 1;
        bit2 = 0;
        break;
        
        case 4: 
        bit0 = 0;
        bit1 = 0;
        bit2 = 1;
        break;
        
        case 5: 
        bit0 = 1;
        bit1 = 0;
        bit2 = 1;
        break;
        
        default:
        bit0 = 0;
        bit1 = 0;
        bit2 = 0;
        break;
        
    }
    
    return -0.58f*sqrt(distance)+0.58f;
}