#include "mbed.h"
#include <Debouncer.h>

PwmOut led1(p36);
PwmOut green(p5); 
PwmOut blue(p34);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);
//DigitalIn  taste(P0_10);
Debouncer butt(P0_10);

// States
//typedef enum {ST_EIN, ST_AUS, ST_STATE2, ST_STATE3} nextstate;
// alternativ
const int ST_EIN = 0;
const int ST_AUS = 1;

// ---------------- Transitions --------------------------
bool pressed = false;

void fall(void) { 
    pressed = true; 
}

bool CheckFlag()
{
    if( pressed ) { 
        pressed=false; 
        return true; 
    }
    return false;
}

// ----------------- Klasse Stm -----------------------------
class Stm {
  public:
        Stm() { state=ST_AUS; }
        
        void Ein();
        void Aus();
        void Error();

        uint8_t state;
};

void Stm::Ein(){
    while(true) {
        led1 = 1;
        if(CheckFlag()) {
            state = ST_AUS;
            return;
        }
    }
}

void Stm::Aus(){
    while(true) {
        led1 = 0;
        if(CheckFlag()) {
            state = ST_EIN;
            return;
        }
    }
}

void Stm::Error(){
    while(1) {
        led3 = ~led3;
        wait_ms(200);
    }
}

Stm stm;

void stateMachine()
{
    switch (stm.state)
    {
    case ST_EIN: stm.Ein();
        break;
    case ST_AUS: stm.Aus();
        break;
    default: stm.Error();
        break;
    }
}

int main()
{
    printf("Hello STM\n");
    butt.attach_fall(&fall); //.attach_rise(&rise);
    blue=green=1;
    while(1) {
        stateMachine(); 
    }
}