Antonia Baumgartner / Mbed 2 deprecated Versuch21

Dependencies:   mbed

Fork of Versuch20 by Alexander Wyss

Revision:
0:b886f13e4ac6
Child:
1:6ef5bc60e69c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Classes/LHR.cpp	Sun Apr 22 16:14:54 2018 +0000
@@ -0,0 +1,36 @@
+#include "LHR.h"
+#include "EncoderCounter.h"
+#include "Controller.h"
+#include "IRSensorGF.h"
+#include "IRSensorG.h"
+#include "IRSensorK.h"
+#include "IRSensorZ.h"
+
+using namespace std;
+
+LHR::LHR(IRSensorGF& Sensor1, IRSensorG& Sensor2, IRSensorG& Sensor3, IRSensorK& Sensor4, IRSensorK& Sensor5, IRSensorZ& Sensor6):
+    Sensor1(Sensor1), Sensor2(Sensor2), Sensor3(Sensor3), Sensor4(Sensor4), Sensor5(Sensor5), Sensor6(Sensor6)
+{
+    this->D = D;
+}
+
+
+LHR::~LHR() {}
+
+int LHR::moving()
+{
+    if (1/*Sensor6.read() > 0*/) {
+        if(Sensor4.read() == 0) {
+            D=1;
+        } else if (Sensor1.read() == 0) {
+            D=2;
+        } else if (Sensor5.read() == 0) {
+            D=3;
+        } else {
+            D=4;
+        }
+    } else {
+        D=0;
+    }
+    return D;
+}