Method initPio

lib/n64_gamecube_controller/Controller.cpp:15–39

}

void Controller::initPio(InitParams *initParams) {
  pio_hw_t *pios[2] = {pio0, pio1};
  uint pio_index = 0;
  if (!pio_can_add_program(pios[pio_index], &controller_program)) {
    pio_index = 1;
    if (!pio_can_add_program(pios[pio_index], &controller_program)) {
      // throw 0;
    }
  }
  initParams->pio = pios[pio_index];
  initParams->offset = pio_add_program(initParams->pio, &controller_program);
  initParams->sm = pio_claim_unused_sm(initParams->pio, true);
  pio_sm_config tmpConfig =
      controller_program_get_default_config(initParams->offset);
  initParams->c = &tmpConfig;
  controller_program_init(initParams->pio, initParams->sm, initParams->offset,
                          initParams->pin, initParams->c);

  // Send a command to see if connected controller is N64 or Gamecube
  uint8_t initRequest[1] = {0x00};
  uint8_t initResponse[3] = {0x00};
  transfer(initParams->pio, initParams->sm, initRequest, sizeof(initRequest),
           initResponse, sizeof(initResponse));
  initParams->controllerType = (ControllerType)initResponse[0];
}
void Controller::transfer(uint8_t *request, uint8_t requestLength,
                          uint8_t *response, uint8_t responseLength) {
  transfer(_pio, _sm, request, requestLength, response, responseLength);