Prometheus / Mbed 2 deprecated Prom_Roebi

Prom_Roebi_0.1

Dependencies:   Farbsensor IRSensorLib PID_Control Servo mbed PixyLib

liftAnsteuerung.cpp

Committer:
ZHAW_Prometheus
Date:
2017-05-26
Revision:
16:ad45ef4fee04
Parent:
15:26dbcd6ff48d

File content as of revision 16:ad45ef4fee04:

#include "mbed.h"
#include "cstdlib"
#include "liftAnsteuerung.h"

//Konstruktor
LiftAnsteuerung::LiftAnsteuerung(uint8_t interval, uint8_t ruecklauf, Servo& _servoLift) : servoLift(_servoLift)
{
    zeitinterval = interval;
    ruecklaufzeit = ruecklauf;
    M1 = interval;
    M2 = ruecklauf;
}
//Destruktor
LiftAnsteuerung::~LiftAnsteuerung() {}

void LiftAnsteuerung::steuerung()
{
    if (M1>0) {
        servoLift = 1.2f;
        M1--;
    } else if (M2>0) {

        servoLift = 0.1f;
        M2--;
    } else {
        M1 = zeitinterval;
        M2 = ruecklaufzeit;
    }
}