Antonia Baumgartner / Mbed 2 deprecated Versuch21

Dependencies:   mbed

Fork of Versuch20 by Alexander Wyss

Classes/Spurhaltung.cpp

Committer:
mrbb2
Date:
2018-04-23
Revision:
1:6ef5bc60e69c
Parent:
0:b886f13e4ac6
Child:
2:efa9a78591da

File content as of revision 1:6ef5bc60e69c:

#include "Spurhaltung.h"
#include "IRSensorG.h"

using namespace std;

Spurhaltung::Spurhaltung(IRSensorG& Sensor2, IRSensorG& Sensor3):
    Sensor2(Sensor2), Sensor3(Sensor3)

{
    this->sr = sr;
    this->sl = sl;
}

Spurhaltung::~Spurhaltung() {}

int Spurhaltung::speedl()
{
    if(abs(Sensor2.read()-Sensor3.read())<20) {
        int sl = Sensor2.read() * 1.875;
        return sl;
    } else {
        int sl = 150;
        return sl;
    }
}

int Spurhaltung::speedr()
{
    if(abs(Sensor3.read()-Sensor2.read())<20) {
        int sr = Sensor3.read() * 1.875;
        return sr;
    } else {
        int sr = 150;
        return sr;
    }
}