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

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

bool sw1_pressed = false,
     sw2_pressed = false;

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

void prekidac1(int id, void* ptrt){
    if(digitalRead(SW1) && !sw1_pressed){
        setTaskState(blink_task_id, TASK_ENABLE);
        sw1_pressed = true;
        Serial.println("SWITCH 2 upravo pritisnut ON");
    }else if(!digitalRead(SW1) && sw1_pressed){
        setTaskState(blink_task_id, TASK_DISABLE);
        sw1_pressed = false;
        Serial.println("SWITCH 2 upravo pritisnut OFF");
        if(digitalRead(LD1)){
            digitalWrite(LD1, LOW);
        }
    }
}

void prekidac2(int id, void* ptrt){
    if(digitalRead(SW2) && !sw2_pressed){
        setTaskPeriod(blink_task_id, 1000);
        sw2_pressed = true;
        Serial.println("SWITCH 7 upravo pritisnut(1000ms)");
    }else if(!digitalRead(SW2) && sw2_pressed){
        setTaskPeriod(blink_task_id, 100);
        sw2_pressed = false;
        Serial.println("SWITCH 7 upravo pritisnut(100ms)");
    }
}

void setup()
{
    pinMode(LD1, OUTPUT);
    pinMode(SW1, INPUT);
    pinMode(SW2, INPUT);
    blink_task_id = createTask(blink_task1, 100, TASK_DISABLE, NULL);
    createTask(prekidac1, 50, TASK_ENABLE, NULL);
    createTask(prekidac2, 50, TASK_ENABLE, NULL);
}

void loop()
{

}