[НРС] Вежбе 12 - Задатак 3

#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 LD8 33
#define SW1 2
#define SW2 7
#define SW3 8
#define SW4 35

int blink_task1,
    blink_task2;

void turn_LD8(int id, void* ptrt){
    digitalWrite(LD8, !digitalRead(LD8));
}

void check_SWs(int id, void* ptrt){
    int intervalPeriod = 100 + (digitalRead(SW1) + digitalRead(SW2) + digitalRead(SW3) + digitalRead(SW4)) * 100;
    if(getTaskPeriod(blink_task1) != intervalPeriod){
        setTaskPeriod(blink_task1, intervalPeriod);
    }
}

void setup()
{
    pinMode(LD8, OUTPUT);
    pinMode(SW1, INPUT);
    pinMode(SW2, INPUT);
    pinMode(SW3, INPUT);
    pinMode(SW4, INPUT);
    blink_task1 = createTask(turn_LD8, 100, TASK_ENABLE, NULL);
    blink_task2 = createTask(check_SWs, 1000, TASK_ENABLE, NULL);
}

void loop()
{

}