#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;

uint8_t state = ST_AUS;

// Transitions
bool pressed = false;

void fall(void) { 
    pressed = true; 
}

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

// State Functions    
void Ein(){
    // entry
    // do
    while(true) {
        led1 = 1;
        if(CheckFlag()) {
            state = ST_AUS;
            // exit
            return;
        }
    }
}

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

void Error(){
    while(1) {
        led3 = !led3;
        wait_ms(200);
    }
}

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

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