TreelLab/prog/sources/teensy-3-6-digital-io.cpp

#include "all-headers.h"

//——————————————————————————————————————————————————————————————————————————————————————————————————————————————————————

void pinMode (const DigitalPort inPort, const DigitalMode inMode) {
//--- Set config and dir to apply
  uint32_t config = 0 ;
  bool output = false ;
  switch (inMode) {
  case DigitalMode::OUTPUT :
    config = PORT_PCR_MUX (1) ;
    output = true ;
    break ;
  case DigitalMode::OUTPUT_OPEN_COLLECTOR :
    config = PORT_PCR_MUX (1) | PORT_PCR_ODE ;
    output = true ;
    break ;
  case DigitalMode::INPUT :
    config = PORT_PCR_MUX(1) ;
    break ;
  case DigitalMode::INPUT_PULLDOWN :
    config = PORT_PCR_MUX(1) | PORT_PCR_PE ;
    break ;
  case DigitalMode::INPUT_PULLUP :
    config = PORT_PCR_MUX(1) | PORT_PCR_PE | PORT_PCR_PS ;
    break ;
  }
//--- Apply
  switch (inPort) {
  case DigitalPort::D0 : // PTB16
    PORTB_PCR (16) = config ;
    bitband32 (GPIOB_PDDR, 16, output) ;
    break ;
  case DigitalPort::D1 : // PTB17
    PORTB_PCR (17) = config ;
    bitband32 (GPIOB_PDDR, 17, output) ;
    break ;
  case DigitalPort::D2 : // PTD0
    PORTD_PCR (0) = config ;
    bitband32 (GPIOD_PDDR, 0, output) ;
    break ;
  case DigitalPort::D3 : // PTA12
    PORTA_PCR (12) = config ;
    bitband32 (GPIOA_PDDR, 12, output) ;
    break ;
  case DigitalPort::D4 : // PTA13
    PORTA_PCR (13) = config ;
    bitband32 (GPIOA_PDDR, 13, output) ;
    break ;
  case DigitalPort::D5 : // PTD7
    PORTD_PCR (7) = config ;
    bitband32 (GPIOD_PDDR, 7, output) ;
    break ;
  case DigitalPort::D6 : // PTD4
    PORTD_PCR (4) = config ;
    bitband32 (GPIOD_PDDR, 4, output) ;
    break ;
  case DigitalPort::D7 : // PTD2
    PORTD_PCR (2) = config ;
    bitband32 (GPIOD_PDDR, 2, output) ;
    break ;
  case DigitalPort::D8 : // PTD3
    PORTD_PCR (3) = config ;
    bitband32 (GPIOD_PDDR, 3, output) ;
    break ;
  case DigitalPort::D9  : // PTC3
    PORTC_PCR (3) = config ;
    bitband32 (GPIOC_PDDR, 3, output) ;
    break ;
  case DigitalPort::D10 : // PTC4
    PORTC_PCR (4) = config ;
    bitband32 (GPIOC_PDDR, 4, output) ;
    break ;
  case DigitalPort::D11 : // PTC6
    PORTC_PCR (6) = config ;
    bitband32 (GPIOC_PDDR, 6, output) ;
    break ;
  case DigitalPort::D12 : // PTC7
    PORTC_PCR (7) = config ;
    bitband32 (GPIOC_PDDR, 7, output) ;
    break ;
  case DigitalPort::D13 : // PTC5
    PORTC_PCR (5) = config ;
    bitband32 (GPIOC_PDDR, 5, output) ;
    break ;
  case DigitalPort::D14 : // PTD1
    PORTD_PCR (1) = config ;
    bitband32 (GPIOD_PDDR, 1, output) ;
    break ;
  case DigitalPort::D15 : // PTC0
    PORTC_PCR (0) = config ;
    bitband32 (GPIOC_PDDR, 0, output) ;
    break ;
  case DigitalPort::D16 : // PTB0
    PORTB_PCR (0) = config ;
    bitband32 (GPIOB_PDDR, 0, output) ;
    break ;
  case DigitalPort::D17 : // PTB1
    PORTB_PCR (1) = config ;
    bitband32 (GPIOB_PDDR, 1, output) ;
    break ;
  case DigitalPort::D18 : // PTB3
    PORTB_PCR (3) = config ;
    bitband32 (GPIOB_PDDR, 3, output) ;
    break ;
  case DigitalPort::D19 : // PTB2
    PORTB_PCR (2) = config ;
    bitband32 (GPIOB_PDDR, 2, output) ;
    break ;
  case DigitalPort::D20 : // PTD5
    PORTD_PCR (5) = config ;
    bitband32 (GPIOD_PDDR, 5, output) ;
    break ;
  case DigitalPort::D21 : // PTD6
    PORTD_PCR (6) = config ;
    bitband32 (GPIOD_PDDR, 6, output) ;
    break ;
  case DigitalPort::D22 : // PTC1
    PORTC_PCR (1) = config ;
    bitband32 (GPIOC_PDDR, 1, output) ;
    break ;
  case DigitalPort::D23 : // PTC2
    PORTC_PCR (2) = config ;
    bitband32 (GPIOC_PDDR, 2, output) ;
    break ;
  case DigitalPort::D24 : // PTE26
    PORTE_PCR (26) = config ;
    bitband32 (GPIOE_PDDR, 26, output) ;
    break ;
  case DigitalPort::D25 : // PTA5
    PORTA_PCR (5) = config ;
    bitband32 (GPIOA_PDDR, 5, output) ;
    break ;
  case DigitalPort::D26 : // PTA14
    PORTA_PCR (14) = config ;
    bitband32 (GPIOA_PDDR, 14, output) ;
    break ;
  case DigitalPort::D27 : // PTA15
    PORTA_PCR (15) = config ;
    bitband32 (GPIOA_PDDR, 15, output) ;
    break ;
  case DigitalPort::D28 : // PTA16
    PORTA_PCR (16) = config ;
    bitband32 (GPIOA_PDDR, 16, output) ;
    break ;
  case DigitalPort::D29 : // PTB18
    PORTB_PCR (18) = config ;
    bitband32 (GPIOB_PDDR, 18, output) ;
    break ;
  case DigitalPort::D30 : // PTB19
    PORTB_PCR (19) = config ;
    bitband32 (GPIOB_PDDR, 19, output) ;
    break ;
  case DigitalPort::D31 : // PTB10
    PORTB_PCR (10) = config ;
    bitband32 (GPIOB_PDDR, 10, output) ;
    break ;
  case DigitalPort::D32 : // PTB11
    PORTB_PCR (11) = config ;
    bitband32 (GPIOB_PDDR, 11, output) ;
    break ;
  case DigitalPort::D33 : // PTE24
    PORTE_PCR (24) = config ;
    bitband32 (GPIOE_PDDR, 24, output) ;
    break ;
  case DigitalPort::D34 : // PTE25
    PORTE_PCR (25) = config ;
    bitband32 (GPIOE_PDDR, 25, output) ;
    break ;
  case DigitalPort::D35 : // PTC8
    PORTC_PCR (8) = config ;
    bitband32 (GPIOC_PDDR, 8, output) ;
    break ;
  case DigitalPort::D36 : // PTC9
    PORTC_PCR (9) = config ;
    bitband32 (GPIOC_PDDR, 9, output) ;
    break ;
  case DigitalPort::D37 : // PTC10
    PORTC_PCR (10) = config ;
    bitband32 (GPIOC_PDDR, 10, output) ;
    break ;
  case DigitalPort::D38 : // PTC11
    PORTC_PCR (11) = config ;
    bitband32 (GPIOC_PDDR, 11, output) ;
    break ;
 case DigitalPort::D39 : // PTA17
    PORTA_PCR (17) = config ;
    bitband32 (GPIOA_PDDR, 17, output) ;
    break ;
  case DigitalPort::D40 : // PTA28
    PORTA_PCR (28) = config ;
    bitband32 (GPIOA_PDDR, 28, output) ;
    break ;
  case DigitalPort::D41 : // PTA29
    PORTA_PCR (29) = config ;
    bitband32 (GPIOA_PDDR, 29, output) ;
    break ;
  case DigitalPort::D42 : // PTA26
    PORTA_PCR (26) = config ;
    bitband32 (GPIOA_PDDR, 26, output) ;
    break ;
  case DigitalPort::D43 : // PTB20
    PORTB_PCR (20) = config ;
    bitband32 (GPIOB_PDDR, 20, output) ;
    break ;
  case DigitalPort::D44 : // PTB22
    PORTB_PCR (22) = config ;
    bitband32 (GPIOB_PDDR, 22, output) ;
    break ;
  case DigitalPort::D45 : // PTB23
    PORTB_PCR (23) = config ;
    bitband32 (GPIOB_PDDR, 23, output) ;
    break ;
  case DigitalPort::D46 : // PTB21
    PORTB_PCR (21) = config ;
    bitband32 (GPIOB_PDDR, 21, output) ;
    break ;
  case DigitalPort::D47 : // PTD8
    PORTD_PCR (8) = config ;
    bitband32 (GPIOD_PDDR, 8, output) ;
    break ;
  case DigitalPort::D48 : // PTD9
    PORTD_PCR (9) = config ;
    bitband32 (GPIOD_PDDR, 9, output) ;
    break ;
  case DigitalPort::D49 : // PTB4
    PORTB_PCR (4) = config ;
    bitband32 (GPIOB_PDDR, 4, output) ;
    break ;
  case DigitalPort::D50 : // PTB5
    PORTB_PCR (5) = config ;
    bitband32 (GPIOB_PDDR, 5, output) ;
    break ;
  case DigitalPort::D51 : // PTD14
    PORTD_PCR (14) = config ;
    bitband32 (GPIOD_PDDR, 14, output) ;
    break ;
  case DigitalPort::D52 : // PTD13
    PORTD_PCR (13) = config ;
    bitband32 (GPIOD_PDDR, 13, output) ;
    break ;
  case DigitalPort::D53 : // PTD12
    PORTD_PCR (12) = config ;
    bitband32 (GPIOD_PDDR, 12, output) ;
    break ;
  case DigitalPort::D54 : // PTD15
    PORTD_PCR (15) = config ;
    bitband32 (GPIOD_PDDR, 15, output) ;
    break ;
 case DigitalPort::D55 : // PTD11
    PORTD_PCR (11) = config ;
    bitband32 (GPIOD_PDDR, 11, output) ;
    break ;
  case DigitalPort::D56 : // PTE10
    PORTE_PCR (10) = config ;
    bitband32 (GPIOE_PDDR, 10, output) ;
    break ;
  case DigitalPort::D57 : // PTE11
    PORTE_PCR (11) = config ;
    bitband32 (GPIOE_PDDR, 11, output) ;
    break ;
  case DigitalPort::True : // No port
  case DigitalPort::False : // No port
    break ;
  }
}

//——————————————————————————————————————————————————————————————————————————————————————————————————————————————————————

void digitalWrite (const DigitalPort inPort, const bool inValue) {
  switch (inPort) {
  case DigitalPort::D0 : // PTB16
    if (inValue) {
      GPIOB_PSOR = 1 << 16 ;
    }else{
      GPIOB_PCOR = 1 << 16 ;
    }
    break ;
  case DigitalPort::D1 : // PTB17
    if (inValue) {
      GPIOB_PSOR = 1 << 17 ;
    }else{
      GPIOB_PCOR = 1 << 17 ;
    }
    break ;
  case DigitalPort::D2 : // PTD0
    if (inValue) {
      GPIOD_PSOR = 1 << 0 ;
    }else{
      GPIOD_PCOR = 1 << 0 ;
    }
    break ;
  case DigitalPort::D3 : // PTA12
    if (inValue) {
      GPIOA_PSOR = 1 << 12 ;
    }else{
      GPIOA_PCOR = 1 << 12 ;
    }
    break ;
  case DigitalPort::D4 : // PTA13
    if (inValue) {
      GPIOA_PSOR = 1 << 13 ;
    }else{
      GPIOA_PCOR = 1 << 13 ;
    }
    break ;
  case DigitalPort::D5 : // PTD7
    if (inValue) {
      GPIOD_PSOR = 1 << 7 ;
    }else{
      GPIOD_PCOR = 1 << 7 ;
    }
    break ;
  case DigitalPort::D6 : // PTD4
    if (inValue) {
      GPIOD_PSOR = 1 << 4 ;
    }else{
      GPIOD_PCOR = 1 << 4 ;
    }
    break ;
  case DigitalPort::D7 : // PTD2
    if (inValue) {
      GPIOD_PSOR = 1 << 2 ;
    }else{
      GPIOD_PCOR = 1 << 2 ;
    }
    break ;
  case DigitalPort::D8 : // PTD3
    if (inValue) {
      GPIOD_PSOR = 1 << 3 ;
    }else{
      GPIOD_PCOR = 1 << 3 ;
    }
    break ;
  case DigitalPort::D9  : // PTC3
    if (inValue) {
      GPIOC_PSOR = 1 << 3 ;
    }else{
      GPIOC_PCOR = 1 << 3 ;
    }
    break ;
  case DigitalPort::D10 : // PTC4
    if (inValue) {
      GPIOC_PSOR = 1 << 4 ;
    }else{
      GPIOC_PCOR = 1 << 4 ;
    }
    break ;
  case DigitalPort::D11 : // PTC6
    if (inValue) {
      GPIOC_PSOR = 1 << 6 ;
    }else{
      GPIOC_PCOR = 1 << 6 ;
    }
    break ;
  case DigitalPort::D12 : // PTC7
    if (inValue) {
      GPIOC_PSOR = 1 << 7 ;
    }else{
      GPIOC_PCOR = 1 << 7 ;
    }
    break ;
  case DigitalPort::D13 : // PTC5
    if (inValue) {
      GPIOC_PSOR = 1 << 5 ;
    }else{
      GPIOC_PCOR = 1 << 5 ;
    }
    break ;
  case DigitalPort::D14 : // PTD1
    if (inValue) {
      GPIOD_PSOR = 1 << 1 ;
    }else{
      GPIOD_PCOR = 1 << 1 ;
    }
    break ;
  case DigitalPort::D15 : // PTC0
    if (inValue) {
      GPIOC_PSOR = 1 << 0 ;
    }else{
      GPIOC_PCOR = 1 << 0 ;
    }
    break ;
  case DigitalPort::D16 : // PTB0
    if (inValue) {
      GPIOB_PSOR = 1 << 0 ;
    }else{
      GPIOB_PCOR = 1 << 0 ;
    }
    break ;
  case DigitalPort::D17 : // PTB1
    if (inValue) {
      GPIOB_PSOR = 1 << 1 ;
    }else{
      GPIOB_PCOR = 1 << 1 ;
    }
    break ;
  case DigitalPort::D18 : // PTB3
    if (inValue) {
      GPIOB_PSOR = 1 << 3 ;
    }else{
      GPIOB_PCOR = 1 << 3 ;
    }
    break ;
  case DigitalPort::D19 : // PTB2
    if (inValue) {
      GPIOB_PSOR = 1 << 2 ;
    }else{
      GPIOB_PCOR = 1 << 2 ;
    }
    break ;
  case DigitalPort::D20 : // PTD5
    if (inValue) {
      GPIOD_PSOR = 1 << 5 ;
    }else{
      GPIOD_PCOR = 1 << 5 ;
    }
    break ;
  case DigitalPort::D21 : // PTD6
    if (inValue) {
      GPIOD_PSOR = 1 << 6 ;
    }else{
      GPIOD_PCOR = 1 << 6 ;
    }
    break ;
  case DigitalPort::D22 : // PTC1
    if (inValue) {
      GPIOC_PSOR = 1 << 1 ;
    }else{
      GPIOC_PCOR = 1 << 1 ;
    }
    break ;
  case DigitalPort::D23 : // PTC2
    if (inValue) {
      GPIOC_PSOR = 1 << 2 ;
    }else{
      GPIOC_PCOR = 1 << 2 ;
    }
    break ;
  case DigitalPort::D24 : // PTE26
    if (inValue) {
      GPIOE_PSOR = 1 << 26 ;
    }else{
      GPIOE_PCOR = 1 << 26 ;
    }
    break ;
  case DigitalPort::D25 : // PTA5
    if (inValue) {
      GPIOA_PSOR = 1 << 5 ;
    }else{
      GPIOA_PCOR = 1 << 5 ;
    }
    break ;
  case DigitalPort::D26 : // PTA14
    if (inValue) {
      GPIOA_PSOR = 1 << 14 ;
    }else{
      GPIOA_PCOR = 1 << 14 ;
    }
    break ;
  case DigitalPort::D27 : // PTA15
    if (inValue) {
      GPIOA_PSOR = 1 << 15 ;
    }else{
      GPIOA_PCOR = 1 << 15 ;
    }
    break ;
  case DigitalPort::D28 : // PTA16
    if (inValue) {
      GPIOA_PSOR = 1 << 16 ;
    }else{
      GPIOA_PCOR = 1 << 16 ;
    }
    break ;
  case DigitalPort::D29 : // PTB18
    if (inValue) {
      GPIOB_PSOR = 1 << 18 ;
    }else{
      GPIOB_PCOR = 1 << 18 ;
    }
    break ;
  case DigitalPort::D30 : // PTB19
    if (inValue) {
      GPIOB_PSOR = 1 << 19 ;
    }else{
      GPIOB_PCOR = 1 << 19 ;
    }
    break ;
  case DigitalPort::D31 : // PTB10
    if (inValue) {
      GPIOB_PSOR = 1 << 10 ;
    }else{
      GPIOB_PCOR = 1 << 10 ;
    }
    break ;
  case DigitalPort::D32 : // PTB11
    if (inValue) {
      GPIOB_PSOR = 1 << 11 ;
    }else{
      GPIOB_PCOR = 1 << 11 ;
    }
    break ;
  case DigitalPort::D33 : // PTE24
    if (inValue) {
      GPIOE_PSOR = 1 << 24 ;
    }else{
      GPIOE_PCOR = 1 << 24 ;
    }
    break ;
  case DigitalPort::D34 : // PTE25
    if (inValue) {
      GPIOE_PSOR = 1 << 25 ;
    }else{
      GPIOE_PCOR = 1 << 25 ;
    }
    break ;
  case DigitalPort::D35 : // PTC8
    if (inValue) {
      GPIOC_PSOR = 1 << 8 ;
    }else{
      GPIOC_PCOR = 1 << 8 ;
    }
    break ;
  case DigitalPort::D36 : // PTC9
    if (inValue) {
      GPIOC_PSOR = 1 << 9 ;
    }else{
      GPIOC_PCOR = 1 << 9 ;
    }
    break ;
  case DigitalPort::D37 : // PTC10
    if (inValue) {
      GPIOC_PSOR = 1 << 10 ;
    }else{
      GPIOC_PCOR = 1 << 10 ;
    }
    break ;
  case DigitalPort::D38 : // PTC11
    if (inValue) {
      GPIOC_PSOR = 1 << 11 ;
    }else{
      GPIOC_PCOR = 1 << 11 ;
    }
    break ;
  case DigitalPort::D39 : // PTA17
    if (inValue) {
      GPIOA_PSOR = 1 << 17 ;
    }else{
      GPIOA_PCOR = 1 << 17 ;
    }
    break ;
  case DigitalPort::D40 : // PTA28
    if (inValue) {
      GPIOA_PSOR = 1 << 28 ;
    }else{
      GPIOA_PCOR = 1 << 28 ;
    }
    break ;
  case DigitalPort::D41 : // PTA29
    if (inValue) {
      GPIOA_PSOR = 1 << 29 ;
    }else{
      GPIOA_PCOR = 1 << 29 ;
    }
    break ;
  case DigitalPort::D42 : // PTA26
    if (inValue) {
      GPIOA_PSOR = 1 << 26 ;
    }else{
      GPIOA_PCOR = 1 << 26 ;
    }
    break ;
  case DigitalPort::D43 : // PTB20
    if (inValue) {
      GPIOB_PSOR = 1 << 20 ;
    }else{
      GPIOB_PCOR = 1 << 20 ;
    }
    break ;
  case DigitalPort::D44 : // PTB22
    if (inValue) {
      GPIOB_PSOR = 1 << 22 ;
    }else{
      GPIOB_PCOR = 1 << 22 ;
    }
    break ;
  case DigitalPort::D45 : // PTB23
    if (inValue) {
      GPIOB_PSOR = 1 << 23 ;
    }else{
      GPIOB_PCOR = 1 << 23 ;
    }
    break ;
  case DigitalPort::D46 : // PTB21
    if (inValue) {
      GPIOB_PSOR = 1 << 21 ;
    }else{
      GPIOB_PCOR = 1 << 21 ;
    }
    break ;
  case DigitalPort::D47 : // PTD8
    if (inValue) {
      GPIOD_PSOR = 1 << 8 ;
    }else{
      GPIOD_PCOR = 1 << 8 ;
    }
    break ;
  case DigitalPort::D48 : // PTD9
    if (inValue) {
      GPIOD_PSOR = 1 << 9 ;
    }else{
      GPIOD_PCOR = 1 << 9 ;
    }
    break ;
  case DigitalPort::D49 : // PTB4
    if (inValue) {
      GPIOB_PSOR = 1 << 4 ;
    }else{
      GPIOB_PCOR = 1 << 4 ;
    }
    break ;
  case DigitalPort::D50 : // PTB5
    if (inValue) {
      GPIOB_PSOR = 1 << 5 ;
    }else{
      GPIOB_PCOR = 1 << 5 ;
    }
    break ;
  case DigitalPort::D51 : // PTD14
    if (inValue) {
      GPIOD_PSOR = 1 << 14 ;
    }else{
      GPIOD_PCOR = 1 << 14 ;
    }
    break ;
  case DigitalPort::D52 : // PTD13
    if (inValue) {
      GPIOD_PSOR = 1 << 13 ;
    }else{
      GPIOD_PCOR = 1 << 13 ;
    }
    break ;
  case DigitalPort::D53 : // PTD12
    if (inValue) {
      GPIOD_PSOR = 1 << 12 ;
    }else{
      GPIOD_PCOR = 1 << 12 ;
    }
    break ;
  case DigitalPort::D54 : // PTD15
    if (inValue) {
      GPIOD_PSOR = 1 << 15 ;
    }else{
      GPIOD_PCOR = 1 << 15 ;
    }
    break ;
  case DigitalPort::D55 : // PTD11
    if (inValue) {
      GPIOD_PSOR = 1 << 11 ;
    }else{
      GPIOD_PCOR = 1 << 11 ;
    }
    break ;
  case DigitalPort::D56 : // PTE10
    if (inValue) {
      GPIOE_PSOR = 1 << 10 ;
    }else{
      GPIOE_PCOR = 1 << 10 ;
    }
    break ;
  case DigitalPort::D57 : // PTE11
    if (inValue) {
      GPIOE_PSOR = 1 << 11 ;
    }else{
      GPIOE_PCOR = 1 << 11 ;
    }
    break ;
  case DigitalPort::True : // No port
  case DigitalPort::False : // No port
    break ;
  }
}

//——————————————————————————————————————————————————————————————————————————————————————————————————————————————————————

bool digitalRead (const DigitalPort inPort) {
  bool result = false ;
  switch (inPort) {
  case DigitalPort::D0 : // PTB16
    result = (GPIOB_PDIR & (1 << 16)) != 0 ;
    break ;
  case DigitalPort::D1 : // PTB17
    result = (GPIOB_PDIR & (1 << 17)) != 0 ;
    break ;
  case DigitalPort::D2 : // PTD0
    result = (GPIOD_PDIR & (1 << 0)) != 0 ;
    break ;
  case DigitalPort::D3 : // PTA12
    result = (GPIOA_PDIR & (1 << 12)) != 0 ;
    break ;
  case DigitalPort::D4 : // PTA13
    result = (GPIOA_PDIR & (1 << 13)) != 0 ;
    break ;
  case DigitalPort::D5 : // PTD7
    result = (GPIOD_PDIR & (1 << 7)) != 0 ;
    break ;
  case DigitalPort::D6 : // PTD4
    result = (GPIOD_PDIR & (1 << 4)) != 0 ;
    break ;
  case DigitalPort::D7 : // PTD2
    result = (GPIOD_PDIR & (1 << 2)) != 0 ;
    break ;
  case DigitalPort::D8 : // PTD3
    result = (GPIOD_PDIR & (1 << 3)) != 0 ;
    break ;
  case DigitalPort::D9  : // PTC3
    result = (GPIOC_PDIR & (1 << 3)) != 0 ;
    break ;
  case DigitalPort::D10 : // PTC4
    result = (GPIOC_PDIR & (1 << 4)) != 0 ;
    break ;
  case DigitalPort::D11 : // PTC6
    result = (GPIOC_PDIR & (1 << 6)) != 0 ;
    break ;
  case DigitalPort::D12 : // PTC7
    result = (GPIOC_PDIR & (1 << 7)) != 0 ;
    break ;
  case DigitalPort::D13 : // PTC5
    result = (GPIOC_PDIR & (1 << 5)) != 0 ;
    break ;
  case DigitalPort::D14 : // PTD1
    result = (GPIOD_PDIR & (1 << 1)) != 0 ;
    break ;
  case DigitalPort::D15 : // PTC0
    result = (GPIOC_PDIR & (1 << 0)) != 0 ;
    break ;
  case DigitalPort::D16 : // PTB0
    result = (GPIOB_PDIR & (1 << 0)) != 0 ;
    break ;
  case DigitalPort::D17 : // PTB1
    result = (GPIOB_PDIR & (1 << 1)) != 0 ;
    break ;
  case DigitalPort::D18 : // PTB3
    result = (GPIOB_PDIR & (1 << 3)) != 0 ;
    break ;
  case DigitalPort::D19 : // PTB2
    result = (GPIOB_PDIR & (1 << 2)) != 0 ;
    break ;
  case DigitalPort::D20 : // PTD5
    result = (GPIOD_PDIR & (1 << 5)) != 0 ;
    break ;
  case DigitalPort::D21 : // PTD6
    result = (GPIOD_PDIR & (1 << 6)) != 0 ;
    break ;
  case DigitalPort::D22 : // PTC1
    result = (GPIOC_PDIR & (1 << 1)) != 0 ;
    break ;
  case DigitalPort::D23 : // PTC2
    result = (GPIOC_PDIR & (1 << 2)) != 0 ;
    break ;
  case DigitalPort::D24 : // PTE26
    result = (GPIOE_PDIR & (1 << 26)) != 0 ;
    break ;
  case DigitalPort::D25 : // PTA5
    result = (GPIOA_PDIR & (1 << 5)) != 0 ;
    break ;
  case DigitalPort::D26 : // PTA14
    result = (GPIOA_PDIR & (1 << 14)) != 0 ;
    break ;
  case DigitalPort::D27 : // PTA15
    result = (GPIOA_PDIR & (1 << 15)) != 0 ;
    break ;
  case DigitalPort::D28 : // PTA16
    result = (GPIOA_PDIR & (1 << 16)) != 0 ;
    break ;
  case DigitalPort::D29 : // PTB18
    result = (GPIOB_PDIR & (1 << 18)) != 0 ;
    break ;
  case DigitalPort::D30 : // PTB19
    result = (GPIOB_PDIR & (1 << 19)) != 0 ;
    break ;
  case DigitalPort::D31 : // PTB10
    result = (GPIOB_PDIR & (1 << 10)) != 0 ;
    break ;
  case DigitalPort::D32 : // PTB11
    result = (GPIOB_PDIR & (1 << 11)) != 0 ;
    break ;
  case DigitalPort::D33 : // PTE24
    result = (GPIOE_PDIR & (1 << 24)) != 0 ;
    break ;
  case DigitalPort::D34 : // PTE25
    result = (GPIOE_PDIR & (1 << 25)) != 0 ;
    break ;
  case DigitalPort::D35 : // PTC8
    result = (GPIOC_PDIR & (1 << 8)) != 0 ;
    break ;
  case DigitalPort::D36 : // PTC9
    result = (GPIOC_PDIR & (1 << 9)) != 0 ;
    break ;
  case DigitalPort::D37 : // PTC10
    result = (GPIOC_PDIR & (1 << 10)) != 0 ;
    break ;
  case DigitalPort::D38 : // PTC11
    result = (GPIOC_PDIR & (1 << 11)) != 0 ;
    break ;
  case DigitalPort::D39 : // PTA17
    result = (GPIOA_PDIR & (1 << 17)) != 0 ;
    break ;
  case DigitalPort::D40 : // PTA28
    result = (GPIOA_PDIR & (1 << 28)) != 0 ;
    break ;
  case DigitalPort::D41 : // PTA29
    result = (GPIOA_PDIR & (1 << 29)) != 0 ;
    break ;
  case DigitalPort::D42 : // PTA26
    result = (GPIOA_PDIR & (1 << 26)) != 0 ;
    break ;
  case DigitalPort::D43 : // PTB20
    result = (GPIOB_PDIR & (1 << 20)) != 0 ;
    break ;
  case DigitalPort::D44 : // PTB22
    result = (GPIOB_PDIR & (1 << 22)) != 0 ;
    break ;
  case DigitalPort::D45 : // PTB23
    result = (GPIOB_PDIR & (1 << 23)) != 0 ;
    break ;
  case DigitalPort::D46 : // PTB21
    result = (GPIOB_PDIR & (1 << 21)) != 0 ;
    break ;
  case DigitalPort::D47 : // PTD8
    result = (GPIOD_PDIR & (1 << 8)) != 0 ;
    break ;
  case DigitalPort::D48 : // PTD9
    result = (GPIOD_PDIR & (1 << 9)) != 0 ;
    break ;
  case DigitalPort::D49 : // PTB4
    result = (GPIOB_PDIR & (1 << 4)) != 0 ;
    break ;
  case DigitalPort::D50 : // PTB5
    result = (GPIOB_PDIR & (1 << 5)) != 0 ;
    break ;
  case DigitalPort::D51 : // PTD14
    result = (GPIOD_PDIR & (1 << 14)) != 0 ;
    break ;
  case DigitalPort::D52 : // PTD13
    result = (GPIOD_PDIR & (1 << 13)) != 0 ;
    break ;
  case DigitalPort::D53 : // PTD12
    result = (GPIOD_PDIR & (1 << 12)) != 0 ;
    break ;
  case DigitalPort::D54 : // PTD15
    result = (GPIOD_PDIR & (1 << 15)) != 0 ;
    break ;
  case DigitalPort::D55 : // PTD11
    result = (GPIOD_PDIR & (1 << 11)) != 0 ;
    break ;
  case DigitalPort::D56 : // PTE10
    result = (GPIOE_PDIR & (1 << 10)) != 0 ;
    break ;
  case DigitalPort::D57 : // PTE11
    result = (GPIOE_PDIR & (1 << 11)) != 0 ;
    break ;
  case DigitalPort::False : // No port, returns always false
    break ;
  case DigitalPort::True : // No port, returns always true
    result = true ;
    break ;
  }
  return result ;
}

//——————————————————————————————————————————————————————————————————————————————————————————————————————————————————————

void digitalToggle (const DigitalPort inPort) {
  switch (inPort) {
  case DigitalPort::D0 : // PTB16
    GPIOB_PTOR = 1 << 16 ;
    break ;
  case DigitalPort::D1 : // PTB17
    GPIOB_PTOR = 1 << 17 ;
    break ;
  case DigitalPort::D2 : // PTD0
    GPIOD_PTOR = 1 << 0 ;
    break ;
  case DigitalPort::D3 : // PTA12
    GPIOA_PTOR = 1 << 12 ;
    break ;
  case DigitalPort::D4 : // PTA13
    GPIOA_PTOR = 1 << 13 ;
    break ;
  case DigitalPort::D5 : // PTD7
    GPIOD_PTOR = 1 << 7 ;
    break ;
  case DigitalPort::D6 : // PTD4
    GPIOD_PTOR = 1 << 4 ;
    break ;
  case DigitalPort::D7 : // PTD2
    GPIOD_PTOR = 1 << 2 ;
    break ;
  case DigitalPort::D8 : // PTD3
    GPIOD_PTOR = 1 << 3 ;
    break ;
  case DigitalPort::D9  : // PTC3
    GPIOC_PTOR = 1 << 3 ;
    break ;
  case DigitalPort::D10 : // PTC4
    GPIOC_PTOR = 1 << 4 ;
    break ;
  case DigitalPort::D11 : // PTC6
    GPIOC_PTOR = 1 << 6 ;
    break ;
  case DigitalPort::D12 : // PTC7
    GPIOC_PTOR = 1 << 7 ;
    break ;
  case DigitalPort::D13 : // PTC5
    GPIOC_PTOR = 1 << 5 ;
    break ;
  case DigitalPort::D14 : // PTD1
    GPIOD_PTOR = 1 << 1 ;
    break ;
  case DigitalPort::D15 : // PTC0
    GPIOC_PTOR = 1 << 0 ;
    break ;
  case DigitalPort::D16 : // PTB0
    GPIOB_PTOR = 1 << 0 ;
    break ;
  case DigitalPort::D17 : // PTB1
    GPIOB_PTOR = 1 << 1 ;
    break ;
  case DigitalPort::D18 : // PTB3
    GPIOB_PTOR = 1 << 3 ;
    break ;
  case DigitalPort::D19 : // PTB2
    GPIOB_PTOR = 1 << 2 ;
    break ;
  case DigitalPort::D20 : // PTD5
    GPIOD_PTOR = 1 << 5 ;
    break ;
  case DigitalPort::D21 : // PTD6
    GPIOD_PTOR = 1 << 6 ;
    break ;
  case DigitalPort::D22 : // PTC1
    GPIOC_PTOR = 1 << 1 ;
    break ;
  case DigitalPort::D23 : // PTC2
    GPIOC_PTOR = 1 << 2 ;
    break ;
  case DigitalPort::D24 : // PTE26
    GPIOE_PTOR = 1 << 26 ;
    break ;
  case DigitalPort::D25 : // PTA5
    GPIOA_PTOR = 1 << 5 ;
    break ;
  case DigitalPort::D26 : // PTA14
    GPIOA_PTOR = 1 << 14 ;
    break ;
  case DigitalPort::D27 : // PTA15
    GPIOA_PTOR = 1 << 15 ;
    break ;
  case DigitalPort::D28 : // PTA16
    GPIOA_PTOR = 1 << 16 ;
    break ;
  case DigitalPort::D29 : // PTB18
    GPIOB_PTOR = 1 << 18 ;
    break ;
  case DigitalPort::D30 : // PTB19
    GPIOB_PTOR = 1 << 19 ;
    break ;
  case DigitalPort::D31 : // PTB10
    GPIOB_PTOR = 1 << 10 ;
    break ;
  case DigitalPort::D32 : // PTB11
    GPIOB_PTOR = 1 << 11 ;
    break ;
  case DigitalPort::D33 : // PTE24
    GPIOE_PTOR = 1 << 24 ;
    break ;
  case DigitalPort::D34 : // PTE25
    GPIOE_PTOR = 1 << 25 ;
    break ;
  case DigitalPort::D35 : // PTC8
    GPIOC_PTOR = 1 << 8 ;
    break ;
  case DigitalPort::D36 : // PTC9
    GPIOC_PTOR = 1 << 9 ;
    break ;
  case DigitalPort::D37 : // PTC10
    GPIOC_PTOR = 1 << 10 ;
    break ;
  case DigitalPort::D38 : // PTC11
    GPIOC_PTOR = 1 << 11 ;
    break ;
  case DigitalPort::D39 : // PTA17
    GPIOA_PTOR = 1 << 17 ;
    break ;
  case DigitalPort::D40 : // PTA28
    GPIOA_PTOR = 1 << 28 ;
    break ;
  case DigitalPort::D41 : // PTA29
    GPIOA_PTOR = 1 << 29 ;
    break ;
  case DigitalPort::D42 : // PTA26
    GPIOA_PTOR = 1 << 26 ;
    break ;
  case DigitalPort::D43 : // PTB20
    GPIOB_PTOR = 1 << 20 ;
    break ;
  case DigitalPort::D44 : // PTB22
    GPIOB_PTOR = 1 << 22 ;
    break ;
  case DigitalPort::D45 : // PTB23
    GPIOB_PTOR = 1 << 23 ;
    break ;
  case DigitalPort::D46 : // PTB21
    GPIOB_PTOR = 1 << 21 ;
    break ;
  case DigitalPort::D47 : // PTD8
    GPIOD_PTOR = 1 << 8 ;
    break ;
  case DigitalPort::D48 : // PTD9
    GPIOD_PTOR = 1 << 9 ;
    break ;
  case DigitalPort::D49 : // PTB4
    GPIOB_PTOR = 1 << 4 ;
    break ;
  case DigitalPort::D50 : // PTB5
    GPIOB_PTOR = 1 << 5 ;
    break ;
  case DigitalPort::D51 : // PTD14
    GPIOD_PTOR = 1 << 14 ;
    break ;
  case DigitalPort::D52 : // PTD13
    GPIOD_PTOR = 1 << 13 ;
    break ;
  case DigitalPort::D53 : // PTD12
    GPIOD_PTOR = 1 << 12 ;
    break ;
  case DigitalPort::D54 : // PTD15
    GPIOD_PTOR = 1 << 15 ;
    break ;
  case DigitalPort::D55 : // PTD11
    GPIOD_PTOR = 1 << 11 ;
    break ;
  case DigitalPort::D56 : // PTE10
    GPIOE_PTOR = 1 << 10 ;
    break ;
  case DigitalPort::D57 : // PTE11
    GPIOE_PTOR = 1 << 11 ;
    break ;
  case DigitalPort::False : // No port, no effect
  case DigitalPort::True : // No port, no effect
    break ;
  }
}

//——————————————————————————————————————————————————————————————————————————————————————————————————————————————————————