svn commit: r243274 - projects/efika_mx/sys/arm/freescale/imx
Aleksandr Rybalko
ray at FreeBSD.org
Mon Nov 19 11:55:24 UTC 2012
Author: ray
Date: Mon Nov 19 11:55:24 2012
New Revision: 243274
URL: http://svnweb.freebsd.org/changeset/base/243274
Log:
Watchdog driver for i.MX51x.
Sponsored by: FreeBSD Foundation
Added:
projects/efika_mx/sys/arm/freescale/imx/imx_wdog.c
projects/efika_mx/sys/arm/freescale/imx/imx_wdogreg.h
Added: projects/efika_mx/sys/arm/freescale/imx/imx_wdog.c
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ projects/efika_mx/sys/arm/freescale/imx/imx_wdog.c Mon Nov 19 11:55:24 2012 (r243274)
@@ -0,0 +1,163 @@
+/*-
+ * Copyright (c) 2012 The FreeBSD Foundation
+ * All rights reserved.
+ *
+ * This software was developed by Oleksandr Rybalko under sponsorship
+ * from the FreeBSD Foundation.
+ *
+ * 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/systm.h>
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/time.h>
+#include <sys/bus.h>
+#include <sys/resource.h>
+#include <sys/rman.h>
+#include <sys/watchdog.h>
+
+#include <machine/bus.h>
+#include <machine/intr.h>
+
+#include <dev/fdt/fdt_common.h>
+#include <dev/ofw/openfirm.h>
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+#include <machine/fdt.h>
+
+#include <arm/freescale/imx/imx_wdogreg.h>
+
+struct imx_wdog_softc {
+ struct mtx sc_mtx;
+ device_t sc_dev;
+ bus_space_tag_t sc_bst;
+ bus_space_handle_t sc_bsh;
+ struct resource *sc_res[2];
+ uint32_t sc_timeout;
+};
+
+static struct resource_spec imx_wdog_spec[] = {
+ { SYS_RES_MEMORY, 0, RF_ACTIVE },
+ { SYS_RES_IRQ, 0, RF_ACTIVE },
+ { -1, 0 }
+};
+
+static void imx_watchdog(void *, u_int, int *);
+static int imx_wdog_probe(device_t);
+static int imx_wdog_attach(device_t);
+
+static device_method_t imx_wdog_methods[] = {
+ DEVMETHOD(device_probe, imx_wdog_probe),
+ DEVMETHOD(device_attach, imx_wdog_attach),
+ DEVMETHOD_END
+};
+
+static driver_t imx_wdog_driver = {
+ "imx_wdog",
+ imx_wdog_methods,
+ sizeof(struct imx_wdog_softc),
+};
+static devclass_t imx_wdog_devclass;
+DRIVER_MODULE(imx_wdog, simplebus, imx_wdog_driver, imx_wdog_devclass, 0, 0);
+
+
+static void
+imx_watchdog(void *arg, u_int cmd, int *error)
+{
+ struct imx_wdog_softc *sc;
+ uint16_t reg;
+ int timeout;
+
+ sc = arg;
+ mtx_lock(&sc->sc_mtx);
+
+ /* Refresh counter, since we feels good */
+ WRITE(sc, WDOG_SR_REG, WDOG_SR_STEP1);
+ WRITE(sc, WDOG_SR_REG, WDOG_SR_STEP2);
+
+ /* We don't require precession, so "-10" (/1024) is ok */
+ timeout = (1 << ((cmd & WD_INTERVAL) - 10)) / 1000000;
+ if (timeout > 1 && timeout < 128) {
+ if (timeout != sc->sc_timeout) {
+ device_printf(sc->sc_dev,
+ "WARNING: watchdog can't be disabled!!!");
+ sc->sc_timeout = timeout;
+ reg = READ(sc, WDOG_CR_REG);
+ reg &= ~WDOG_CR_WT_MASK;
+ reg |= (timeout << (WDOG_CR_WT_SHIFT + 1)) &
+ WDOG_CR_WT_MASK;
+ WRITE(sc, WDOG_CR_REG, reg);
+ /* Refresh counter */
+ WRITE(sc, WDOG_SR_REG, WDOG_SR_STEP1);
+ WRITE(sc, WDOG_SR_REG, WDOG_SR_STEP2);
+ *error = 0;
+ } else {
+ *error = EOPNOTSUPP;
+ }
+ } else {
+ device_printf(sc->sc_dev, "Can not be disabled.\n");
+ *error = EOPNOTSUPP;
+ }
+ mtx_unlock(&sc->sc_mtx);
+
+}
+
+static int
+imx_wdog_probe(device_t dev)
+{
+
+ if (!ofw_bus_is_compatible(dev, "fsl,imx51-wdt"))
+ return (ENXIO);
+
+ device_set_desc(dev, "Freescale i.MX5xx Watchdog Timer");
+ return (0);
+}
+
+static int
+imx_wdog_attach(device_t dev)
+{
+ struct imx_wdog_softc *sc;
+
+ sc = device_get_softc(dev);
+ sc->sc_dev = dev;
+
+ if (bus_alloc_resources(dev, imx_wdog_spec, sc->sc_res)) {
+ device_printf(dev, "could not allocate resources\n");
+ return (ENXIO);
+ }
+
+ mtx_init(&sc->sc_mtx, device_get_nameunit(dev), "imx_wdt", MTX_DEF);
+
+ sc->sc_dev = dev;
+ sc->sc_bst = rman_get_bustag(sc->sc_res[0]);
+ sc->sc_bsh = rman_get_bushandle(sc->sc_res[0]);
+
+ /* TODO: handle interrupt */
+
+ EVENTHANDLER_REGISTER(watchdog_list, imx_watchdog, sc, 0);
+ return (0);
+}
Added: projects/efika_mx/sys/arm/freescale/imx/imx_wdogreg.h
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ projects/efika_mx/sys/arm/freescale/imx/imx_wdogreg.h Mon Nov 19 11:55:24 2012 (r243274)
@@ -0,0 +1,65 @@
+/*-
+ * Copyright (c) 2012 The FreeBSD Foundation
+ * All rights reserved.
+ *
+ * This software was developed by Oleksandr Rybalko under sponsorship
+ * from the FreeBSD Foundation.
+ *
+ * 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$
+ */
+
+#define WDOG_CLK_FREQ 32768
+
+#define WDOG_CR_REG 0x00 /* Control Register */
+#define WDOG_CR_WT_MASK 0xff00 /* Count of 0.5 sec */
+#define WDOG_CR_WT_SHIFT 8
+#define WDOG_CR_WDW (1 << 7) /* Suspend WDog */
+#define WDOG_CR_WDA (1 << 5) /* Don't touch ipp_wdog */
+#define WDOG_CR_SRS (1 << 4) /* Don't touch sys_reset */
+#define WDOG_CR_WDT (1 << 3) /* Assert ipp_wdog on tout */
+#define WDOG_CR_WDE (1 << 2) /* WDog Enable */
+#define WDOG_CR_WDBG (1 << 1) /* Suspend when DBG mode */
+#define WDOG_CR_WDZST (1 << 0) /* Suspend when LP mode */
+
+#define WDOG_SR_REG 0x02 /* Service Register */
+#define WDOG_SR_STEP1 0x5555
+#define WDOG_SR_STEP2 0xaaaa
+
+#define WDOG_RSR_REG 0x04 /* Reset Status Register */
+#define WDOG_RSR_TOUT (1 << 1) /* Due WDog timeout reset */
+#define WDOG_RSR_SFTW (1 << 0) /* Due Soft reset */
+
+#define WDOG_ICR_REG 0x06 /* Interrupt Control Register */
+#define WDOG_ICR_WIE (1 << 15) /* Enable Interrupt */
+#define WDOG_ICR_WTIS (1 << 14) /* Interrupt has occurred */
+#define WDOG_ICR_WTCT_MASK 0x00ff
+#define WDOG_ICR_WTCT_SHIFT 0 /* Interrupt hold time */
+
+#define WDOG_MCR_REG 0x08 /* Miscellaneous Control Register */
+#define WDOG_MCR_PDE (1 << 0)
+
+#define READ(_sc, _r) \
+ bus_space_read_2((_sc)->sc_bst, (_sc)->sc_bsh, (_r))
+#define WRITE(_sc, _r, _v) \
+ bus_space_write_2((_sc)->sc_bst, (_sc)->sc_bsh, (_r), (_v))
More information about the svn-src-projects
mailing list