mirror of
https://git.rtems.org/rtems-libbsd/
synced 2025-10-14 07:15:58 +08:00
@@ -69,12 +69,8 @@ __FBSDID("$FreeBSD$");
|
||||
#include <dev/dwc/if_dwcvar.h>
|
||||
#include <dev/mii/mii.h>
|
||||
#include <dev/mii/miivar.h>
|
||||
#ifndef __rtems__
|
||||
#include <dev/ofw/ofw_bus.h>
|
||||
#include <dev/ofw/ofw_bus_subr.h>
|
||||
#else /* __rtems__ */
|
||||
#include <rtems/bsd/bsd.h>
|
||||
#endif /* __rtems__ */
|
||||
|
||||
#ifdef EXT_RESOURCES
|
||||
#include <dev/extres/clk/clk.h>
|
||||
@@ -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);
|
||||
|
@@ -57,12 +57,10 @@ __FBSDID("$FreeBSD$");
|
||||
|
||||
#include <rtems/bsd/local/miibus_if.h>
|
||||
|
||||
#ifndef __rtems__
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ofw/openfirm.h>
|
||||
#include <dev/ofw/ofw_bus.h>
|
||||
#include <dev/ofw/ofw_bus_subr.h>
|
||||
#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);
|
||||
}
|
||||
|
226
freebsd/sys/dev/usb/controller/dwc_otg_fdt.c
Normal file
226
freebsd/sys/dev/usb/controller/dwc_otg_fdt.c
Normal file
@@ -0,0 +1,226 @@
|
||||
#include <machine/rtems-bsd-kernel-space.h>
|
||||
|
||||
/*-
|
||||
* 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 <sys/cdefs.h>
|
||||
__FBSDID("$FreeBSD$");
|
||||
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/bus.h>
|
||||
#include <sys/condvar.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/module.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/rman.h>
|
||||
|
||||
#include <dev/ofw/openfirm.h>
|
||||
#include <dev/ofw/ofw_bus.h>
|
||||
#include <dev/ofw/ofw_bus_subr.h>
|
||||
|
||||
#include <dev/usb/usb.h>
|
||||
#include <dev/usb/usbdi.h>
|
||||
|
||||
#include <dev/usb/usb_core.h>
|
||||
#include <dev/usb/usb_busdma.h>
|
||||
#include <dev/usb/usb_process.h>
|
||||
#include <dev/usb/usb_util.h>
|
||||
|
||||
#include <dev/usb/usb_controller.h>
|
||||
#include <dev/usb/usb_bus.h>
|
||||
|
||||
#include <dev/usb/controller/dwc_otg.h>
|
||||
#include <dev/usb/controller/dwc_otg_fdt.h>
|
||||
|
||||
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);
|
40
freebsd/sys/dev/usb/controller/dwc_otg_fdt.h
Normal file
40
freebsd/sys/dev/usb/controller/dwc_otg_fdt.h
Normal file
@@ -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
|
Reference in New Issue
Block a user