Page MenuHomeFreeBSD

D30288.id89397.diff
No OneTemporary

D30288.id89397.diff

Index: sys/conf/files
===================================================================
--- sys/conf/files
+++ sys/conf/files
@@ -2476,6 +2476,8 @@
dev/mmc/mmcbus_if.m standard
dev/mmc/mmcsd.c optional mmcsd !mmccam
dev/mmc/mmc_fdt_helpers.c optional mmc fdt | mmccam fdt
+dev/mmc/mmc_pwrseq.c optional mmc fdt | mmccam fdt
+dev/mmc/mmc_pwrseq_if.m optional mmc fdt | mmccam fdt
dev/mmcnull/mmcnull.c optional mmcnull
dev/mpr/mpr.c optional mpr
dev/mpr/mpr_config.c optional mpr
Index: sys/dev/mmc/mmc_pwrseq.c
===================================================================
--- /dev/null
+++ sys/dev/mmc/mmc_pwrseq.c
@@ -0,0 +1,192 @@
+/*
+ * Copyright 2021 Emmanuel Vadot <manu@freebsd.org>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are
+ * met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
+ * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
+ * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
+ * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
+ * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/gpio.h>
+
+#include <dev/gpio/gpiobusvar.h>
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+
+#include <dev/extres/clk/clk.h>
+
+#include "mmc_pwrseq_if.h"
+
+enum pwrseq_type {
+ PWRSEQ_SIMPLE = 1,
+ PWRSEQ_EMMC,
+};
+
+static struct ofw_compat_data compat_data[] = {
+ { "mmc-pwrseq-simple", PWRSEQ_SIMPLE },
+ { "mmc-pwrseq-emmc", PWRSEQ_EMMC },
+ { NULL, 0 }
+};
+
+struct mmc_pwrseq_softc {
+ enum pwrseq_type type;
+ clk_t ext_clock;
+ struct gpiobus_pin *reset_gpio;
+
+ uint32_t post_power_on_delay_ms;
+ uint32_t power_off_delay_us;
+};
+
+static int
+mmc_pwrseq_probe(device_t dev)
+{
+ enum pwrseq_type type;
+
+ if (!ofw_bus_search_compatible(dev, compat_data)->ocd_data)
+ return (ENXIO);
+
+ type = (enum pwrseq_type)ofw_bus_search_compatible(dev, compat_data)->ocd_data;
+ switch (type) {
+ case PWRSEQ_SIMPLE:
+ device_set_desc(dev, "MMC Simple Power sequence");
+ break;
+ case PWRSEQ_EMMC:
+ device_set_desc(dev, "MMC eMMC Power sequence");
+ break;
+ }
+ return (BUS_PROBE_DEFAULT);
+}
+
+static int
+mmc_pwrseq_attach(device_t dev)
+{
+ struct mmc_pwrseq_softc *sc;
+ phandle_t node;
+ int rv;
+
+ sc = device_get_softc(dev);
+ sc->type = (enum pwrseq_type)ofw_bus_search_compatible(dev, compat_data)->ocd_data;
+ node = ofw_bus_get_node(dev);
+
+ if (sc->type == PWRSEQ_SIMPLE) {
+ if (OF_hasprop(node, "clocks")) {
+ rv = clk_get_by_ofw_name(dev, 0, "ext_clock", &sc->ext_clock);
+ if (rv != 0) {
+ device_printf(dev,
+ "Node have a clocks property but no clocks named \"ext_clock\"\n");
+ return (ENXIO);
+ }
+ }
+ OF_getencprop(node, "post-power-on-delay-ms", &sc->post_power_on_delay_ms, sizeof(uint32_t));
+ OF_getencprop(node, "power-off-delay-us", &sc->power_off_delay_us, sizeof(uint32_t));
+ }
+
+ if (OF_hasprop(node, "reset-gpios")) {
+ if (gpio_pin_get_by_ofw_property(dev, node, "reset-gpios",
+ &sc->reset_gpio) != 0) {
+ device_printf(dev, "Cannot get the reset-gpios\n");
+ return (ENXIO);
+ }
+ gpio_pin_setflags(sc->reset_gpio, GPIO_PIN_OUTPUT);
+ gpio_pin_set_active(sc->reset_gpio, true);
+ }
+
+ OF_device_register_xref(OF_xref_from_node(node), dev);
+ return (0);
+}
+
+static int
+mmc_pwrseq_detach(device_t dev)
+{
+
+ return (EBUSY);
+}
+
+static int
+mmv_pwrseq_set_power(device_t dev, bool power_on)
+{
+ struct mmc_pwrseq_softc *sc;
+ int rv;
+
+ sc = device_get_softc(dev);
+
+ if (power_on) {
+ if (sc->ext_clock) {
+ rv = clk_enable(sc->ext_clock);
+ if (rv != 0)
+ return (rv);
+ }
+
+ if (sc->reset_gpio) {
+ rv = gpio_pin_set_active(sc->reset_gpio, false);
+ if (rv != 0)
+ return (rv);
+ }
+
+ if (sc->post_power_on_delay_ms)
+ DELAY(sc->post_power_on_delay_ms * 1000);
+ } else {
+ if (sc->reset_gpio) {
+ rv = gpio_pin_set_active(sc->reset_gpio, true);
+ if (rv != 0)
+ return (rv);
+ }
+
+ if (sc->ext_clock) {
+ rv = clk_stop(sc->ext_clock);
+ if (rv != 0)
+ return (rv);
+ }
+ if (sc->power_off_delay_us)
+ DELAY(sc->power_off_delay_us);
+ }
+
+ return (0);
+}
+
+static device_method_t mmc_pwrseq_methods[] = {
+ /* Device interface */
+ DEVMETHOD(device_probe, mmc_pwrseq_probe),
+ DEVMETHOD(device_attach, mmc_pwrseq_attach),
+ DEVMETHOD(device_detach, mmc_pwrseq_detach),
+
+ DEVMETHOD(mmc_pwrseq_set_power, mmv_pwrseq_set_power),
+ DEVMETHOD_END
+};
+
+static driver_t mmc_pwrseq_driver = {
+ "mmc_pwrseq",
+ mmc_pwrseq_methods,
+ sizeof(struct mmc_pwrseq_softc),
+};
+
+static devclass_t mmc_pwrseq_devclass;
+
+EARLY_DRIVER_MODULE(mmc_pwrseq, simplebus, mmc_pwrseq_driver, mmc_pwrseq_devclass, 0, 0,
+ BUS_PASS_SUPPORTDEV + BUS_PASS_ORDER_FIRST);
+MODULE_VERSION(mmc_pwrseq, 1);
+SIMPLEBUS_PNP_INFO(compat_data);
Index: sys/dev/mmc/mmc_pwrseq_if.m
===================================================================
--- /dev/null
+++ sys/dev/mmc/mmc_pwrseq_if.m
@@ -0,0 +1,38 @@
+#-
+# SPDX-License-Identifier: BSD-2-Clause-FreeBSD
+#
+# Copyright (c) 2021 Emmanuel Vadot <manu@FreeBSD.org>
+#
+# Redistribution and use in source and binary forms, with or without
+# modification, are permitted provided that the following conditions
+# are met:
+# 1. Redistributions of source code must retain the above copyright
+# notice, this list of conditions and the following disclaimer.
+# 2. Redistributions in binary form must reproduce the above copyright
+# notice, this list of conditions and the following disclaimer in the
+# documentation and/or other materials provided with the distribution.
+#
+# THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+# ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+# IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+# ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+# FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+# DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+# OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+# HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+# OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+# SUCH DAMAGE.
+#
+# $FreeBSD$
+#
+
+INTERFACE mmc_pwrseq;
+
+#
+# Power up/down the card
+#
+METHOD int set_power {
+ device_t bus;
+ bool power_on;
+};

File Metadata

Mime Type
text/plain
Expires
Wed, Sep 2, 8:02 AM (10 h, 24 m)
Storage Engine
blob
Storage Format
Raw Data
Storage Handle
37931371
Default Alt Text
D30288.id89397.diff (7 KB)

Event Timeline