From c30fa94277cfdf2c8a7e0a6206d31a506453a491 Mon Sep 17 00:00:00 2001 From: Sebastian Huber Date: Mon, 5 Feb 2018 13:57:11 +0100 Subject: Add device tree support for Altera/Intel Cyclone V Close #3290. --- freebsd/sys/dev/dwc/if_dwc.c | 25 +-- freebsd/sys/dev/mii/micphy.c | 21 --- freebsd/sys/dev/usb/controller/dwc_otg_fdt.c | 226 +++++++++++++++++++++++++++ freebsd/sys/dev/usb/controller/dwc_otg_fdt.h | 40 +++++ 4 files changed, 273 insertions(+), 39 deletions(-) create mode 100644 freebsd/sys/dev/usb/controller/dwc_otg_fdt.c create mode 100644 freebsd/sys/dev/usb/controller/dwc_otg_fdt.h (limited to 'freebsd') diff --git a/freebsd/sys/dev/dwc/if_dwc.c b/freebsd/sys/dev/dwc/if_dwc.c index 507547a9..badbd807 100644 --- a/freebsd/sys/dev/dwc/if_dwc.c +++ b/freebsd/sys/dev/dwc/if_dwc.c @@ -69,12 +69,8 @@ __FBSDID("$FreeBSD$"); #include #include #include -#ifndef __rtems__ #include #include -#else /* __rtems__ */ -#include -#endif /* __rtems__ */ #ifdef EXT_RESOURCES #include @@ -1159,10 +1155,14 @@ out: static int dwc_get_hwaddr(struct dwc_softc *sc, uint8_t *hwaddr) { -#ifndef __rtems__ uint32_t hi, lo, rnd; -#else /* __rtems__ */ - uint32_t hi, lo; +#ifdef __rtems__ + int i; + + i = OF_getprop(ofw_bus_get_node(sc->dev), "local-mac-address", + hwaddr, 6); + if (i == 6) + return (0); #endif /* __rtems__ */ /* @@ -1184,7 +1184,6 @@ dwc_get_hwaddr(struct dwc_softc *sc, uint8_t *hwaddr) hwaddr[4] = (hi >> 0) & 0xff; hwaddr[5] = (hi >> 8) & 0xff; } else { -#ifndef __rtems__ rnd = arc4random() & 0x00ffffff; hwaddr[0] = 'b'; hwaddr[1] = 's'; @@ -1192,10 +1191,6 @@ dwc_get_hwaddr(struct dwc_softc *sc, uint8_t *hwaddr) hwaddr[3] = rnd >> 16; hwaddr[4] = rnd >> 8; hwaddr[5] = rnd >> 0; -#else /* __rtems__ */ - rtems_bsd_get_mac_address(device_get_name(sc->dev), - device_get_unit(sc->dev), hwaddr); -#endif /* __rtems__ */ } return (0); @@ -1293,13 +1288,11 @@ static int dwc_probe(device_t dev) { -#ifndef __rtems__ if (!ofw_bus_status_okay(dev)) return (ENXIO); if (!ofw_bus_is_compatible(dev, "snps,dwmac")) return (ENXIO); -#endif /* __rtems__ */ device_set_desc(dev, "Gigabit Ethernet Controller"); return (BUS_PROBE_DEFAULT); @@ -1568,11 +1561,7 @@ driver_t dwc_driver = { static devclass_t dwc_devclass; -#ifndef __rtems__ DRIVER_MODULE(dwc, simplebus, dwc_driver, dwc_devclass, 0, 0); -#else /* __rtems__ */ -DRIVER_MODULE(dwc, nexus, dwc_driver, dwc_devclass, 0, 0); -#endif /* __rtems__ */ DRIVER_MODULE(miibus, dwc, miibus_driver, miibus_devclass, 0, 0); MODULE_DEPEND(dwc, ether, 1, 1, 1); diff --git a/freebsd/sys/dev/mii/micphy.c b/freebsd/sys/dev/mii/micphy.c index a8d90198..a108a9d2 100644 --- a/freebsd/sys/dev/mii/micphy.c +++ b/freebsd/sys/dev/mii/micphy.c @@ -57,12 +57,10 @@ __FBSDID("$FreeBSD$"); #include -#ifndef __rtems__ #include #include #include #include -#endif /* __rtems__ */ #define MII_KSZPHY_EXTREG 0x0b #define KSZPHY_EXTREG_WRITE (1 << 15) @@ -117,7 +115,6 @@ static const struct mii_phy_funcs micphy_funcs = { mii_phy_reset }; -#ifndef __rtems__ static uint32_t ksz9031_read(struct mii_softc *sc, uint32_t devaddr, uint32_t reg) { @@ -131,7 +128,6 @@ ksz9031_read(struct mii_softc *sc, uint32_t devaddr, uint32_t reg) return (PHY_READ(sc, MII_KSZ9031_MMD_ACCESS_DATA)); } -#endif /* __rtems__ */ static void ksz9031_write(struct mii_softc *sc, uint32_t devaddr, uint32_t reg, @@ -148,7 +144,6 @@ ksz9031_write(struct mii_softc *sc, uint32_t devaddr, uint32_t reg, PHY_WRITE(sc, MII_KSZ9031_MMD_ACCESS_DATA, val); } -#ifndef __rtems__ static uint32_t ksz9021_read(struct mii_softc *sc, uint32_t reg) { @@ -157,7 +152,6 @@ ksz9021_read(struct mii_softc *sc, uint32_t reg) return (PHY_READ(sc, MII_KSZPHY_EXTREG_READ)); } -#endif /* __rtems__ */ static void ksz9021_write(struct mii_softc *sc, uint32_t reg, uint32_t val) @@ -167,7 +161,6 @@ ksz9021_write(struct mii_softc *sc, uint32_t reg, uint32_t val) PHY_WRITE(sc, MII_KSZPHY_EXTREG_WRITE, val); } -#ifndef __rtems__ static void ksz90x1_load_values(struct mii_softc *sc, phandle_t node, uint32_t dev, uint32_t reg, char *field1, uint32_t f1mask, int f1off, @@ -245,7 +238,6 @@ ksz9021_load_values(struct mii_softc *sc, phandle_t node) "txd0-skew-ps", 0xf, 0, "txd1-skew-ps", 0xf, 4, "txd2-skew-ps", 0xf, 8, "txd3-skew-ps", 0xf, 12); } -#endif /* __rtems__ */ static int micphy_probe(device_t dev) @@ -258,18 +250,15 @@ static int micphy_attach(device_t dev) { struct mii_softc *sc; -#ifndef __rtems__ phandle_t node; device_t miibus; device_t parent; -#endif /* __rtems__ */ sc = device_get_softc(dev); mii_phy_dev_attach(dev, MIIF_NOMANPAUSE, &micphy_funcs, 1); mii_phy_setmedia(sc); -#ifndef __rtems__ miibus = device_get_parent(dev); parent = device_get_parent(miibus); @@ -280,16 +269,6 @@ micphy_attach(device_t dev) ksz9031_load_values(sc, node); else ksz9021_load_values(sc, node); -#else /* __rtems__ */ - /* FIXME */ - if (sc->mii_mpd_model == MII_MODEL_MICREL_KSZ9031) { - BSD_ASSERT(0); - } else { - ksz9021_write(sc, MII_KSZPHY_CLK_CONTROL_PAD_SKEW, 0xf0f0); - ksz9021_write(sc, MII_KSZPHY_RX_DATA_PAD_SKEW, 0x0000); - ksz9021_write(sc, MII_KSZPHY_TX_DATA_PAD_SKEW, 0x0000); - } -#endif /* __rtems__ */ return (0); } diff --git a/freebsd/sys/dev/usb/controller/dwc_otg_fdt.c b/freebsd/sys/dev/usb/controller/dwc_otg_fdt.c new file mode 100644 index 00000000..d08d233c --- /dev/null +++ b/freebsd/sys/dev/usb/controller/dwc_otg_fdt.c @@ -0,0 +1,226 @@ +#include + +/*- + * Copyright (c) 2012 Hans Petter Selasky. All rights reserved. + * + * 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 +__FBSDID("$FreeBSD$"); + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include + +#include +#include + +#include +#include +#include +#include + +#include +#include + +#include +#include + +static device_probe_t dwc_otg_probe; + +static struct ofw_compat_data compat_data[] = { + { "synopsys,designware-hs-otg2", 1 }, + { "snps,dwc2", 1 }, + { NULL, 0 } +}; + +static int +dwc_otg_probe(device_t dev) +{ + + if (!ofw_bus_status_okay(dev)) + return (ENXIO); + + if (!ofw_bus_search_compatible(dev, compat_data)->ocd_data) + return (ENXIO); + + device_set_desc(dev, "DWC OTG 2.0 integrated USB controller"); + + return (BUS_PROBE_DEFAULT); +} + +int +dwc_otg_attach(device_t dev) +{ + struct dwc_otg_fdt_softc *sc = device_get_softc(dev); + char usb_mode[24]; + int err; + int rid; + + /* initialise some bus fields */ + sc->sc_otg.sc_bus.parent = dev; + sc->sc_otg.sc_bus.devices = sc->sc_otg.sc_devices; + sc->sc_otg.sc_bus.devices_max = DWC_OTG_MAX_DEVICES; + sc->sc_otg.sc_bus.dma_bits = 32; + + /* get USB mode, if any */ + if (OF_getprop(ofw_bus_get_node(dev), "dr_mode", + &usb_mode, sizeof(usb_mode)) > 0) { + + /* ensure proper zero termination */ + usb_mode[sizeof(usb_mode) - 1] = 0; + + if (strcasecmp(usb_mode, "host") == 0) + sc->sc_otg.sc_mode = DWC_MODE_HOST; + else if (strcasecmp(usb_mode, "peripheral") == 0) + sc->sc_otg.sc_mode = DWC_MODE_DEVICE; + else if (strcasecmp(usb_mode, "otg") != 0) { + device_printf(dev, "Invalid FDT dr_mode: %s\n", + usb_mode); + } + } + + /* get all DMA memory */ + if (usb_bus_mem_alloc_all(&sc->sc_otg.sc_bus, + USB_GET_DMA_TAG(dev), NULL)) { + return (ENOMEM); + } + rid = 0; + sc->sc_otg.sc_io_res = + bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, RF_ACTIVE); + + if (!(sc->sc_otg.sc_io_res)) { + err = ENOMEM; + goto error; + } + sc->sc_otg.sc_io_tag = rman_get_bustag(sc->sc_otg.sc_io_res); + sc->sc_otg.sc_io_hdl = rman_get_bushandle(sc->sc_otg.sc_io_res); + sc->sc_otg.sc_io_size = rman_get_size(sc->sc_otg.sc_io_res); + + + /* + * brcm,bcm2708-usb FDT provides two interrupts, + * we need only second one (VC_USB) + */ + rid = ofw_bus_is_compatible(dev, "brcm,bcm2708-usb") ? 1 : 0; + sc->sc_otg.sc_irq_res = + bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, RF_ACTIVE); + if (sc->sc_otg.sc_irq_res == NULL) + goto error; + + sc->sc_otg.sc_bus.bdev = device_add_child(dev, "usbus", -1); + if (sc->sc_otg.sc_bus.bdev == NULL) + goto error; + + device_set_ivars(sc->sc_otg.sc_bus.bdev, &sc->sc_otg.sc_bus); + + err = bus_setup_intr(dev, sc->sc_otg.sc_irq_res, INTR_TYPE_TTY | INTR_MPSAFE, + &dwc_otg_filter_interrupt, &dwc_otg_interrupt, sc, &sc->sc_otg.sc_intr_hdl); + if (err) { + sc->sc_otg.sc_intr_hdl = NULL; + goto error; + } + err = dwc_otg_init(&sc->sc_otg); + if (err == 0) { + err = device_probe_and_attach(sc->sc_otg.sc_bus.bdev); + } + if (err) + goto error; + + + return (0); + +error: + dwc_otg_detach(dev); + return (ENXIO); +} + +int +dwc_otg_detach(device_t dev) +{ + struct dwc_otg_fdt_softc *sc = device_get_softc(dev); + int err; + + /* during module unload there are lots of children leftover */ + device_delete_children(dev); + + if (sc->sc_otg.sc_irq_res && sc->sc_otg.sc_intr_hdl) { + /* + * only call dwc_otg_uninit() after dwc_otg_init() + */ + dwc_otg_uninit(&sc->sc_otg); + + err = bus_teardown_intr(dev, sc->sc_otg.sc_irq_res, + sc->sc_otg.sc_intr_hdl); + sc->sc_otg.sc_intr_hdl = NULL; + } + /* free IRQ channel, if any */ + if (sc->sc_otg.sc_irq_res) { + bus_release_resource(dev, SYS_RES_IRQ, 0, + sc->sc_otg.sc_irq_res); + sc->sc_otg.sc_irq_res = NULL; + } + /* free memory resource, if any */ + if (sc->sc_otg.sc_io_res) { + bus_release_resource(dev, SYS_RES_MEMORY, 0, + sc->sc_otg.sc_io_res); + sc->sc_otg.sc_io_res = NULL; + } + usb_bus_mem_free_all(&sc->sc_otg.sc_bus, NULL); + + return (0); +} + +static device_method_t dwc_otg_methods[] = { + /* Device interface */ + DEVMETHOD(device_probe, dwc_otg_probe), + DEVMETHOD(device_attach, dwc_otg_attach), + DEVMETHOD(device_detach, dwc_otg_detach), + DEVMETHOD(device_suspend, bus_generic_suspend), + DEVMETHOD(device_resume, bus_generic_resume), + DEVMETHOD(device_shutdown, bus_generic_shutdown), + + DEVMETHOD_END +}; + +driver_t dwc_otg_driver = { + .name = "dwcotg", + .methods = dwc_otg_methods, + .size = sizeof(struct dwc_otg_fdt_softc), +}; + +static devclass_t dwc_otg_devclass; + +DRIVER_MODULE(dwcotg, simplebus, dwc_otg_driver, dwc_otg_devclass, 0, 0); +MODULE_DEPEND(dwcotg, usb, 1, 1, 1); diff --git a/freebsd/sys/dev/usb/controller/dwc_otg_fdt.h b/freebsd/sys/dev/usb/controller/dwc_otg_fdt.h new file mode 100644 index 00000000..634b7960 --- /dev/null +++ b/freebsd/sys/dev/usb/controller/dwc_otg_fdt.h @@ -0,0 +1,40 @@ +/*- + * Copyright (c) 2012 Hans Petter Selasky. All rights reserved. + * + * 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$ + */ + +#ifndef _DWC_OTG_FDT_H_ +#define _DWC_OTG_FDT_H_ + +struct dwc_otg_fdt_softc { + struct dwc_otg_softc sc_otg; /* must be first */ +}; + +extern driver_t dwc_otg_driver; + +device_attach_t dwc_otg_attach; +device_attach_t dwc_otg_detach; + +#endif -- cgit v1.2.3