Antonia Baumgartner / Mbed 2 deprecated Versuch21

Dependencies:   mbed

Fork of Versuch20 by Alexander Wyss

Committer:
baumgant
Date:
Sun Apr 22 16:14:54 2018 +0000
Revision:
0:b886f13e4ac6
Child:
1:6ef5bc60e69c
Roebi

Who changed what in which revision?

UserRevisionLine numberNew contents of line
baumgant 0:b886f13e4ac6 1 #include "LHR.h"
baumgant 0:b886f13e4ac6 2 #include "EncoderCounter.h"
baumgant 0:b886f13e4ac6 3 #include "Controller.h"
baumgant 0:b886f13e4ac6 4 #include "IRSensorGF.h"
baumgant 0:b886f13e4ac6 5 #include "IRSensorG.h"
baumgant 0:b886f13e4ac6 6 #include "IRSensorK.h"
baumgant 0:b886f13e4ac6 7 #include "IRSensorZ.h"
baumgant 0:b886f13e4ac6 8
baumgant 0:b886f13e4ac6 9 using namespace std;
baumgant 0:b886f13e4ac6 10
baumgant 0:b886f13e4ac6 11 LHR::LHR(IRSensorGF& Sensor1, IRSensorG& Sensor2, IRSensorG& Sensor3, IRSensorK& Sensor4, IRSensorK& Sensor5, IRSensorZ& Sensor6):
baumgant 0:b886f13e4ac6 12 Sensor1(Sensor1), Sensor2(Sensor2), Sensor3(Sensor3), Sensor4(Sensor4), Sensor5(Sensor5), Sensor6(Sensor6)
baumgant 0:b886f13e4ac6 13 {
baumgant 0:b886f13e4ac6 14 this->D = D;
baumgant 0:b886f13e4ac6 15 }
baumgant 0:b886f13e4ac6 16
baumgant 0:b886f13e4ac6 17
baumgant 0:b886f13e4ac6 18 LHR::~LHR() {}
baumgant 0:b886f13e4ac6 19
baumgant 0:b886f13e4ac6 20 int LHR::moving()
baumgant 0:b886f13e4ac6 21 {
baumgant 0:b886f13e4ac6 22 if (1/*Sensor6.read() > 0*/) {
baumgant 0:b886f13e4ac6 23 if(Sensor4.read() == 0) {
baumgant 0:b886f13e4ac6 24 D=1;
baumgant 0:b886f13e4ac6 25 } else if (Sensor1.read() == 0) {
baumgant 0:b886f13e4ac6 26 D=2;
baumgant 0:b886f13e4ac6 27 } else if (Sensor5.read() == 0) {
baumgant 0:b886f13e4ac6 28 D=3;
baumgant 0:b886f13e4ac6 29 } else {
baumgant 0:b886f13e4ac6 30 D=4;
baumgant 0:b886f13e4ac6 31 }
baumgant 0:b886f13e4ac6 32 } else {
baumgant 0:b886f13e4ac6 33 D=0;
baumgant 0:b886f13e4ac6 34 }
baumgant 0:b886f13e4ac6 35 return D;
baumgant 0:b886f13e4ac6 36 }