FAP port read code snippet

FAP_port_read.c

// loads a port for CPU to read
void load16(uint8_t address, uint8_t data)
{
  // put the address and data onto STM32-CPLD bus
  uint16_t value = 0;
  value = (address & 0xf) << 8;
  value = value | data;
  CPLD_DATA_PORT->ODR &= 0xf000;
  CPLD_DATA_PORT->ODR |= value;
  data_output();
  addr_output();
  // load the latch
  latch16_activate();
  latch16_deactivate();
  data_input();
  addr_input();
}