[НРС] Вежбе 13 - Задатак 1 - начин #2

#include<arduinoPlatform.h>
#include<tasks.h>
#include<interrupts.h>
#include<stdio.h>
#include<serial.h>
#include <pwm.h>
#include<data.h>

extern serial Serial;

#define LD1 26
#define SW1 2
#define SW2 7

int lastState_sw1,
    lastState_sw2,
    blink_task1_id;

void blink_task1(int id, void* ptrt){
    digitalWrite(LD1, !digitalRead(LD1));
}

void prekidac1(int id, void* ptrt){
    int newState = digitalRead(SW1);
    if(lastState_sw1 < newState){
        setTaskState(blink_task1_id, TASK_ENABLE);
    }else if(lastState_sw1 > newState){
        setTaskState(blink_task1_id, TASK_DISABLE);
        if(digitalRead(LD1)){ //proveravamo da li je ostala upaljena led dioda kad smo ugasili task (desilo mi se da jeste)
            digitalWrite(LD1, LOW);
        }
    }
    if(lastState_sw1 != newState){
        lastState_sw1 = newState;
    }
}

void prekidac2(int id, void* ptrt){
    int newState = digitalRead(SW2);
    if(lastState_sw2 < newState){
        setTaskPeriod(blink_task1_id, 1000);
    }else if(lastState_sw2 > newState){
        setTaskPeriod(blink_task1_id, 100);
    }
    if(lastState_sw2 != newState){
        lastState_sw2 = newState;
    }
}

void setup()
{
    lastState_sw1  = digitalRead(SW1);
    lastState_sw2  = digitalRead(SW2);
    blink_task1_id = createTask(blink_task1, 100, TASK_DISABLE, NULL);
    createTask(prekidac1, 50, TASK_ENABLE, NULL);
    createTask(prekidac2, 50, TASK_ENABLE, NULL);
}

void loop()
{

}