   Serial.print("=>");
   Serial.println(PORTJ, BIN);
 
-  
-}
-
-//Deze functie gaat de poorten (registers) lezen en serieel terugsturen.
-//Nu in binair maar kan ook in HEX.
-void readStatusPorts(){
-  
-  unsigned int partB = (PORTB & USEDPINS_PORTB)<<8;
-  unsigned int partD = (PORTD & USEDPINS_PORTD)>>2;
-  unsigned int partE1 = (PORTE & 0x08)<<5;
-  unsigned int partE2 = (PORTE & 0x30)<<2;
-  unsigned int partH1 = (PORTH & 0x78)<<6;
-  unsigned int partH2 = (PORTH & 0x03)<<2;
-  unsigned int partJ = (PORTJ & USEDPINS_PORTJ)<<4;
-  
-FEEDBACK_STATUS_PORT=0x0000;
-FEEDBACK_STATUS_PORT = FEEDBACK_STATUS_PORT|partB;
-FEEDBACK_STATUS_PORT = FEEDBACK_STATUS_PORT|partD;
-FEEDBACK_STATUS_PORT = FEEDBACK_STATUS_PORT|partE1;
-FEEDBACK_STATUS_PORT = FEEDBACK_STATUS_PORT|partE2;
-FEEDBACK_STATUS_PORT = FEEDBACK_STATUS_PORT|partH1;
-FEEDBACK_STATUS_PORT = FEEDBACK_STATUS_PORT|partH2;
-FEEDBACK_STATUS_PORT = FEEDBACK_STATUS_PORT|partJ;
-
-Serial.print(F("Status van de poorten na aanpssen van registers[BIN]: "));
-print_binary(FEEDBACK_STATUS_PORT,16);
-Serial.print(F("Status van de poorten na aanpssen van registers [HEX]: 0x"));
-Serial.println(FEEDBACK_STATUS_PORT,HEX);
-  
-}
-  
+}
+
 //Print de mapping van de poorten
-void printInfoPoorten(){
- Serial.print(F("Uitgang:        "));
- Serial.println(F("0  1   2   3   4  5   6  7  8  9  10  11  12  13  14  15"));
- Serial.print(F("Port# arduino:  "));
- Serial.println(F("13 12  11  9   8  7   6  5  3  2  14  15  16  17  18  19"));
- Serial.print(F("Port.BIT:       "));
- Serial.println(F("B7 B6  B5  H6  H5 H4  H3 E3 E5 E4 J1  J0  H1  H0  D3  D2"));
-
- Serial.println(F("Je kan nu een de uitgangen sturen door tussen [] een HEX-waarde mee te geven."));
- Serial.println(F("Bv: [FFFF] => alles aan | [0000] => alles uit | [1800] => uitgagen 3&4 aan, de rest uit"));
-  }
+void printInfoPoorten() {
+  Serial.print(F("Uitgang:        "));
+  Serial.println(F("0  1   2   3   4  5   6  7  8  9  10  11  12  13  14  15"));
+  Serial.print(F("Port# arduino:  "));
+  Serial.println(F("13 12  11  9   8  7   6  5  3  2  14  15  16  17  18  19"));
+  Serial.print(F("Port.BIT:       "));
+  Serial.println(F("B7 B6  B5  H6  H5 H4  H3 E3 E5 E4 J1  J0  H1  H0  D3  D2"));
+
+  Serial.println(F("Je kan nu een de uitgangen sturen door tussen [] een HEX-waarde mee te geven."));
+  Serial.println(F("Bv: [FFFF] => alles aan | [0000] => alles uit | [1800] => uitgagen 3&4 aan, de rest uit"));
+}

      ;
  }
}
 //Dit is gewoon om de status van de poorten te printen in de seriële console.
 //DEBUG, Niet nodig in finale code
void printStatusPorts() {
  Serial.print("PORTB: 0x");
  Serial.print(PORTB, HEX);

//Outputs
#define USEDPINS_PORTB 0xE0 //b1110 0000
#define USEDPINS_PORTD 0x0C //b0000 1100
#define USEDPINS_PORTE 0x38 //b0011 1000
#define USEDPINS_PORTH 0x7B //b0111 1011
#define USEDPINS_PORTJ 0x03 //b0000 0011

//Inputs
#define USEDPINS_PORTF 0xFF //b1111 1111
#define USEDPINS_PORTL 0xC7 //b1100 0111
#define USEDPINS_PORTG 0x03 //b0000 0011
#define USEDPINS_PORTD 0x80 //b1000 0000

# define aantalSamples 6


byte INPUT_1[aantalSamples];
byte INPUT_2[aantalSamples];
byte INPUT_3[aantalSamples];
byte INPUT_4[aantalSamples];
byte INPUT_5[aantalSamples];
byte INPUT_6[aantalSamples];
byte INPUT_7[aantalSamples];
byte INPUT_8[aantalSamples];
byte INPUT_9[aantalSamples];
byte INPUT_10[aantalSamples];
byte INPUT_11[aantalSamples];
byte INPUT_12[aantalSamples];
byte INPUT_13[aantalSamples];
byte INPUT_14[aantalSamples];
byte INPUT_15[aantalSamples];
byte INPUT_16[aantalSamples];

int index = 0;

unsigned int temp_INPUT_STATUS = 0x0000;

int INPUT_COMMAND_PORTB = 0x00;
int INPUT_COMMAND_PORTD = 0x00;
