diff options
author | gonzo <gonzo@FreeBSD.org> | 2012-11-30 02:32:37 +0000 |
---|---|---|
committer | gonzo <gonzo@FreeBSD.org> | 2012-11-30 02:32:37 +0000 |
commit | e7bfe2f92c15a2c30f4057d15c9cc08a3c400fe3 (patch) | |
tree | 5324180015615567a1252e5295f400f35490b96c | |
parent | c1fa64e79e757c0b76c8bcbb039864a25ed63cc5 (diff) | |
download | FreeBSD-src-e7bfe2f92c15a2c30f4057d15c9cc08a3c400fe3.zip FreeBSD-src-e7bfe2f92c15a2c30f4057d15c9cc08a3c400fe3.tar.gz |
Get frequency from "clock-frequency" property of "/axi/sdhci" FDT node
-rw-r--r-- | sys/arm/broadcom/bcm2835/bcm2835_sdhci.c | 15 |
1 files changed, 14 insertions, 1 deletions
diff --git a/sys/arm/broadcom/bcm2835/bcm2835_sdhci.c b/sys/arm/broadcom/bcm2835/bcm2835_sdhci.c index 94c1fcf..14422e2 100644 --- a/sys/arm/broadcom/bcm2835/bcm2835_sdhci.c +++ b/sys/arm/broadcom/bcm2835/bcm2835_sdhci.c @@ -56,6 +56,7 @@ __FBSDID("$FreeBSD$"); #include <machine/frame.h> #include <machine/intr.h> +#include <dev/fdt/fdt_common.h> #include <dev/ofw/ofw_bus.h> #include <dev/ofw/ofw_bus_subr.h> @@ -66,6 +67,8 @@ __FBSDID("$FreeBSD$"); #include <dev/sdhci/sdhci.h> #include "sdhci_if.h" +#define BCM2835_DEFAULT_SDHCI_FREQ 50 + #define DEBUG #ifdef DEBUG @@ -129,10 +132,20 @@ bcm_sdhci_attach(device_t dev) { struct bcm_sdhci_softc *sc = device_get_softc(dev); int rid, err; + phandle_t node; + pcell_t cell; + int default_freq; sc->sc_dev = dev; sc->sc_req = NULL; + default_freq = BCM2835_DEFAULT_SDHCI_FREQ; + node = ofw_bus_get_node(sc->sc_dev); + if ((OF_getprop(node, "clock-frequency", &cell, sizeof(cell))) > 0) + default_freq = (int)fdt32_to_cpu(cell)/1000000; + + dprintf("SDHCI frequency: %dMHz\n", default_freq); + mtx_init(&sc->sc_mtx, "bcm sdhci", "sdhci", MTX_DEF); rid = 0; @@ -168,7 +181,7 @@ bcm_sdhci_attach(device_t dev) } sc->sc_slot.caps = SDHCI_CAN_VDD_330 | SDHCI_CAN_VDD_180 | SDHCI_CAN_DO_HISPD; - sc->sc_slot.caps |= (50 << SDHCI_CLOCK_BASE_SHIFT); + sc->sc_slot.caps |= (default_freq << SDHCI_CLOCK_BASE_SHIFT); sc->sc_slot.quirks = SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK | SDHCI_QUIRK_BROKEN_TIMEOUT_VAL | SDHCI_QUIRK_MISSING_CAPS; |