src/commonlib/storage/pci_sdhci.c

   1 /* SPDX-License-Identifier: GPL-2.0-or-later */
   2
   3 #include <commonlib/sdhci.h>
   4 #include <device/pci.h>
   5 #include <device/pci_ops.h>
   6 #include <stdint.h>
   7 #include <string.h>
   8
   9 #include "sd_mmc.h"
  10 #include "storage.h"
  11
  12 /* Initialize an SDHCI port */
  13 int sdhci_controller_init(struct sdhci_ctrlr *sdhci_ctrlr, void *ioaddr)
  14 {
  15         memset(sdhci_ctrlr, 0, sizeof(*sdhci_ctrlr));
  16         sdhci_ctrlr->ioaddr = ioaddr;
  17         return add_sdhci(sdhci_ctrlr);
  18 }
  19
  20 struct sd_mmc_ctrlr *new_mem_sdhci_controller(void *ioaddr)
  21 {
  22         static bool sdhci_init_done;
  23         static struct sdhci_ctrlr sdhci_ctrlr;
  24
  25         if (sdhci_init_done == true) {
  26                 sdhc_error("Error: SDHCI is already initialized.\n");
  27                 return NULL;
  28         }
  29
  30         if (sdhci_controller_init(&sdhci_ctrlr, ioaddr)) {
  31                 sdhc_error("Error: SDHCI initialization failed.\n");
  32                 return NULL;
  33         }
  34
  35         sdhci_init_done = true;
  36
  37         return &sdhci_ctrlr.sd_mmc_ctrlr;
  38 }
  39
  40 struct sd_mmc_ctrlr *new_pci_sdhci_controller(pci_devfn_t dev)
  41 {
  42         uint32_t addr;
  43
  44         addr = pci_s_read_config32(dev, PCI_BASE_ADDRESS_0);
  45         if (addr == ((uint32_t)~0)) {
  46                 sdhc_error("Error: PCI SDHCI not found\n");
  47                 return NULL;
  48         }
  49
  50         addr &= ~0xf;
  51         return new_mem_sdhci_controller((void *)addr);
  52 }