Diff: liftAnsteuerung.cpp

Revision:

2:dea0bab5e45c

Parent:

1:5c44e2462a8b

Child:

5:4b409c37e81f

Child:

7:5949f408b6da

--- a/liftAnsteuerung.cpp	Wed May 10 14:48:50 2017 +0000
+++ b/liftAnsteuerung.cpp	Wed May 10 18:12:34 2017 +0000
@@ -3,9 +3,9 @@
 #include "liftAnsteuerung.h"
  
  
-LiftAnsteuerung::LiftAnsteuerung(int zeitintervall, int ruecklaufzeit, Servo* servoLift)
+LiftAnsteuerung::LiftAnsteuerung(int intervall, int ruecklauf, Servo* servoLift)
 {
-    init(zeitintervall, ruecklauf, servoLift);
+    init(intervall, ruecklauf, servoLift);
 }
  
  
@@ -15,35 +15,26 @@
 LiftAnsteuerung::~LiftAnsteuerung() {}
  
  
-void LiftAnsteuerung::init(int deltat, int rueck, Servo* servoLift)
+void LiftAnsteuerung::init(int interval, int ruecklauf, Servo* servoLift)
 {
-    zeitintervall = deltat;
-    ruecklaufzeit = rueck;
+    zeitintervall = interval;
+    ruecklaufzeit = ruecklauf;
     this->servoLift = servoLift;
     M1 = 0;
-    M2 = 0;
+    M2 = ruecklauf;
 }
-void LiftAnsteuerung::steuerung(int zeitintervall, int ruecklaufzeit, Servo* servoAusw){
+void LiftAnsteuerung::steuerung(){
     
-    
-    if (M1<zeitintervall){
+    if (M1<zeitintervall && M2 == ruecklauf) {
         servoLift->write(1.1f);
         M1++;
-        
-    }
-    if (M1==zeitintervall){
-        M2=1;
-        }
-    
-    if (M2<ruecklaufzeit){
-        servoLift->write(0.1f);
-        M2++;
-        }
-        
-    if (M2==ruecklaufzeit){
-        M1=0;
-        M2=0;
-        }
+        } else if (M1==zeitintervall && M2>=0) {
+            servoLift->write(0.1f);
+            M2--;
+            } else {
+                M1 = 0;
+                M2 = zeitintervall;
+                }
         
 }
 void LiftAnsteuerung::setSerialOutput(Serial *pc)