#include <avr/io.h>
#include <util/atomic.h>
#include "io-helper.h"

volatile uint8_t outStates[nrOfOutputs/8];
volatile uint8_t inStatesRaw[nrOfInputs/8];
volatile uint8_t inStates[nrOfInputs/8];

volatile uint8_t outStatesBlinking[nrOfOutputs/8];

volatile uint8_t oldInstates[nrOfInputs/8];
volatile uint8_t inStatesBothEdges[nrOfInputs/8];
volatile uint8_t inStatesRisingEdge[nrOfInputs/8];
volatile uint8_t inStatesFallingEdge[nrOfInputs/8];

uint8_t read_Input(uint8_t nr, uint8_t type) {
  uint8_t state = 0;
  switch (type) {
    case LEVEL:
      state = ioHelperReadBit(inStates, nr);
      break;
    case EDGE:
      state = ioHelperReadBit(inStatesBothEdges, nr);
      ioHelperSetBit(inStatesBothEdges, nr, 0);
      break;
    case RISING:
      state = ioHelperReadBit(inStatesRisingEdge, nr);
      ioHelperSetBit(inStatesRisingEdge, nr, 0);
      break;
    case FALLING:
      state = ioHelperReadBit(inStatesFallingEdge, nr);
      ioHelperSetBit(inStatesFallingEdge, nr, 0);
      break;
  }

  return state;
}

void set_Output(uint8_t nr, uint8_t state) {
  switch (state) {
    case BLINK:
      ioHelperSetBit(outStatesBlinking,  nr,  ON);
      break;
    case TOGGLE:
      ioHelperSetBit(outStatesBlinking,  nr,  OFF);
      if (ioHelperReadBit(outStates, nr)) {
        ioHelperSetBit(outStates,  nr,  OFF);
      } else {
        ioHelperSetBit(outStates,  nr,  ON);
      }
      break;
    case ON:
      ioHelperSetBit(outStates,  nr,  ON);
      ioHelperSetBit(outStatesBlinking,  nr,  OFF);
      break;
    case OFF:
      ioHelperSetBit(outStates,  nr,  OFF);
      ioHelperSetBit(outStatesBlinking,  nr,  OFF);
      break;
  }
}

void ioHelperEdgeDetector(void){
    for (uint8_t i = 0; i < nrOfInputs/8; i++){
        inStatesBothEdges[i] = oldInstates[i] ^ inStates[i];
        inStatesRisingEdge[i] = inStatesBothEdges[i] & inStates[i];
        inStatesFallingEdge[i] = inStatesBothEdges[i] & oldInstates[i];
        oldInstates[i] = inStates[i];
    }
}

/* @brief: copies a single bit from one char to another char (or arrays thereof)
 *
 *
 */
void ioHelperCpArb(volatile uint8_t *source, uint16_t sourceNr,volatile uint8_t *target, uint16_t targetNr) {
    if(*(source+(sourceNr/8))&(1<<(sourceNr-((sourceNr/8)*8))))
    {
        *(target+(targetNr/8))|=(1<<(targetNr-((targetNr/8)*8)));
    } else *(target+(targetNr/8))&=~(1<<(targetNr-((targetNr/8)*8)));
}

volatile uint8_t ioHelperDebounceTable[nrOfInputs];

/* debounceing: */
void ioHelperDebounce(void) {
    static volatile uint8_t tablePos=0;
    for(uint8_t i = 0; i<nrOfInputs; i++) {
        ioHelperCpArb(inStatesRaw,i,ioHelperDebounceTable,i*8+tablePos);
        if(ioHelperDebounceTable[i]==0) ioHelperSetBit(inStates,i,0);
        else if(ioHelperDebounceTable[i]==0xFF) ioHelperSetBit(inStates,i,1);
    }
    if (tablePos<7) {
        tablePos++;
    } else tablePos=0;
}


void ioHelperSetBit(volatile uint8_t *list, uint8_t nr, uint8_t state) {
    unsigned char ArC=0;
    ArC=nr/8;
    if(state) *(list+ArC)|=(1<<(nr-(ArC*8)));
    else *(list+ArC)&=~(1<<(nr-(ArC*8)));
}

unsigned char ioHelperReadBit(volatile uint8_t *list, uint8_t nr) {
    unsigned char ArC=0;
    ArC=nr/8;
    if (*(list+ArC)&(1<<(nr-(ArC*8))))
    {
        return 1;
    } else return 0;
}

void ioHelperCpBit(uint8_t reg, uint8_t bi, uint8_t bo) {
    ioHelperSetBit(inStatesRaw,bo,reg&(1<<bi));
}

uint8_t getBit1(uint8_t bit) {
    if(ioHelperReadBit(outStates,bit)) return 1;
    else return 0;
}
uint8_t getBit0(uint8_t bit) {
    if(ioHelperReadBit(outStates,bit)) return 0;
    else return 1;
}

//void writeBit(volatile uint8_t * port, uint8_t bp, uint8_t bstate) {
//    if (outStates&(1<<bstate)) *(port) |= (1<<bp);
//    else *(port) &=~(1<<bp);
//}

void ioHelperIoConf(void) {
    for(uint8_t x=0; x<nrOfInputs; x++) {
        ioHelperDebounceTable[x]=0;
    }
    for(uint8_t x=0; x<nrOfInputs/8; x++) {
        inStates[x]=0;
        inStatesRaw[x]=0;
    }
    for(uint8_t x=0; x<nrOfOutputs/8; x++) {
        outStates[x]=0;
    }

#ifdef DDRA
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRA|=0
#ifdef BitPA0
            |(1<<0)
#endif
#ifdef BitPA1
            |(1<<1)
#endif
#ifdef BitPA2
            |(1<<2)
#endif
#ifdef BitPA3
            |(1<<3)
#endif
#ifdef BitPA4
            |(1<<4)
#endif
#ifdef BitPA5
            |(1<<5)
#endif
#ifdef BitPA6
            |(1<<6)
#endif
#ifdef BitPA7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRB
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRB|=0
#ifdef BitPB0
            |(1<<0)
#endif
#ifdef BitPB1
            |(1<<1)
#endif
#ifdef BitPB2
            |(1<<2)
#endif
#ifdef BitPB3
            |(1<<3)
#endif
#ifdef BitPB4
            |(1<<4)
#endif
#ifdef BitPB5
            |(1<<5)
#endif
#ifdef BitPB6
            |(1<<6)
#endif
#ifdef BitPB7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRC
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRC|=0
#ifdef BitPC0
            |(1<<0)
#endif
#ifdef BitPC1
            |(1<<1)
#endif
#ifdef BitPC2
            |(1<<2)
#endif
#ifdef BitPC3
            |(1<<3)
#endif
#ifdef BitPC4
            |(1<<4)
#endif
#ifdef BitPC5
            |(1<<5)
#endif
#ifdef BitPC6
            |(1<<6)
#endif
#ifdef BitPC7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRD
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRD|=0
#ifdef BitPD0
            |(1<<0)
#endif
#ifdef BitPD1
            |(1<<1)
#endif
#ifdef BitPD2
            |(1<<2)
#endif
#ifdef BitPD3
            |(1<<3)
#endif
#ifdef BitPD4
            |(1<<4)
#endif
#ifdef BitPD5
            |(1<<5)
#endif
#ifdef BitPD6
            |(1<<6)
#endif
#ifdef BitPD7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRE
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRE|=0
#ifdef BitPE0
            |(1<<0)
#endif
#ifdef BitPE1
            |(1<<1)
#endif
#ifdef BitPE2
            |(1<<2)
#endif
#ifdef BitPE3
            |(1<<3)
#endif
#ifdef BitPE4
            |(1<<4)
#endif
#ifdef BitPE5
            |(1<<5)
#endif
#ifdef BitPE6
            |(1<<6)
#endif
#ifdef BitPE7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRF
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRF|=0
#ifdef BitPF0
            |(1<<0)
#endif
#ifdef BitPF1
            |(1<<1)
#endif
#ifdef BitPF2
            |(1<<2)
#endif
#ifdef BitPF3
            |(1<<3)
#endif
#ifdef BitPF4
            |(1<<4)
#endif
#ifdef BitPF5
            |(1<<5)
#endif
#ifdef BitPF6
            |(1<<6)
#endif
#ifdef BitPF7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRG
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRG|=0
#ifdef BitPG0
            |(1<<0)
#endif
#ifdef BitPG1
            |(1<<1)
#endif
#ifdef BitPG2
            |(1<<2)
#endif
#ifdef BitPG3
            |(1<<3)
#endif
#ifdef BitPG4
            |(1<<4)
#endif
#ifdef BitPG5
            |(1<<5)
#endif
#ifdef BitPG6
            |(1<<6)
#endif
#ifdef BitPG7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRH
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRH|=0
#ifdef BitPH0
            |(1<<0)
#endif
#ifdef BitPH1
            |(1<<1)
#endif
#ifdef BitPH2
            |(1<<2)
#endif
#ifdef BitPH3
            |(1<<3)
#endif
#ifdef BitPH4
            |(1<<4)
#endif
#ifdef BitPH5
            |(1<<5)
#endif
#ifdef BitPH6
            |(1<<6)
#endif
#ifdef BitPH7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRI
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRI|=0
#ifdef BitPI0
            |(1<<0)
#endif
#ifdef BitPI1
            |(1<<1)
#endif
#ifdef BitPI2
            |(1<<2)
#endif
#ifdef BitPI3
            |(1<<3)
#endif
#ifdef BitPI4
            |(1<<4)
#endif
#ifdef BitPI5
            |(1<<5)
#endif
#ifdef BitPI6
            |(1<<6)
#endif
#ifdef BitPI7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRJ
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRJ|=0
#ifdef BitPJ0
            |(1<<0)
#endif
#ifdef BitPJ1
            |(1<<1)
#endif
#ifdef BitPJ2
            |(1<<2)
#endif
#ifdef BitPJ3
            |(1<<3)
#endif
#ifdef BitPJ4
            |(1<<4)
#endif
#ifdef BitPJ5
            |(1<<5)
#endif
#ifdef BitPJ6
            |(1<<6)
#endif
#ifdef BitPJ7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRK
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRK|=0
#ifdef BitPK0
            |(1<<0)
#endif
#ifdef BitPK1
            |(1<<1)
#endif
#ifdef BitPK2
            |(1<<2)
#endif
#ifdef BitPK3
            |(1<<3)
#endif
#ifdef BitPK4
            |(1<<4)
#endif
#ifdef BitPK5
            |(1<<5)
#endif
#ifdef BitPK6
            |(1<<6)
#endif
#ifdef BitPK7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRL
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRL|=0
#ifdef BitPL0
            |(1<<0)
#endif
#ifdef BitPL1
            |(1<<1)
#endif
#ifdef BitPL2
            |(1<<2)
#endif
#ifdef BitPL3
            |(1<<3)
#endif
#ifdef BitPL4
            |(1<<4)
#endif
#ifdef BitPL5
            |(1<<5)
#endif
#ifdef BitPL6
            |(1<<6)
#endif
#ifdef BitPL7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRM
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRM|=0
#ifdef BitPM0
            |(1<<0)
#endif
#ifdef BitPM1
            |(1<<1)
#endif
#ifdef BitPM2
            |(1<<2)
#endif
#ifdef BitPM3
            |(1<<3)
#endif
#ifdef BitPM4
            |(1<<4)
#endif
#ifdef BitPM5
            |(1<<5)
#endif
#ifdef BitPM6
            |(1<<6)
#endif
#ifdef BitPM7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRN
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRN|=0
#ifdef BitPN0
            |(1<<0)
#endif
#ifdef BitPN1
            |(1<<1)
#endif
#ifdef BitPN2
            |(1<<2)
#endif
#ifdef BitPN3
            |(1<<3)
#endif
#ifdef BitPN4
            |(1<<4)
#endif
#ifdef BitPN5
            |(1<<5)
#endif
#ifdef BitPN6
            |(1<<6)
#endif
#ifdef BitPN7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRO
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRO|=0
#ifdef BitPO0
            |(1<<0)
#endif
#ifdef BitPO1
            |(1<<1)
#endif
#ifdef BitPO2
            |(1<<2)
#endif
#ifdef BitPO3
            |(1<<3)
#endif
#ifdef BitPO4
            |(1<<4)
#endif
#ifdef BitPO5
            |(1<<5)
#endif
#ifdef BitPO6
            |(1<<6)
#endif
#ifdef BitPO7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRP
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRP|=0
#ifdef BitPP0
            |(1<<0)
#endif
#ifdef BitPP1
            |(1<<1)
#endif
#ifdef BitPP2
            |(1<<2)
#endif
#ifdef BitPP3
            |(1<<3)
#endif
#ifdef BitPP4
            |(1<<4)
#endif
#ifdef BitPP5
            |(1<<5)
#endif
#ifdef BitPP6
            |(1<<6)
#endif
#ifdef BitPP7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRQ
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRQ|=0
#ifdef BitPQ0
            |(1<<0)
#endif
#ifdef BitPQ1
            |(1<<1)
#endif
#ifdef BitPQ2
            |(1<<2)
#endif
#ifdef BitPQ3
            |(1<<3)
#endif
#ifdef BitPQ4
            |(1<<4)
#endif
#ifdef BitPQ5
            |(1<<5)
#endif
#ifdef BitPQ6
            |(1<<6)
#endif
#ifdef BitPQ7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRR
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRR|=0
#ifdef BitPR0
            |(1<<0)
#endif
#ifdef BitPR1
            |(1<<1)
#endif
#ifdef BitPR2
            |(1<<2)
#endif
#ifdef BitPR3
            |(1<<3)
#endif
#ifdef BitPR4
            |(1<<4)
#endif
#ifdef BitPR5
            |(1<<5)
#endif
#ifdef BitPR6
            |(1<<6)
#endif
#ifdef BitPR7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRS
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRS|=0
#ifdef BitPS0
            |(1<<0)
#endif
#ifdef BitPS1
            |(1<<1)
#endif
#ifdef BitPS2
            |(1<<2)
#endif
#ifdef BitPS3
            |(1<<3)
#endif
#ifdef BitPS4
            |(1<<4)
#endif
#ifdef BitPS5
            |(1<<5)
#endif
#ifdef BitPS6
            |(1<<6)
#endif
#ifdef BitPS7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRT
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRT|=0
#ifdef BitPT0
            |(1<<0)
#endif
#ifdef BitPT1
            |(1<<1)
#endif
#ifdef BitPT2
            |(1<<2)
#endif
#ifdef BitPT3
            |(1<<3)
#endif
#ifdef BitPT4
            |(1<<4)
#endif
#ifdef BitPT5
            |(1<<5)
#endif
#ifdef BitPT6
            |(1<<6)
#endif
#ifdef BitPT7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRU
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRU|=0
#ifdef BitPU0
            |(1<<0)
#endif
#ifdef BitPU1
            |(1<<1)
#endif
#ifdef BitPU2
            |(1<<2)
#endif
#ifdef BitPU3
            |(1<<3)
#endif
#ifdef BitPU4
            |(1<<4)
#endif
#ifdef BitPU5
            |(1<<5)
#endif
#ifdef BitPU6
            |(1<<6)
#endif
#ifdef BitPU7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRV
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRV|=0
#ifdef BitPV0
            |(1<<0)
#endif
#ifdef BitPV1
            |(1<<1)
#endif
#ifdef BitPV2
            |(1<<2)
#endif
#ifdef BitPV3
            |(1<<3)
#endif
#ifdef BitPV4
            |(1<<4)
#endif
#ifdef BitPV5
            |(1<<5)
#endif
#ifdef BitPV6
            |(1<<6)
#endif
#ifdef BitPV7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRW
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRW|=0
#ifdef BitPW0
            |(1<<0)
#endif
#ifdef BitPW1
            |(1<<1)
#endif
#ifdef BitPW2
            |(1<<2)
#endif
#ifdef BitPW3
            |(1<<3)
#endif
#ifdef BitPW4
            |(1<<4)
#endif
#ifdef BitPW5
            |(1<<5)
#endif
#ifdef BitPW6
            |(1<<6)
#endif
#ifdef BitPW7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRX
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRX|=0
#ifdef BitPX0
            |(1<<0)
#endif
#ifdef BitPX1
            |(1<<1)
#endif
#ifdef BitPX2
            |(1<<2)
#endif
#ifdef BitPX3
            |(1<<3)
#endif
#ifdef BitPX4
            |(1<<4)
#endif
#ifdef BitPX5
            |(1<<5)
#endif
#ifdef BitPX6
            |(1<<6)
#endif
#ifdef BitPX7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRY
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRY|=0
#ifdef BitPY0
            |(1<<0)
#endif
#ifdef BitPY1
            |(1<<1)
#endif
#ifdef BitPY2
            |(1<<2)
#endif
#ifdef BitPY3
            |(1<<3)
#endif
#ifdef BitPY4
            |(1<<4)
#endif
#ifdef BitPY5
            |(1<<5)
#endif
#ifdef BitPY6
            |(1<<6)
#endif
#ifdef BitPY7
            |(1<<7)
#endif
            |0;
    }
#endif


#ifdef DDRZ
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        DDRZ|=0
#ifdef BitPZ0
            |(1<<0)
#endif
#ifdef BitPZ1
            |(1<<1)
#endif
#ifdef BitPZ2
            |(1<<2)
#endif
#ifdef BitPZ3
            |(1<<3)
#endif
#ifdef BitPZ4
            |(1<<4)
#endif
#ifdef BitPZ5
            |(1<<5)
#endif
#ifdef BitPZ6
            |(1<<6)
#endif
#ifdef BitPZ7
            |(1<<7)
#endif
            |0;
    }
#endif
}


void ioHelperSetOuts(void) {
#ifdef PORTA
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTA|=0
#ifdef BitPA0
            |(getBit1(BitPA0)<<0)
#endif
#ifdef BitPA1
            |(getBit1(BitPA1)<<1)
#endif
#ifdef BitPA2
            |(getBit1(BitPA2)<<2)
#endif
#ifdef BitPA3
            |(getBit1(BitPA3)<<3)
#endif
#ifdef BitPA4
            |(getBit1(BitPA4)<<4)
#endif
#ifdef BitPA5
            |(getBit1(BitPA5)<<5)
#endif
#ifdef BitPA6
            |(getBit1(BitPA6)<<6)
#endif
#ifdef BitPA7
            |(getBit1(BitPA7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTA&=~(0
#ifdef BitPA0
                |(getBit0(BitPA0)<<0)
#endif
#ifdef BitPA1
                |(getBit0(BitPA1)<<1)
#endif
#ifdef BitPA2
                |(getBit0(BitPA2)<<2)
#endif
#ifdef BitPA3
                |(getBit0(BitPA3)<<3)
#endif
#ifdef BitPA4
                |(getBit0(BitPA4)<<4)
#endif
#ifdef BitPA5
                |(getBit0(BitPA5)<<5)
#endif
#ifdef BitPA6
                |(getBit0(BitPA6)<<6)
#endif
#ifdef BitPA7
                |(getBit0(BitPA7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTB
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTB|=0
#ifdef BitPB0
            |(getBit1(BitPB0)<<0)
#endif
#ifdef BitPB1
            |(getBit1(BitPB1)<<1)
#endif
#ifdef BitPB2
            |(getBit1(BitPB2)<<2)
#endif
#ifdef BitPB3
            |(getBit1(BitPB3)<<3)
#endif
#ifdef BitPB4
            |(getBit1(BitPB4)<<4)
#endif
#ifdef BitPB5
            |(getBit1(BitPB5)<<5)
#endif
#ifdef BitPB6
            |(getBit1(BitPB6)<<6)
#endif
#ifdef BitPB7
            |(getBit1(BitPB7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTB&=~(0
#ifdef BitPB0
                |(getBit0(BitPB0)<<0)
#endif
#ifdef BitPB1
                |(getBit0(BitPB1)<<1)
#endif
#ifdef BitPB2
                |(getBit0(BitPB2)<<2)
#endif
#ifdef BitPB3
                |(getBit0(BitPB3)<<3)
#endif
#ifdef BitPB4
                |(getBit0(BitPB4)<<4)
#endif
#ifdef BitPB5
                |(getBit0(BitPB5)<<5)
#endif
#ifdef BitPB6
                |(getBit0(BitPB6)<<6)
#endif
#ifdef BitPB7
                |(getBit0(BitPB7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTC
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTC|=0
#ifdef BitPC0
            |(getBit1(BitPC0)<<0)
#endif
#ifdef BitPC1
            |(getBit1(BitPC1)<<1)
#endif
#ifdef BitPC2
            |(getBit1(BitPC2)<<2)
#endif
#ifdef BitPC3
            |(getBit1(BitPC3)<<3)
#endif
#ifdef BitPC4
            |(getBit1(BitPC4)<<4)
#endif
#ifdef BitPC5
            |(getBit1(BitPC5)<<5)
#endif
#ifdef BitPC6
            |(getBit1(BitPC6)<<6)
#endif
#ifdef BitPC7
            |(getBit1(BitPC7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTC&=~(0
#ifdef BitPC0
                |(getBit0(BitPC0)<<0)
#endif
#ifdef BitPC1
                |(getBit0(BitPC1)<<1)
#endif
#ifdef BitPC2
                |(getBit0(BitPC2)<<2)
#endif
#ifdef BitPC3
                |(getBit0(BitPC3)<<3)
#endif
#ifdef BitPC4
                |(getBit0(BitPC4)<<4)
#endif
#ifdef BitPC5
                |(getBit0(BitPC5)<<5)
#endif
#ifdef BitPC6
                |(getBit0(BitPC6)<<6)
#endif
#ifdef BitPC7
                |(getBit0(BitPC7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTD
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTD|=0
#ifdef BitPD0
            |(getBit1(BitPD0)<<0)
#endif
#ifdef BitPD1
            |(getBit1(BitPD1)<<1)
#endif
#ifdef BitPD2
            |(getBit1(BitPD2)<<2)
#endif
#ifdef BitPD3
            |(getBit1(BitPD3)<<3)
#endif
#ifdef BitPD4
            |(getBit1(BitPD4)<<4)
#endif
#ifdef BitPD5
            |(getBit1(BitPD5)<<5)
#endif
#ifdef BitPD6
            |(getBit1(BitPD6)<<6)
#endif
#ifdef BitPD7
            |(getBit1(BitPD7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTD&=~(0
#ifdef BitPD0
                |(getBit0(BitPD0)<<0)
#endif
#ifdef BitPD1
                |(getBit0(BitPD1)<<1)
#endif
#ifdef BitPD2
                |(getBit0(BitPD2)<<2)
#endif
#ifdef BitPD3
                |(getBit0(BitPD3)<<3)
#endif
#ifdef BitPD4
                |(getBit0(BitPD4)<<4)
#endif
#ifdef BitPD5
                |(getBit0(BitPD5)<<5)
#endif
#ifdef BitPD6
                |(getBit0(BitPD6)<<6)
#endif
#ifdef BitPD7
                |(getBit0(BitPD7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTE
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTE|=0
#ifdef BitPE0
            |(getBit1(BitPE0)<<0)
#endif
#ifdef BitPE1
            |(getBit1(BitPE1)<<1)
#endif
#ifdef BitPE2
            |(getBit1(BitPE2)<<2)
#endif
#ifdef BitPE3
            |(getBit1(BitPE3)<<3)
#endif
#ifdef BitPE4
            |(getBit1(BitPE4)<<4)
#endif
#ifdef BitPE5
            |(getBit1(BitPE5)<<5)
#endif
#ifdef BitPE6
            |(getBit1(BitPE6)<<6)
#endif
#ifdef BitPE7
            |(getBit1(BitPE7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTE&=~(0
#ifdef BitPE0
                |(getBit0(BitPE0)<<0)
#endif
#ifdef BitPE1
                |(getBit0(BitPE1)<<1)
#endif
#ifdef BitPE2
                |(getBit0(BitPE2)<<2)
#endif
#ifdef BitPE3
                |(getBit0(BitPE3)<<3)
#endif
#ifdef BitPE4
                |(getBit0(BitPE4)<<4)
#endif
#ifdef BitPE5
                |(getBit0(BitPE5)<<5)
#endif
#ifdef BitPE6
                |(getBit0(BitPE6)<<6)
#endif
#ifdef BitPE7
                |(getBit0(BitPE7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTF
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTF|=0
#ifdef BitPF0
            |(getBit1(BitPF0)<<0)
#endif
#ifdef BitPF1
            |(getBit1(BitPF1)<<1)
#endif
#ifdef BitPF2
            |(getBit1(BitPF2)<<2)
#endif
#ifdef BitPF3
            |(getBit1(BitPF3)<<3)
#endif
#ifdef BitPF4
            |(getBit1(BitPF4)<<4)
#endif
#ifdef BitPF5
            |(getBit1(BitPF5)<<5)
#endif
#ifdef BitPF6
            |(getBit1(BitPF6)<<6)
#endif
#ifdef BitPF7
            |(getBit1(BitPF7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTF&=~(0
#ifdef BitPF0
                |(getBit0(BitPF0)<<0)
#endif
#ifdef BitPF1
                |(getBit0(BitPF1)<<1)
#endif
#ifdef BitPF2
                |(getBit0(BitPF2)<<2)
#endif
#ifdef BitPF3
                |(getBit0(BitPF3)<<3)
#endif
#ifdef BitPF4
                |(getBit0(BitPF4)<<4)
#endif
#ifdef BitPF5
                |(getBit0(BitPF5)<<5)
#endif
#ifdef BitPF6
                |(getBit0(BitPF6)<<6)
#endif
#ifdef BitPF7
                |(getBit0(BitPF7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTG
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTG|=0
#ifdef BitPG0
            |(getBit1(BitPG0)<<0)
#endif
#ifdef BitPG1
            |(getBit1(BitPG1)<<1)
#endif
#ifdef BitPG2
            |(getBit1(BitPG2)<<2)
#endif
#ifdef BitPG3
            |(getBit1(BitPG3)<<3)
#endif
#ifdef BitPG4
            |(getBit1(BitPG4)<<4)
#endif
#ifdef BitPG5
            |(getBit1(BitPG5)<<5)
#endif
#ifdef BitPG6
            |(getBit1(BitPG6)<<6)
#endif
#ifdef BitPG7
            |(getBit1(BitPG7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTG&=~(0
#ifdef BitPG0
                |(getBit0(BitPG0)<<0)
#endif
#ifdef BitPG1
                |(getBit0(BitPG1)<<1)
#endif
#ifdef BitPG2
                |(getBit0(BitPG2)<<2)
#endif
#ifdef BitPG3
                |(getBit0(BitPG3)<<3)
#endif
#ifdef BitPG4
                |(getBit0(BitPG4)<<4)
#endif
#ifdef BitPG5
                |(getBit0(BitPG5)<<5)
#endif
#ifdef BitPG6
                |(getBit0(BitPG6)<<6)
#endif
#ifdef BitPG7
                |(getBit0(BitPG7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTH
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTH|=0
#ifdef BitPH0
            |(getBit1(BitPH0)<<0)
#endif
#ifdef BitPH1
            |(getBit1(BitPH1)<<1)
#endif
#ifdef BitPH2
            |(getBit1(BitPH2)<<2)
#endif
#ifdef BitPH3
            |(getBit1(BitPH3)<<3)
#endif
#ifdef BitPH4
            |(getBit1(BitPH4)<<4)
#endif
#ifdef BitPH5
            |(getBit1(BitPH5)<<5)
#endif
#ifdef BitPH6
            |(getBit1(BitPH6)<<6)
#endif
#ifdef BitPH7
            |(getBit1(BitPH7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTH&=~(0
#ifdef BitPH0
                |(getBit0(BitPH0)<<0)
#endif
#ifdef BitPH1
                |(getBit0(BitPH1)<<1)
#endif
#ifdef BitPH2
                |(getBit0(BitPH2)<<2)
#endif
#ifdef BitPH3
                |(getBit0(BitPH3)<<3)
#endif
#ifdef BitPH4
                |(getBit0(BitPH4)<<4)
#endif
#ifdef BitPH5
                |(getBit0(BitPH5)<<5)
#endif
#ifdef BitPH6
                |(getBit0(BitPH6)<<6)
#endif
#ifdef BitPH7
                |(getBit0(BitPH7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTI
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTI|=0
#ifdef BitPI0
            |(getBit1(BitPI0)<<0)
#endif
#ifdef BitPI1
            |(getBit1(BitPI1)<<1)
#endif
#ifdef BitPI2
            |(getBit1(BitPI2)<<2)
#endif
#ifdef BitPI3
            |(getBit1(BitPI3)<<3)
#endif
#ifdef BitPI4
            |(getBit1(BitPI4)<<4)
#endif
#ifdef BitPI5
            |(getBit1(BitPI5)<<5)
#endif
#ifdef BitPI6
            |(getBit1(BitPI6)<<6)
#endif
#ifdef BitPI7
            |(getBit1(BitPI7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTI&=~(0
#ifdef BitPI0
                |(getBit0(BitPI0)<<0)
#endif
#ifdef BitPI1
                |(getBit0(BitPI1)<<1)
#endif
#ifdef BitPI2
                |(getBit0(BitPI2)<<2)
#endif
#ifdef BitPI3
                |(getBit0(BitPI3)<<3)
#endif
#ifdef BitPI4
                |(getBit0(BitPI4)<<4)
#endif
#ifdef BitPI5
                |(getBit0(BitPI5)<<5)
#endif
#ifdef BitPI6
                |(getBit0(BitPI6)<<6)
#endif
#ifdef BitPI7
                |(getBit0(BitPI7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTJ
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTJ|=0
#ifdef BitPJ0
            |(getBit1(BitPJ0)<<0)
#endif
#ifdef BitPJ1
            |(getBit1(BitPJ1)<<1)
#endif
#ifdef BitPJ2
            |(getBit1(BitPJ2)<<2)
#endif
#ifdef BitPJ3
            |(getBit1(BitPJ3)<<3)
#endif
#ifdef BitPJ4
            |(getBit1(BitPJ4)<<4)
#endif
#ifdef BitPJ5
            |(getBit1(BitPJ5)<<5)
#endif
#ifdef BitPJ6
            |(getBit1(BitPJ6)<<6)
#endif
#ifdef BitPJ7
            |(getBit1(BitPJ7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTJ&=~(0
#ifdef BitPJ0
                |(getBit0(BitPJ0)<<0)
#endif
#ifdef BitPJ1
                |(getBit0(BitPJ1)<<1)
#endif
#ifdef BitPJ2
                |(getBit0(BitPJ2)<<2)
#endif
#ifdef BitPJ3
                |(getBit0(BitPJ3)<<3)
#endif
#ifdef BitPJ4
                |(getBit0(BitPJ4)<<4)
#endif
#ifdef BitPJ5
                |(getBit0(BitPJ5)<<5)
#endif
#ifdef BitPJ6
                |(getBit0(BitPJ6)<<6)
#endif
#ifdef BitPJ7
                |(getBit0(BitPJ7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTK
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTK|=0
#ifdef BitPK0
            |(getBit1(BitPK0)<<0)
#endif
#ifdef BitPK1
            |(getBit1(BitPK1)<<1)
#endif
#ifdef BitPK2
            |(getBit1(BitPK2)<<2)
#endif
#ifdef BitPK3
            |(getBit1(BitPK3)<<3)
#endif
#ifdef BitPK4
            |(getBit1(BitPK4)<<4)
#endif
#ifdef BitPK5
            |(getBit1(BitPK5)<<5)
#endif
#ifdef BitPK6
            |(getBit1(BitPK6)<<6)
#endif
#ifdef BitPK7
            |(getBit1(BitPK7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTK&=~(0
#ifdef BitPK0
                |(getBit0(BitPK0)<<0)
#endif
#ifdef BitPK1
                |(getBit0(BitPK1)<<1)
#endif
#ifdef BitPK2
                |(getBit0(BitPK2)<<2)
#endif
#ifdef BitPK3
                |(getBit0(BitPK3)<<3)
#endif
#ifdef BitPK4
                |(getBit0(BitPK4)<<4)
#endif
#ifdef BitPK5
                |(getBit0(BitPK5)<<5)
#endif
#ifdef BitPK6
                |(getBit0(BitPK6)<<6)
#endif
#ifdef BitPK7
                |(getBit0(BitPK7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTL
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTL|=0
#ifdef BitPL0
            |(getBit1(BitPL0)<<0)
#endif
#ifdef BitPL1
            |(getBit1(BitPL1)<<1)
#endif
#ifdef BitPL2
            |(getBit1(BitPL2)<<2)
#endif
#ifdef BitPL3
            |(getBit1(BitPL3)<<3)
#endif
#ifdef BitPL4
            |(getBit1(BitPL4)<<4)
#endif
#ifdef BitPL5
            |(getBit1(BitPL5)<<5)
#endif
#ifdef BitPL6
            |(getBit1(BitPL6)<<6)
#endif
#ifdef BitPL7
            |(getBit1(BitPL7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTL&=~(0
#ifdef BitPL0
                |(getBit0(BitPL0)<<0)
#endif
#ifdef BitPL1
                |(getBit0(BitPL1)<<1)
#endif
#ifdef BitPL2
                |(getBit0(BitPL2)<<2)
#endif
#ifdef BitPL3
                |(getBit0(BitPL3)<<3)
#endif
#ifdef BitPL4
                |(getBit0(BitPL4)<<4)
#endif
#ifdef BitPL5
                |(getBit0(BitPL5)<<5)
#endif
#ifdef BitPL6
                |(getBit0(BitPL6)<<6)
#endif
#ifdef BitPL7
                |(getBit0(BitPL7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTM
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTM|=0
#ifdef BitPM0
            |(getBit1(BitPM0)<<0)
#endif
#ifdef BitPM1
            |(getBit1(BitPM1)<<1)
#endif
#ifdef BitPM2
            |(getBit1(BitPM2)<<2)
#endif
#ifdef BitPM3
            |(getBit1(BitPM3)<<3)
#endif
#ifdef BitPM4
            |(getBit1(BitPM4)<<4)
#endif
#ifdef BitPM5
            |(getBit1(BitPM5)<<5)
#endif
#ifdef BitPM6
            |(getBit1(BitPM6)<<6)
#endif
#ifdef BitPM7
            |(getBit1(BitPM7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTM&=~(0
#ifdef BitPM0
                |(getBit0(BitPM0)<<0)
#endif
#ifdef BitPM1
                |(getBit0(BitPM1)<<1)
#endif
#ifdef BitPM2
                |(getBit0(BitPM2)<<2)
#endif
#ifdef BitPM3
                |(getBit0(BitPM3)<<3)
#endif
#ifdef BitPM4
                |(getBit0(BitPM4)<<4)
#endif
#ifdef BitPM5
                |(getBit0(BitPM5)<<5)
#endif
#ifdef BitPM6
                |(getBit0(BitPM6)<<6)
#endif
#ifdef BitPM7
                |(getBit0(BitPM7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTN
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTN|=0
#ifdef BitPN0
            |(getBit1(BitPN0)<<0)
#endif
#ifdef BitPN1
            |(getBit1(BitPN1)<<1)
#endif
#ifdef BitPN2
            |(getBit1(BitPN2)<<2)
#endif
#ifdef BitPN3
            |(getBit1(BitPN3)<<3)
#endif
#ifdef BitPN4
            |(getBit1(BitPN4)<<4)
#endif
#ifdef BitPN5
            |(getBit1(BitPN5)<<5)
#endif
#ifdef BitPN6
            |(getBit1(BitPN6)<<6)
#endif
#ifdef BitPN7
            |(getBit1(BitPN7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTN&=~(0
#ifdef BitPN0
                |(getBit0(BitPN0)<<0)
#endif
#ifdef BitPN1
                |(getBit0(BitPN1)<<1)
#endif
#ifdef BitPN2
                |(getBit0(BitPN2)<<2)
#endif
#ifdef BitPN3
                |(getBit0(BitPN3)<<3)
#endif
#ifdef BitPN4
                |(getBit0(BitPN4)<<4)
#endif
#ifdef BitPN5
                |(getBit0(BitPN5)<<5)
#endif
#ifdef BitPN6
                |(getBit0(BitPN6)<<6)
#endif
#ifdef BitPN7
                |(getBit0(BitPN7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTO
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTO|=0
#ifdef BitPO0
            |(getBit1(BitPO0)<<0)
#endif
#ifdef BitPO1
            |(getBit1(BitPO1)<<1)
#endif
#ifdef BitPO2
            |(getBit1(BitPO2)<<2)
#endif
#ifdef BitPO3
            |(getBit1(BitPO3)<<3)
#endif
#ifdef BitPO4
            |(getBit1(BitPO4)<<4)
#endif
#ifdef BitPO5
            |(getBit1(BitPO5)<<5)
#endif
#ifdef BitPO6
            |(getBit1(BitPO6)<<6)
#endif
#ifdef BitPO7
            |(getBit1(BitPO7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTO&=~(0
#ifdef BitPO0
                |(getBit0(BitPO0)<<0)
#endif
#ifdef BitPO1
                |(getBit0(BitPO1)<<1)
#endif
#ifdef BitPO2
                |(getBit0(BitPO2)<<2)
#endif
#ifdef BitPO3
                |(getBit0(BitPO3)<<3)
#endif
#ifdef BitPO4
                |(getBit0(BitPO4)<<4)
#endif
#ifdef BitPO5
                |(getBit0(BitPO5)<<5)
#endif
#ifdef BitPO6
                |(getBit0(BitPO6)<<6)
#endif
#ifdef BitPO7
                |(getBit0(BitPO7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTP
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTP|=0
#ifdef BitPP0
            |(getBit1(BitPP0)<<0)
#endif
#ifdef BitPP1
            |(getBit1(BitPP1)<<1)
#endif
#ifdef BitPP2
            |(getBit1(BitPP2)<<2)
#endif
#ifdef BitPP3
            |(getBit1(BitPP3)<<3)
#endif
#ifdef BitPP4
            |(getBit1(BitPP4)<<4)
#endif
#ifdef BitPP5
            |(getBit1(BitPP5)<<5)
#endif
#ifdef BitPP6
            |(getBit1(BitPP6)<<6)
#endif
#ifdef BitPP7
            |(getBit1(BitPP7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTP&=~(0
#ifdef BitPP0
                |(getBit0(BitPP0)<<0)
#endif
#ifdef BitPP1
                |(getBit0(BitPP1)<<1)
#endif
#ifdef BitPP2
                |(getBit0(BitPP2)<<2)
#endif
#ifdef BitPP3
                |(getBit0(BitPP3)<<3)
#endif
#ifdef BitPP4
                |(getBit0(BitPP4)<<4)
#endif
#ifdef BitPP5
                |(getBit0(BitPP5)<<5)
#endif
#ifdef BitPP6
                |(getBit0(BitPP6)<<6)
#endif
#ifdef BitPP7
                |(getBit0(BitPP7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTQ
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTQ|=0
#ifdef BitPQ0
            |(getBit1(BitPQ0)<<0)
#endif
#ifdef BitPQ1
            |(getBit1(BitPQ1)<<1)
#endif
#ifdef BitPQ2
            |(getBit1(BitPQ2)<<2)
#endif
#ifdef BitPQ3
            |(getBit1(BitPQ3)<<3)
#endif
#ifdef BitPQ4
            |(getBit1(BitPQ4)<<4)
#endif
#ifdef BitPQ5
            |(getBit1(BitPQ5)<<5)
#endif
#ifdef BitPQ6
            |(getBit1(BitPQ6)<<6)
#endif
#ifdef BitPQ7
            |(getBit1(BitPQ7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTQ&=~(0
#ifdef BitPQ0
                |(getBit0(BitPQ0)<<0)
#endif
#ifdef BitPQ1
                |(getBit0(BitPQ1)<<1)
#endif
#ifdef BitPQ2
                |(getBit0(BitPQ2)<<2)
#endif
#ifdef BitPQ3
                |(getBit0(BitPQ3)<<3)
#endif
#ifdef BitPQ4
                |(getBit0(BitPQ4)<<4)
#endif
#ifdef BitPQ5
                |(getBit0(BitPQ5)<<5)
#endif
#ifdef BitPQ6
                |(getBit0(BitPQ6)<<6)
#endif
#ifdef BitPQ7
                |(getBit0(BitPQ7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTR
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTR|=0
#ifdef BitPR0
            |(getBit1(BitPR0)<<0)
#endif
#ifdef BitPR1
            |(getBit1(BitPR1)<<1)
#endif
#ifdef BitPR2
            |(getBit1(BitPR2)<<2)
#endif
#ifdef BitPR3
            |(getBit1(BitPR3)<<3)
#endif
#ifdef BitPR4
            |(getBit1(BitPR4)<<4)
#endif
#ifdef BitPR5
            |(getBit1(BitPR5)<<5)
#endif
#ifdef BitPR6
            |(getBit1(BitPR6)<<6)
#endif
#ifdef BitPR7
            |(getBit1(BitPR7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTR&=~(0
#ifdef BitPR0
                |(getBit0(BitPR0)<<0)
#endif
#ifdef BitPR1
                |(getBit0(BitPR1)<<1)
#endif
#ifdef BitPR2
                |(getBit0(BitPR2)<<2)
#endif
#ifdef BitPR3
                |(getBit0(BitPR3)<<3)
#endif
#ifdef BitPR4
                |(getBit0(BitPR4)<<4)
#endif
#ifdef BitPR5
                |(getBit0(BitPR5)<<5)
#endif
#ifdef BitPR6
                |(getBit0(BitPR6)<<6)
#endif
#ifdef BitPR7
                |(getBit0(BitPR7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTS
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTS|=0
#ifdef BitPS0
            |(getBit1(BitPS0)<<0)
#endif
#ifdef BitPS1
            |(getBit1(BitPS1)<<1)
#endif
#ifdef BitPS2
            |(getBit1(BitPS2)<<2)
#endif
#ifdef BitPS3
            |(getBit1(BitPS3)<<3)
#endif
#ifdef BitPS4
            |(getBit1(BitPS4)<<4)
#endif
#ifdef BitPS5
            |(getBit1(BitPS5)<<5)
#endif
#ifdef BitPS6
            |(getBit1(BitPS6)<<6)
#endif
#ifdef BitPS7
            |(getBit1(BitPS7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTS&=~(0
#ifdef BitPS0
                |(getBit0(BitPS0)<<0)
#endif
#ifdef BitPS1
                |(getBit0(BitPS1)<<1)
#endif
#ifdef BitPS2
                |(getBit0(BitPS2)<<2)
#endif
#ifdef BitPS3
                |(getBit0(BitPS3)<<3)
#endif
#ifdef BitPS4
                |(getBit0(BitPS4)<<4)
#endif
#ifdef BitPS5
                |(getBit0(BitPS5)<<5)
#endif
#ifdef BitPS6
                |(getBit0(BitPS6)<<6)
#endif
#ifdef BitPS7
                |(getBit0(BitPS7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTT
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTT|=0
#ifdef BitPT0
            |(getBit1(BitPT0)<<0)
#endif
#ifdef BitPT1
            |(getBit1(BitPT1)<<1)
#endif
#ifdef BitPT2
            |(getBit1(BitPT2)<<2)
#endif
#ifdef BitPT3
            |(getBit1(BitPT3)<<3)
#endif
#ifdef BitPT4
            |(getBit1(BitPT4)<<4)
#endif
#ifdef BitPT5
            |(getBit1(BitPT5)<<5)
#endif
#ifdef BitPT6
            |(getBit1(BitPT6)<<6)
#endif
#ifdef BitPT7
            |(getBit1(BitPT7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTT&=~(0
#ifdef BitPT0
                |(getBit0(BitPT0)<<0)
#endif
#ifdef BitPT1
                |(getBit0(BitPT1)<<1)
#endif
#ifdef BitPT2
                |(getBit0(BitPT2)<<2)
#endif
#ifdef BitPT3
                |(getBit0(BitPT3)<<3)
#endif
#ifdef BitPT4
                |(getBit0(BitPT4)<<4)
#endif
#ifdef BitPT5
                |(getBit0(BitPT5)<<5)
#endif
#ifdef BitPT6
                |(getBit0(BitPT6)<<6)
#endif
#ifdef BitPT7
                |(getBit0(BitPT7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTU
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTU|=0
#ifdef BitPU0
            |(getBit1(BitPU0)<<0)
#endif
#ifdef BitPU1
            |(getBit1(BitPU1)<<1)
#endif
#ifdef BitPU2
            |(getBit1(BitPU2)<<2)
#endif
#ifdef BitPU3
            |(getBit1(BitPU3)<<3)
#endif
#ifdef BitPU4
            |(getBit1(BitPU4)<<4)
#endif
#ifdef BitPU5
            |(getBit1(BitPU5)<<5)
#endif
#ifdef BitPU6
            |(getBit1(BitPU6)<<6)
#endif
#ifdef BitPU7
            |(getBit1(BitPU7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTU&=~(0
#ifdef BitPU0
                |(getBit0(BitPU0)<<0)
#endif
#ifdef BitPU1
                |(getBit0(BitPU1)<<1)
#endif
#ifdef BitPU2
                |(getBit0(BitPU2)<<2)
#endif
#ifdef BitPU3
                |(getBit0(BitPU3)<<3)
#endif
#ifdef BitPU4
                |(getBit0(BitPU4)<<4)
#endif
#ifdef BitPU5
                |(getBit0(BitPU5)<<5)
#endif
#ifdef BitPU6
                |(getBit0(BitPU6)<<6)
#endif
#ifdef BitPU7
                |(getBit0(BitPU7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTV
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTV|=0
#ifdef BitPV0
            |(getBit1(BitPV0)<<0)
#endif
#ifdef BitPV1
            |(getBit1(BitPV1)<<1)
#endif
#ifdef BitPV2
            |(getBit1(BitPV2)<<2)
#endif
#ifdef BitPV3
            |(getBit1(BitPV3)<<3)
#endif
#ifdef BitPV4
            |(getBit1(BitPV4)<<4)
#endif
#ifdef BitPV5
            |(getBit1(BitPV5)<<5)
#endif
#ifdef BitPV6
            |(getBit1(BitPV6)<<6)
#endif
#ifdef BitPV7
            |(getBit1(BitPV7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTV&=~(0
#ifdef BitPV0
                |(getBit0(BitPV0)<<0)
#endif
#ifdef BitPV1
                |(getBit0(BitPV1)<<1)
#endif
#ifdef BitPV2
                |(getBit0(BitPV2)<<2)
#endif
#ifdef BitPV3
                |(getBit0(BitPV3)<<3)
#endif
#ifdef BitPV4
                |(getBit0(BitPV4)<<4)
#endif
#ifdef BitPV5
                |(getBit0(BitPV5)<<5)
#endif
#ifdef BitPV6
                |(getBit0(BitPV6)<<6)
#endif
#ifdef BitPV7
                |(getBit0(BitPV7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTW
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTW|=0
#ifdef BitPW0
            |(getBit1(BitPW0)<<0)
#endif
#ifdef BitPW1
            |(getBit1(BitPW1)<<1)
#endif
#ifdef BitPW2
            |(getBit1(BitPW2)<<2)
#endif
#ifdef BitPW3
            |(getBit1(BitPW3)<<3)
#endif
#ifdef BitPW4
            |(getBit1(BitPW4)<<4)
#endif
#ifdef BitPW5
            |(getBit1(BitPW5)<<5)
#endif
#ifdef BitPW6
            |(getBit1(BitPW6)<<6)
#endif
#ifdef BitPW7
            |(getBit1(BitPW7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTW&=~(0
#ifdef BitPW0
                |(getBit0(BitPW0)<<0)
#endif
#ifdef BitPW1
                |(getBit0(BitPW1)<<1)
#endif
#ifdef BitPW2
                |(getBit0(BitPW2)<<2)
#endif
#ifdef BitPW3
                |(getBit0(BitPW3)<<3)
#endif
#ifdef BitPW4
                |(getBit0(BitPW4)<<4)
#endif
#ifdef BitPW5
                |(getBit0(BitPW5)<<5)
#endif
#ifdef BitPW6
                |(getBit0(BitPW6)<<6)
#endif
#ifdef BitPW7
                |(getBit0(BitPW7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTX
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTX|=0
#ifdef BitPX0
            |(getBit1(BitPX0)<<0)
#endif
#ifdef BitPX1
            |(getBit1(BitPX1)<<1)
#endif
#ifdef BitPX2
            |(getBit1(BitPX2)<<2)
#endif
#ifdef BitPX3
            |(getBit1(BitPX3)<<3)
#endif
#ifdef BitPX4
            |(getBit1(BitPX4)<<4)
#endif
#ifdef BitPX5
            |(getBit1(BitPX5)<<5)
#endif
#ifdef BitPX6
            |(getBit1(BitPX6)<<6)
#endif
#ifdef BitPX7
            |(getBit1(BitPX7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTX&=~(0
#ifdef BitPX0
                |(getBit0(BitPX0)<<0)
#endif
#ifdef BitPX1
                |(getBit0(BitPX1)<<1)
#endif
#ifdef BitPX2
                |(getBit0(BitPX2)<<2)
#endif
#ifdef BitPX3
                |(getBit0(BitPX3)<<3)
#endif
#ifdef BitPX4
                |(getBit0(BitPX4)<<4)
#endif
#ifdef BitPX5
                |(getBit0(BitPX5)<<5)
#endif
#ifdef BitPX6
                |(getBit0(BitPX6)<<6)
#endif
#ifdef BitPX7
                |(getBit0(BitPX7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTY
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTY|=0
#ifdef BitPY0
            |(getBit1(BitPY0)<<0)
#endif
#ifdef BitPY1
            |(getBit1(BitPY1)<<1)
#endif
#ifdef BitPY2
            |(getBit1(BitPY2)<<2)
#endif
#ifdef BitPY3
            |(getBit1(BitPY3)<<3)
#endif
#ifdef BitPY4
            |(getBit1(BitPY4)<<4)
#endif
#ifdef BitPY5
            |(getBit1(BitPY5)<<5)
#endif
#ifdef BitPY6
            |(getBit1(BitPY6)<<6)
#endif
#ifdef BitPY7
            |(getBit1(BitPY7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTY&=~(0
#ifdef BitPY0
                |(getBit0(BitPY0)<<0)
#endif
#ifdef BitPY1
                |(getBit0(BitPY1)<<1)
#endif
#ifdef BitPY2
                |(getBit0(BitPY2)<<2)
#endif
#ifdef BitPY3
                |(getBit0(BitPY3)<<3)
#endif
#ifdef BitPY4
                |(getBit0(BitPY4)<<4)
#endif
#ifdef BitPY5
                |(getBit0(BitPY5)<<5)
#endif
#ifdef BitPY6
                |(getBit0(BitPY6)<<6)
#endif
#ifdef BitPY7
                |(getBit0(BitPY7)<<7)
#endif
                |0);
    }
#endif



#ifdef PORTZ
    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTZ|=0
#ifdef BitPZ0
            |(getBit1(BitPZ0)<<0)
#endif
#ifdef BitPZ1
            |(getBit1(BitPZ1)<<1)
#endif
#ifdef BitPZ2
            |(getBit1(BitPZ2)<<2)
#endif
#ifdef BitPZ3
            |(getBit1(BitPZ3)<<3)
#endif
#ifdef BitPZ4
            |(getBit1(BitPZ4)<<4)
#endif
#ifdef BitPZ5
            |(getBit1(BitPZ5)<<5)
#endif
#ifdef BitPZ6
            |(getBit1(BitPZ6)<<6)
#endif
#ifdef BitPZ7
            |(getBit1(BitPZ7)<<7)
#endif
            |0;
    }

    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
        PORTZ&=~(0
#ifdef BitPZ0
                |(getBit0(BitPZ0)<<0)
#endif
#ifdef BitPZ1
                |(getBit0(BitPZ1)<<1)
#endif
#ifdef BitPZ2
                |(getBit0(BitPZ2)<<2)
#endif
#ifdef BitPZ3
                |(getBit0(BitPZ3)<<3)
#endif
#ifdef BitPZ4
                |(getBit0(BitPZ4)<<4)
#endif
#ifdef BitPZ5
                |(getBit0(BitPZ5)<<5)
#endif
#ifdef BitPZ6
                |(getBit0(BitPZ6)<<6)
#endif
#ifdef BitPZ7
                |(getBit0(BitPZ7)<<7)
#endif
                |0);
    }
#endif


}


void ioHelperReadPins(void) {
#ifdef PINA
#ifdef BitPinA0
    ioHelperCpBit(PINA,0,BitPinA0);
#endif
#ifdef BitPinA1
    ioHelperCpBit(PINA,1,BitPinA1);
#endif
#ifdef BitPinA2
    ioHelperCpBit(PINA,2,BitPinA2);
#endif
#ifdef BitPinA3
    ioHelperCpBit(PINA,3,BitPinA3);
#endif
#ifdef BitPinA4
    ioHelperCpBit(PINA,4,BitPinA4);
#endif
#ifdef BitPinA5
    ioHelperCpBit(PINA,5,BitPinA5);
#endif
#ifdef BitPinA6
    ioHelperCpBit(PINA,6,BitPinA6);
#endif
#ifdef BitPinA7
    ioHelperCpBit(PINA,7,BitPinA7);
#endif
#endif



#ifdef PINB
#ifdef BitPinB0
    ioHelperCpBit(PINB,0,BitPinB0);
#endif
#ifdef BitPinB1
    ioHelperCpBit(PINB,1,BitPinB1);
#endif
#ifdef BitPinB2
    ioHelperCpBit(PINB,2,BitPinB2);
#endif
#ifdef BitPinB3
    ioHelperCpBit(PINB,3,BitPinB3);
#endif
#ifdef BitPinB4
    ioHelperCpBit(PINB,4,BitPinB4);
#endif
#ifdef BitPinB5
    ioHelperCpBit(PINB,5,BitPinB5);
#endif
#ifdef BitPinB6
    ioHelperCpBit(PINB,6,BitPinB6);
#endif
#ifdef BitPinB7
    ioHelperCpBit(PINB,7,BitPinB7);
#endif
#endif



#ifdef PINC
#ifdef BitPinC0
    ioHelperCpBit(PINC,0,BitPinC0);
#endif
#ifdef BitPinC1
    ioHelperCpBit(PINC,1,BitPinC1);
#endif
#ifdef BitPinC2
    ioHelperCpBit(PINC,2,BitPinC2);
#endif
#ifdef BitPinC3
    ioHelperCpBit(PINC,3,BitPinC3);
#endif
#ifdef BitPinC4
    ioHelperCpBit(PINC,4,BitPinC4);
#endif
#ifdef BitPinC5
    ioHelperCpBit(PINC,5,BitPinC5);
#endif
#ifdef BitPinC6
    ioHelperCpBit(PINC,6,BitPinC6);
#endif
#ifdef BitPinC7
    ioHelperCpBit(PINC,7,BitPinC7);
#endif
#endif



#ifdef PIND
#ifdef BitPinD0
    ioHelperCpBit(PIND,0,BitPinD0);
#endif
#ifdef BitPinD1
    ioHelperCpBit(PIND,1,BitPinD1);
#endif
#ifdef BitPinD2
    ioHelperCpBit(PIND,2,BitPinD2);
#endif
#ifdef BitPinD3
    ioHelperCpBit(PIND,3,BitPinD3);
#endif
#ifdef BitPinD4
    ioHelperCpBit(PIND,4,BitPinD4);
#endif
#ifdef BitPinD5
    ioHelperCpBit(PIND,5,BitPinD5);
#endif
#ifdef BitPinD6
    ioHelperCpBit(PIND,6,BitPinD6);
#endif
#ifdef BitPinD7
    ioHelperCpBit(PIND,7,BitPinD7);
#endif
#endif



#ifdef PINE
#ifdef BitPinE0
    ioHelperCpBit(PINE,0,BitPinE0);
#endif
#ifdef BitPinE1
    ioHelperCpBit(PINE,1,BitPinE1);
#endif
#ifdef BitPinE2
    ioHelperCpBit(PINE,2,BitPinE2);
#endif
#ifdef BitPinE3
    ioHelperCpBit(PINE,3,BitPinE3);
#endif
#ifdef BitPinE4
    ioHelperCpBit(PINE,4,BitPinE4);
#endif
#ifdef BitPinE5
    ioHelperCpBit(PINE,5,BitPinE5);
#endif
#ifdef BitPinE6
    ioHelperCpBit(PINE,6,BitPinE6);
#endif
#ifdef BitPinE7
    ioHelperCpBit(PINE,7,BitPinE7);
#endif
#endif



#ifdef PINF
#ifdef BitPinF0
    ioHelperCpBit(PINF,0,BitPinF0);
#endif
#ifdef BitPinF1
    ioHelperCpBit(PINF,1,BitPinF1);
#endif
#ifdef BitPinF2
    ioHelperCpBit(PINF,2,BitPinF2);
#endif
#ifdef BitPinF3
    ioHelperCpBit(PINF,3,BitPinF3);
#endif
#ifdef BitPinF4
    ioHelperCpBit(PINF,4,BitPinF4);
#endif
#ifdef BitPinF5
    ioHelperCpBit(PINF,5,BitPinF5);
#endif
#ifdef BitPinF6
    ioHelperCpBit(PINF,6,BitPinF6);
#endif
#ifdef BitPinF7
    ioHelperCpBit(PINF,7,BitPinF7);
#endif
#endif



#ifdef PING
#ifdef BitPinG0
    ioHelperCpBit(PING,0,BitPinG0);
#endif
#ifdef BitPinG1
    ioHelperCpBit(PING,1,BitPinG1);
#endif
#ifdef BitPinG2
    ioHelperCpBit(PING,2,BitPinG2);
#endif
#ifdef BitPinG3
    ioHelperCpBit(PING,3,BitPinG3);
#endif
#ifdef BitPinG4
    ioHelperCpBit(PING,4,BitPinG4);
#endif
#ifdef BitPinG5
    ioHelperCpBit(PING,5,BitPinG5);
#endif
#ifdef BitPinG6
    ioHelperCpBit(PING,6,BitPinG6);
#endif
#ifdef BitPinG7
    ioHelperCpBit(PING,7,BitPinG7);
#endif
#endif



#ifdef PINH
#ifdef BitPinH0
    ioHelperCpBit(PINH,0,BitPinH0);
#endif
#ifdef BitPinH1
    ioHelperCpBit(PINH,1,BitPinH1);
#endif
#ifdef BitPinH2
    ioHelperCpBit(PINH,2,BitPinH2);
#endif
#ifdef BitPinH3
    ioHelperCpBit(PINH,3,BitPinH3);
#endif
#ifdef BitPinH4
    ioHelperCpBit(PINH,4,BitPinH4);
#endif
#ifdef BitPinH5
    ioHelperCpBit(PINH,5,BitPinH5);
#endif
#ifdef BitPinH6
    ioHelperCpBit(PINH,6,BitPinH6);
#endif
#ifdef BitPinH7
    ioHelperCpBit(PINH,7,BitPinH7);
#endif
#endif



#ifdef PINI
#ifdef BitPinI0
    ioHelperCpBit(PINI,0,BitPinI0);
#endif
#ifdef BitPinI1
    ioHelperCpBit(PINI,1,BitPinI1);
#endif
#ifdef BitPinI2
    ioHelperCpBit(PINI,2,BitPinI2);
#endif
#ifdef BitPinI3
    ioHelperCpBit(PINI,3,BitPinI3);
#endif
#ifdef BitPinI4
    ioHelperCpBit(PINI,4,BitPinI4);
#endif
#ifdef BitPinI5
    ioHelperCpBit(PINI,5,BitPinI5);
#endif
#ifdef BitPinI6
    ioHelperCpBit(PINI,6,BitPinI6);
#endif
#ifdef BitPinI7
    ioHelperCpBit(PINI,7,BitPinI7);
#endif
#endif



#ifdef PINJ
#ifdef BitPinJ0
    ioHelperCpBit(PINJ,0,BitPinJ0);
#endif
#ifdef BitPinJ1
    ioHelperCpBit(PINJ,1,BitPinJ1);
#endif
#ifdef BitPinJ2
    ioHelperCpBit(PINJ,2,BitPinJ2);
#endif
#ifdef BitPinJ3
    ioHelperCpBit(PINJ,3,BitPinJ3);
#endif
#ifdef BitPinJ4
    ioHelperCpBit(PINJ,4,BitPinJ4);
#endif
#ifdef BitPinJ5
    ioHelperCpBit(PINJ,5,BitPinJ5);
#endif
#ifdef BitPinJ6
    ioHelperCpBit(PINJ,6,BitPinJ6);
#endif
#ifdef BitPinJ7
    ioHelperCpBit(PINJ,7,BitPinJ7);
#endif
#endif



#ifdef PINK
#ifdef BitPinK0
    ioHelperCpBit(PINK,0,BitPinK0);
#endif
#ifdef BitPinK1
    ioHelperCpBit(PINK,1,BitPinK1);
#endif
#ifdef BitPinK2
    ioHelperCpBit(PINK,2,BitPinK2);
#endif
#ifdef BitPinK3
    ioHelperCpBit(PINK,3,BitPinK3);
#endif
#ifdef BitPinK4
    ioHelperCpBit(PINK,4,BitPinK4);
#endif
#ifdef BitPinK5
    ioHelperCpBit(PINK,5,BitPinK5);
#endif
#ifdef BitPinK6
    ioHelperCpBit(PINK,6,BitPinK6);
#endif
#ifdef BitPinK7
    ioHelperCpBit(PINK,7,BitPinK7);
#endif
#endif



#ifdef PINL
#ifdef BitPinL0
    ioHelperCpBit(PINL,0,BitPinL0);
#endif
#ifdef BitPinL1
    ioHelperCpBit(PINL,1,BitPinL1);
#endif
#ifdef BitPinL2
    ioHelperCpBit(PINL,2,BitPinL2);
#endif
#ifdef BitPinL3
    ioHelperCpBit(PINL,3,BitPinL3);
#endif
#ifdef BitPinL4
    ioHelperCpBit(PINL,4,BitPinL4);
#endif
#ifdef BitPinL5
    ioHelperCpBit(PINL,5,BitPinL5);
#endif
#ifdef BitPinL6
    ioHelperCpBit(PINL,6,BitPinL6);
#endif
#ifdef BitPinL7
    ioHelperCpBit(PINL,7,BitPinL7);
#endif
#endif



#ifdef PINM
#ifdef BitPinM0
    ioHelperCpBit(PINM,0,BitPinM0);
#endif
#ifdef BitPinM1
    ioHelperCpBit(PINM,1,BitPinM1);
#endif
#ifdef BitPinM2
    ioHelperCpBit(PINM,2,BitPinM2);
#endif
#ifdef BitPinM3
    ioHelperCpBit(PINM,3,BitPinM3);
#endif
#ifdef BitPinM4
    ioHelperCpBit(PINM,4,BitPinM4);
#endif
#ifdef BitPinM5
    ioHelperCpBit(PINM,5,BitPinM5);
#endif
#ifdef BitPinM6
    ioHelperCpBit(PINM,6,BitPinM6);
#endif
#ifdef BitPinM7
    ioHelperCpBit(PINM,7,BitPinM7);
#endif
#endif



#ifdef PINN
#ifdef BitPinN0
    ioHelperCpBit(PINN,0,BitPinN0);
#endif
#ifdef BitPinN1
    ioHelperCpBit(PINN,1,BitPinN1);
#endif
#ifdef BitPinN2
    ioHelperCpBit(PINN,2,BitPinN2);
#endif
#ifdef BitPinN3
    ioHelperCpBit(PINN,3,BitPinN3);
#endif
#ifdef BitPinN4
    ioHelperCpBit(PINN,4,BitPinN4);
#endif
#ifdef BitPinN5
    ioHelperCpBit(PINN,5,BitPinN5);
#endif
#ifdef BitPinN6
    ioHelperCpBit(PINN,6,BitPinN6);
#endif
#ifdef BitPinN7
    ioHelperCpBit(PINN,7,BitPinN7);
#endif
#endif



#ifdef PINO
#ifdef BitPinO0
    ioHelperCpBit(PINO,0,BitPinO0);
#endif
#ifdef BitPinO1
    ioHelperCpBit(PINO,1,BitPinO1);
#endif
#ifdef BitPinO2
    ioHelperCpBit(PINO,2,BitPinO2);
#endif
#ifdef BitPinO3
    ioHelperCpBit(PINO,3,BitPinO3);
#endif
#ifdef BitPinO4
    ioHelperCpBit(PINO,4,BitPinO4);
#endif
#ifdef BitPinO5
    ioHelperCpBit(PINO,5,BitPinO5);
#endif
#ifdef BitPinO6
    ioHelperCpBit(PINO,6,BitPinO6);
#endif
#ifdef BitPinO7
    ioHelperCpBit(PINO,7,BitPinO7);
#endif
#endif



#ifdef PINP
#ifdef BitPinP0
    ioHelperCpBit(PINP,0,BitPinP0);
#endif
#ifdef BitPinP1
    ioHelperCpBit(PINP,1,BitPinP1);
#endif
#ifdef BitPinP2
    ioHelperCpBit(PINP,2,BitPinP2);
#endif
#ifdef BitPinP3
    ioHelperCpBit(PINP,3,BitPinP3);
#endif
#ifdef BitPinP4
    ioHelperCpBit(PINP,4,BitPinP4);
#endif
#ifdef BitPinP5
    ioHelperCpBit(PINP,5,BitPinP5);
#endif
#ifdef BitPinP6
    ioHelperCpBit(PINP,6,BitPinP6);
#endif
#ifdef BitPinP7
    ioHelperCpBit(PINP,7,BitPinP7);
#endif
#endif



#ifdef PINQ
#ifdef BitPinQ0
    ioHelperCpBit(PINQ,0,BitPinQ0);
#endif
#ifdef BitPinQ1
    ioHelperCpBit(PINQ,1,BitPinQ1);
#endif
#ifdef BitPinQ2
    ioHelperCpBit(PINQ,2,BitPinQ2);
#endif
#ifdef BitPinQ3
    ioHelperCpBit(PINQ,3,BitPinQ3);
#endif
#ifdef BitPinQ4
    ioHelperCpBit(PINQ,4,BitPinQ4);
#endif
#ifdef BitPinQ5
    ioHelperCpBit(PINQ,5,BitPinQ5);
#endif
#ifdef BitPinQ6
    ioHelperCpBit(PINQ,6,BitPinQ6);
#endif
#ifdef BitPinQ7
    ioHelperCpBit(PINQ,7,BitPinQ7);
#endif
#endif



#ifdef PINR
#ifdef BitPinR0
    ioHelperCpBit(PINR,0,BitPinR0);
#endif
#ifdef BitPinR1
    ioHelperCpBit(PINR,1,BitPinR1);
#endif
#ifdef BitPinR2
    ioHelperCpBit(PINR,2,BitPinR2);
#endif
#ifdef BitPinR3
    ioHelperCpBit(PINR,3,BitPinR3);
#endif
#ifdef BitPinR4
    ioHelperCpBit(PINR,4,BitPinR4);
#endif
#ifdef BitPinR5
    ioHelperCpBit(PINR,5,BitPinR5);
#endif
#ifdef BitPinR6
    ioHelperCpBit(PINR,6,BitPinR6);
#endif
#ifdef BitPinR7
    ioHelperCpBit(PINR,7,BitPinR7);
#endif
#endif



#ifdef PINS
#ifdef BitPinS0
    ioHelperCpBit(PINS,0,BitPinS0);
#endif
#ifdef BitPinS1
    ioHelperCpBit(PINS,1,BitPinS1);
#endif
#ifdef BitPinS2
    ioHelperCpBit(PINS,2,BitPinS2);
#endif
#ifdef BitPinS3
    ioHelperCpBit(PINS,3,BitPinS3);
#endif
#ifdef BitPinS4
    ioHelperCpBit(PINS,4,BitPinS4);
#endif
#ifdef BitPinS5
    ioHelperCpBit(PINS,5,BitPinS5);
#endif
#ifdef BitPinS6
    ioHelperCpBit(PINS,6,BitPinS6);
#endif
#ifdef BitPinS7
    ioHelperCpBit(PINS,7,BitPinS7);
#endif
#endif



#ifdef PINT
#ifdef BitPinT0
    ioHelperCpBit(PINT,0,BitPinT0);
#endif
#ifdef BitPinT1
    ioHelperCpBit(PINT,1,BitPinT1);
#endif
#ifdef BitPinT2
    ioHelperCpBit(PINT,2,BitPinT2);
#endif
#ifdef BitPinT3
    ioHelperCpBit(PINT,3,BitPinT3);
#endif
#ifdef BitPinT4
    ioHelperCpBit(PINT,4,BitPinT4);
#endif
#ifdef BitPinT5
    ioHelperCpBit(PINT,5,BitPinT5);
#endif
#ifdef BitPinT6
    ioHelperCpBit(PINT,6,BitPinT6);
#endif
#ifdef BitPinT7
    ioHelperCpBit(PINT,7,BitPinT7);
#endif
#endif



#ifdef PINU
#ifdef BitPinU0
    ioHelperCpBit(PINU,0,BitPinU0);
#endif
#ifdef BitPinU1
    ioHelperCpBit(PINU,1,BitPinU1);
#endif
#ifdef BitPinU2
    ioHelperCpBit(PINU,2,BitPinU2);
#endif
#ifdef BitPinU3
    ioHelperCpBit(PINU,3,BitPinU3);
#endif
#ifdef BitPinU4
    ioHelperCpBit(PINU,4,BitPinU4);
#endif
#ifdef BitPinU5
    ioHelperCpBit(PINU,5,BitPinU5);
#endif
#ifdef BitPinU6
    ioHelperCpBit(PINU,6,BitPinU6);
#endif
#ifdef BitPinU7
    ioHelperCpBit(PINU,7,BitPinU7);
#endif
#endif



#ifdef PINV
#ifdef BitPinV0
    ioHelperCpBit(PINV,0,BitPinV0);
#endif
#ifdef BitPinV1
    ioHelperCpBit(PINV,1,BitPinV1);
#endif
#ifdef BitPinV2
    ioHelperCpBit(PINV,2,BitPinV2);
#endif
#ifdef BitPinV3
    ioHelperCpBit(PINV,3,BitPinV3);
#endif
#ifdef BitPinV4
    ioHelperCpBit(PINV,4,BitPinV4);
#endif
#ifdef BitPinV5
    ioHelperCpBit(PINV,5,BitPinV5);
#endif
#ifdef BitPinV6
    ioHelperCpBit(PINV,6,BitPinV6);
#endif
#ifdef BitPinV7
    ioHelperCpBit(PINV,7,BitPinV7);
#endif
#endif



#ifdef PINW
#ifdef BitPinW0
    ioHelperCpBit(PINW,0,BitPinW0);
#endif
#ifdef BitPinW1
    ioHelperCpBit(PINW,1,BitPinW1);
#endif
#ifdef BitPinW2
    ioHelperCpBit(PINW,2,BitPinW2);
#endif
#ifdef BitPinW3
    ioHelperCpBit(PINW,3,BitPinW3);
#endif
#ifdef BitPinW4
    ioHelperCpBit(PINW,4,BitPinW4);
#endif
#ifdef BitPinW5
    ioHelperCpBit(PINW,5,BitPinW5);
#endif
#ifdef BitPinW6
    ioHelperCpBit(PINW,6,BitPinW6);
#endif
#ifdef BitPinW7
    ioHelperCpBit(PINW,7,BitPinW7);
#endif
#endif



#ifdef PINX
#ifdef BitPinX0
    ioHelperCpBit(PINX,0,BitPinX0);
#endif
#ifdef BitPinX1
    ioHelperCpBit(PINX,1,BitPinX1);
#endif
#ifdef BitPinX2
    ioHelperCpBit(PINX,2,BitPinX2);
#endif
#ifdef BitPinX3
    ioHelperCpBit(PINX,3,BitPinX3);
#endif
#ifdef BitPinX4
    ioHelperCpBit(PINX,4,BitPinX4);
#endif
#ifdef BitPinX5
    ioHelperCpBit(PINX,5,BitPinX5);
#endif
#ifdef BitPinX6
    ioHelperCpBit(PINX,6,BitPinX6);
#endif
#ifdef BitPinX7
    ioHelperCpBit(PINX,7,BitPinX7);
#endif
#endif



#ifdef PINY
#ifdef BitPinY0
    ioHelperCpBit(PINY,0,BitPinY0);
#endif
#ifdef BitPinY1
    ioHelperCpBit(PINY,1,BitPinY1);
#endif
#ifdef BitPinY2
    ioHelperCpBit(PINY,2,BitPinY2);
#endif
#ifdef BitPinY3
    ioHelperCpBit(PINY,3,BitPinY3);
#endif
#ifdef BitPinY4
    ioHelperCpBit(PINY,4,BitPinY4);
#endif
#ifdef BitPinY5
    ioHelperCpBit(PINY,5,BitPinY5);
#endif
#ifdef BitPinY6
    ioHelperCpBit(PINY,6,BitPinY6);
#endif
#ifdef BitPinY7
    ioHelperCpBit(PINY,7,BitPinY7);
#endif
#endif



#ifdef PINZ
#ifdef BitPinZ0
    ioHelperCpBit(PINZ,0,BitPinZ0);
#endif
#ifdef BitPinZ1
    ioHelperCpBit(PINZ,1,BitPinZ1);
#endif
#ifdef BitPinZ2
    ioHelperCpBit(PINZ,2,BitPinZ2);
#endif
#ifdef BitPinZ3
    ioHelperCpBit(PINZ,3,BitPinZ3);
#endif
#ifdef BitPinZ4
    ioHelperCpBit(PINZ,4,BitPinZ4);
#endif
#ifdef BitPinZ5
    ioHelperCpBit(PINZ,5,BitPinZ5);
#endif
#ifdef BitPinZ6
    ioHelperCpBit(PINZ,6,BitPinZ6);
#endif
#ifdef BitPinZ7
    ioHelperCpBit(PINZ,7,BitPinZ7);
#endif
#endif

}