[НРС] Вежбе 11 - Задатак 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;

#define SW_0 2
#define SW_1 7
#define SW_2 8
#define SW_3 35

int turnedOn = 0;

void setup()
{
    for(int i = 26; i <= 33; i++){
        pinMode(i, OUTPUT);
    }
    pinMode(2, INPUT);
    pinMode(7, INPUT);
    pinMode(8, INPUT);
    pinMode(35, INPUT);
}

void turnOffAfter(int n){
    for(int i = n + 1; i <= 33; i++){
        digitalWrite(i, LOW);
    }
}

void loop()
{
    int toTurnOn = (digitalRead(SW_0) + digitalRead(SW_1) + digitalRead(SW_2) + digitalRead(SW_3)) * 2;
    if(turnedOn != toTurnOn){
        for(int i = 26; i < 26 + toTurnOn; i++){
            if(!digitalRead(i)){
                digitalWrite(i, HIGH);
            }
        }
        turnOffAfter(26 + toTurnOn - 1);
        turnedOn = toTurnOn;
    }
}