#include <Wire.h>
//10
#define BUTTON1 2
#define BUTTON2 3
#define BUTTON3 4
#define BUTTON4 5

#define LED1 7
#define LED2 8
#define LED3 9
#define LED4 10
#define LED5 11
#define LED6 12
#define LED7 13

char aK1;
char aK2;
char aK3;
char aK4;

char L1;
char L2;
char L3;
char L4;
char L5;
char L6;
char L7;

byte x[14] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
byte y[17] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};

struct SerialV
{
  char inputs;
  char outputs;
};

union SerialValues
{
  SerialV s;
  uint16_t v;
};

void setup() {
  // put your setup code here, to run once:
  pinMode(BUTTON1, INPUT);
  pinMode(BUTTON2, INPUT);
  pinMode(BUTTON3, INPUT);
  pinMode(BUTTON4, INPUT);

  pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);
  pinMode(LED3, OUTPUT);
  pinMode(LED4, OUTPUT);
  pinMode(LED5, OUTPUT);
  pinMode(LED6, OUTPUT);
  pinMode(LED7, OUTPUT);

  Wire.begin(8);
  Wire.onReceive(receiveEvent);
  Wire.onRequest(requestEvent);

  noInterrupts();
  TCCR1A = 0;
  TCCR1B = 0;

  TCNT1 = 65536 - 6249;

  TCCR1B |= (1 << CS12);    // 256 prescaler
  TIMSK1 |= (1 << TOIE1);   // enable timer overflow interrupt
  interrupts();

  Serial.begin(115200);
}

void receiveEvent( int bytes ) {
  for (int i = 0; i < sizeof(y); i++) {
    y[i] = Wire.read();
  }
}

void requestEvent()
{
  Wire.write(x, 14);
}

ISR(TIMER1_OVF_vect)        // interrupt service routine
{
  TCNT1 = 65536 - 6249;   // preload timer
  implementacja();

  char inputs = 0;
  char outputs = 0;

  byte msg[2];

  outputs |= ((L7 && 1) << 6) | ((L6 && 1) << 5) | ((L5 && 1) << 4) | ((L4 && 1) << 3) | ((L3 && 1) << 2) | ((L2 && 1) << 1) | (L1 && 1);
  inputs |= ((aK4 && 1) << 3) | ((aK3 && 1) << 2) | ((aK2 && 1) << 1) | (aK1 && 1);

  msg[0] = inputs;
  msg[1] = outputs;
}

void loop() {

  aK1 = digitalRead(BUTTON1);
  aK2 = digitalRead(BUTTON2);
  aK3 = digitalRead(BUTTON3);
  aK4 = digitalRead(BUTTON4);

  // put your main code here, to run repeatedly:
  digitalWrite(LED1, L1);
  digitalWrite(LED2, L2);
  digitalWrite(LED3, L3);
  digitalWrite(LED4, L4);
  digitalWrite(LED5, L5);
  digitalWrite(LED6, L6);
  digitalWrite(LED7, L7);

}
char T1x1 = 0, T1x2 = 0, T1x3 = 0, T2x1 = 0, T2x2 = 0, T2x3 = 0, T3x1 = 0, T3x2 = 0, T3x3 = 0, T4x1 = 0, T4x2 = 0, T4x3 = 0;
char T1 = 0, T2 = 0, T3 = 0, T4 = 0;
char Z1 = 0, Z2 = 0 , Z3 = 0, Z4 = 0, Z5 = 0, Z6 = 0;
char G1 = 0, G2 = 0, G3 = 0, G4 = 0;
char M1 = 0, M2 = 0, M3 = 0, M4 = 0;
char stan1 = 1, stan2 = 1, stan3 = 1, stan4 = 1;
char tim1 = 0, tim2 = 0, tim3 = 0, tim4 = 0;
bool stanOK = true;
void implementacja()
{
  //if (y[16] == 0){
  //    while(true){};
 // }
//else {
//Serial.print("dzialam");
//Przypisanie otrzymanych wartosci do poziomow wody
  T1x1 = y[0];
  T1x2 = y[1];
  T1x3 = y[2];
  T2x1 = y[3];
  T2x2 = y[4];
  T2x3 = y[5];
  T3x1 = y[6];
  T3x2 = y[7];
  T3x3 = y[8];
  T4x1 = y[9];
  T4x2 = y[10];
  T4x3 = y[11];

  //Przypisanie otrzymanych wartosci do poziomu termometrow
  T1 = y[12];
  T2 = y[13];
  T3 = y[14];
  T4 = y[15];
  //Zbiornik 1
  for(int i = 0; i < sizeof(y); i++){
    Serial.print(y[i]);
    Serial.print(" | ");
  }
  Serial.println();
{
    switch (stan1)
    {
    case 1:
      Z1 = 1;
      Z2 = 0;
      Z3 = 0;
      G1 = 0;

      if (T1x2) {
        stan1 = 2;
        tim1= 20;
      }
      break;

    case 2:
      Z1 = 0;
      Z2 = 0;
      Z3 = 0;
      G1 = 0;

      if (T1 || !tim1)
        stan1 = 3;
      break;

    case 3:
      Z1 = 0;
      Z2 = 1;
      Z3 = 1;
      G1 = 0;
      if (!T1x1)
        stan1 = 1;
      break;

    }
  }

  //Zbiornik 2
  {
    switch (stan2) {
    case 1:
      Z4 = 0;
      if (T2x2)
        stan2 = 2;
      break;


    case 2:
      Z4 = 1;
      if (!T2x1)
        stan2 = 1;
      break;
    }

  }

  //Zbiornik 3
  {
    switch (stan3) {
    case 1:
      Z5 = 0;
      if (T3x2)
        stan3 = 2;
      break;


    case 2:
      Z5 = 1;
      if (!T3x1)
        stan3 = 1;
      break;
    }
  }

  //Zbiornik 4
  {
    switch (stan4) {
    case 1:
      Z6 = 0;
      G4 = 1;
      if (T4x1)
        stan4 = 2;
      break;


    case 2:
      Z6 = 1;
      if (!T4x1)
        stan4 = 1;
      break;
    }
  }

  //Przekazanie danych do obiektu
  x[0] = Z1;
  x[1] = Z2;
  x[2] = Z3;
  x[3] = Z4;
  x[4] = Z5;
  x[5] = Z6;

  x[6] = G1;
  x[7] = G2;
  x[8] = G3;
  x[9] = G4;

  x[10] = M1;
  x[11] = M2;
  x[12] = M3;
  x[13] = M4;

  //Obsluga timerow
  if (tim1) --tim1;
  if (tim2) --tim2;
  if (tim3) --tim3;
  if (tim4) --tim4;
//}
}