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

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

extern serial Serial;

//LED pins
#define LED_1 26
#define LED_2 27
#define LED_3 28
#define LED_4 29

//SWITCH pins
#define SW_1 2
#define SW_2 7
#define SW_3 8
#define SW_4 35

int blink_task1,
    led_array[]    = {LED_1, LED_2, LED_3, LED_4},
    switch_array[] = {SW_1, SW_2, SW_3, SW_4};


typedef struct{
    short led_pin;
    short switch_pin;
} input_pairs;

void init_input(input_pairs input[]){
    for(int i = 0; i < 4; i++){
        input[i].led_pin    = led_array[i];
        input[i].switch_pin = switch_array[i];
    }
}

void check_SWs(int id, void* ptrt){
    input_pairs *input = (input_pairs*)ptrt;
    for(int i = 0; i < 4; i++){
        if(digitalRead(input[i].switch_pin) && !digitalRead(input[i].led_pin)){
            digitalWrite(input[i].led_pin, HIGH);
        }else if(!digitalRead(input[i].switch_pin) && digitalRead(input[i].led_pin)){
            digitalWrite(input[i].led_pin, LOW);
        }
    }
}

void setup()
{
    input_pairs input[5];
    //morao sam da definisem 5 clanova iako samo koristim 4, jer kad ih ima samo 4
    //onda nekako task krene da mi dodaje u switch_pin na poslednjem clanu svaki put
    //broj milisekundi koji je sacekao (bude uvek +50, 51, ili 52
    init_input(input);
    blink_task1 = createTask(check_SWs, 50, TASK_ENABLE, input);
}

void loop()
{

}