ChibiOS Free Embedded RTOS

Code: Select all

static FATFS MMC_FS;

/**
 * MMC driver instance.
 */
MMCDriver MMCD1;

/* FS mounted and ready.*/
static bool_t fs_ready = FALSE;

/* Maximum speed SPI configuration (18MHz, CPHA=0, CPOL=0, MSb first).*/
static SPIConfig hs_spicfg = {NULL, GPIOA, GPIOA_LRCK, 0};

/* Low speed SPI configuration (281.250kHz, CPHA=0, CPOL=0, MSb first).*/
static SPIConfig ls_spicfg = {NULL, GPIOA, GPIOA_LRCK, SPI_CR1_BR_2 | SPI_CR1_BR_1};
/* MMC/SD over SPI driver configuration.*/
static MMCConfig mmccfg = {&SPID3, &ls_spicfg, &hs_spicfg};

static EventSource inserted_event, removed_event;

void sd_init(void) {
  struct EventListener el0, el1;
  static const evhandler_t evhndl[] = {
    InsertHandler,
    RemoveHandler
  };

  // function alternate for spi3
  palSetPadMode(GPIOC, 12, PAL_MODE_ALTERNATE(6) | PAL_STM32_OSPEED_LOWEST); // mosi
  palSetPadMode(GPIOC, 11, PAL_MODE_ALTERNATE(6) | PAL_STM32_OSPEED_LOWEST); // miso
  palSetPadMode(GPIOC, 10, PAL_MODE_ALTERNATE(6) | PAL_STM32_OSPEED_LOWEST); // ck

  palSetPadMode(GPIOA, 4, PAL_MODE_ALTERNATE(6) | PAL_STM32_OSPEED_LOWEST); // ss
  palSetPad(GPIOA, 4);

  mmcObjectInit(&MMCD1);
  mmcStart(&MMCD1, &mmccfg);

  chEvtRegister(&inserted_event, &el0, 0);
  chEvtRegister(&removed_event, &el1, 1);

test();
}

void test(BaseSequentialStream *chp, int argc, char *argv[]) {
  FRESULT err;
  uint32_t clusters;

  (void)argv;

//  chprintf(chp, "Trying to connect MMCD1... ");
  bool_t a=mmcConnect(&MMCD1);
//  if (a) {
//    chprintf(chp, "failed connect card!\r\n");
//    return;
//  }

  err = f_mount(0, &MMC_FS);
  if (err != FR_OK) {
   // mmcDisconnect(&MMCD1);
    return;
  } else {
    chprintf(chp, "FS: mounted\r\n");
  }
.........