1c49504beSRafal Jaworowski /*- 2*718cf2ccSPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3*718cf2ccSPedro F. Giffuni * 4c49504beSRafal Jaworowski * Copyright (c) 2010-2012 Semihalf 5c49504beSRafal Jaworowski * All rights reserved. 6c49504beSRafal Jaworowski * 7c49504beSRafal Jaworowski * Redistribution and use in source and binary forms, with or without 8c49504beSRafal Jaworowski * modification, are permitted provided that the following conditions 9c49504beSRafal Jaworowski * are met: 10c49504beSRafal Jaworowski * 1. Redistributions of source code must retain the above copyright 11c49504beSRafal Jaworowski * notice, this list of conditions and the following disclaimer. 12c49504beSRafal Jaworowski * 2. Redistributions in binary form must reproduce the above copyright 13c49504beSRafal Jaworowski * notice, this list of conditions and the following disclaimer in the 14c49504beSRafal Jaworowski * documentation and/or other materials provided with the distribution. 15c49504beSRafal Jaworowski * 16c49504beSRafal Jaworowski * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17c49504beSRafal Jaworowski * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18c49504beSRafal Jaworowski * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19c49504beSRafal Jaworowski * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20c49504beSRafal Jaworowski * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21c49504beSRafal Jaworowski * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22c49504beSRafal Jaworowski * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23c49504beSRafal Jaworowski * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24c49504beSRafal Jaworowski * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25c49504beSRafal Jaworowski * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26c49504beSRafal Jaworowski * SUCH DAMAGE. 27c49504beSRafal Jaworowski */ 28c49504beSRafal Jaworowski 29c49504beSRafal Jaworowski #include <sys/cdefs.h> 30c49504beSRafal Jaworowski __FBSDID("$FreeBSD$"); 31c49504beSRafal Jaworowski 32c49504beSRafal Jaworowski #include "opt_bus.h" 33c49504beSRafal Jaworowski 34c49504beSRafal Jaworowski #include <sys/param.h> 35c49504beSRafal Jaworowski #include <sys/systm.h> 36c49504beSRafal Jaworowski #include <sys/kernel.h> 37c49504beSRafal Jaworowski #include <sys/module.h> 38c49504beSRafal Jaworowski #include <sys/bus.h> 39c49504beSRafal Jaworowski #include <sys/queue.h> 40c49504beSRafal Jaworowski #include <sys/lock.h> 41c49504beSRafal Jaworowski #include <sys/lockmgr.h> 42c49504beSRafal Jaworowski #include <sys/condvar.h> 43c49504beSRafal Jaworowski #include <sys/rman.h> 44c49504beSRafal Jaworowski 45c49504beSRafal Jaworowski #include <dev/ofw/ofw_bus.h> 46c49504beSRafal Jaworowski #include <dev/ofw/ofw_bus_subr.h> 47c49504beSRafal Jaworowski 48c49504beSRafal Jaworowski #include <dev/usb/usb.h> 49c49504beSRafal Jaworowski #include <dev/usb/usbdi.h> 50c49504beSRafal Jaworowski #include <dev/usb/usb_core.h> 51c49504beSRafal Jaworowski #include <dev/usb/usb_busdma.h> 52c49504beSRafal Jaworowski #include <dev/usb/usb_process.h> 53c49504beSRafal Jaworowski #include <dev/usb/usb_util.h> 54c49504beSRafal Jaworowski #include <dev/usb/usb_controller.h> 55c49504beSRafal Jaworowski #include <dev/usb/usb_bus.h> 56c49504beSRafal Jaworowski #include <dev/usb/controller/ehci.h> 57c49504beSRafal Jaworowski #include <dev/usb/controller/ehcireg.h> 58c49504beSRafal Jaworowski 59c49504beSRafal Jaworowski #include <machine/bus.h> 60c49504beSRafal Jaworowski #include <machine/clock.h> 61c49504beSRafal Jaworowski #include <machine/resource.h> 62c49504beSRafal Jaworowski 63c49504beSRafal Jaworowski #include <powerpc/include/tlb.h> 64c49504beSRafal Jaworowski 65c49504beSRafal Jaworowski #include "opt_platform.h" 66c49504beSRafal Jaworowski 67c49504beSRafal Jaworowski /* 68c49504beSRafal Jaworowski * Register the driver 69c49504beSRafal Jaworowski */ 70c49504beSRafal Jaworowski /* Forward declarations */ 71c49504beSRafal Jaworowski static int fsl_ehci_attach(device_t self); 72c49504beSRafal Jaworowski static int fsl_ehci_detach(device_t self); 73c49504beSRafal Jaworowski static int fsl_ehci_probe(device_t self); 74c49504beSRafal Jaworowski 75c49504beSRafal Jaworowski static device_method_t ehci_methods[] = { 76c49504beSRafal Jaworowski /* Device interface */ 77c49504beSRafal Jaworowski DEVMETHOD(device_probe, fsl_ehci_probe), 78c49504beSRafal Jaworowski DEVMETHOD(device_attach, fsl_ehci_attach), 79c49504beSRafal Jaworowski DEVMETHOD(device_detach, fsl_ehci_detach), 80c49504beSRafal Jaworowski DEVMETHOD(device_suspend, bus_generic_suspend), 81c49504beSRafal Jaworowski DEVMETHOD(device_resume, bus_generic_resume), 82c49504beSRafal Jaworowski DEVMETHOD(device_shutdown, bus_generic_shutdown), 83c49504beSRafal Jaworowski 84c49504beSRafal Jaworowski /* Bus interface */ 85c49504beSRafal Jaworowski DEVMETHOD(bus_print_child, bus_generic_print_child), 86c49504beSRafal Jaworowski 87c49504beSRafal Jaworowski { 0, 0 } 88c49504beSRafal Jaworowski }; 89c49504beSRafal Jaworowski 90c49504beSRafal Jaworowski /* kobj_class definition */ 91c49504beSRafal Jaworowski static driver_t ehci_driver = { 92c49504beSRafal Jaworowski "ehci", 93c49504beSRafal Jaworowski ehci_methods, 94c49504beSRafal Jaworowski sizeof(struct ehci_softc) 95c49504beSRafal Jaworowski }; 96c49504beSRafal Jaworowski 97c49504beSRafal Jaworowski static devclass_t ehci_devclass; 98c49504beSRafal Jaworowski 99c49504beSRafal Jaworowski DRIVER_MODULE(ehci, simplebus, ehci_driver, ehci_devclass, 0, 0); 100c49504beSRafal Jaworowski MODULE_DEPEND(ehci, usb, 1, 1, 1); 101c49504beSRafal Jaworowski 102c49504beSRafal Jaworowski /* 103c49504beSRafal Jaworowski * Private defines 104c49504beSRafal Jaworowski */ 105c49504beSRafal Jaworowski #define FSL_EHCI_REG_OFF 0x100 106c49504beSRafal Jaworowski #define FSL_EHCI_REG_SIZE 0x300 107c49504beSRafal Jaworowski 108c49504beSRafal Jaworowski /* 109c49504beSRafal Jaworowski * Internal interface registers' offsets. 110c49504beSRafal Jaworowski * Offsets from 0x000 ehci dev space, big-endian access. 111c49504beSRafal Jaworowski */ 112c49504beSRafal Jaworowski enum internal_reg { 113c49504beSRafal Jaworowski SNOOP1 = 0x400, 114c49504beSRafal Jaworowski SNOOP2 = 0x404, 115c49504beSRafal Jaworowski AGE_CNT_THRESH = 0x408, 116c49504beSRafal Jaworowski SI_CTRL = 0x410, 117c49504beSRafal Jaworowski CONTROL = 0x500 118c49504beSRafal Jaworowski }; 119c49504beSRafal Jaworowski 120c49504beSRafal Jaworowski /* CONTROL register bit flags */ 121c49504beSRafal Jaworowski enum control_flags { 122c49504beSRafal Jaworowski USB_EN = 0x00000004, 123c49504beSRafal Jaworowski UTMI_PHY_EN = 0x00000200, 124c49504beSRafal Jaworowski ULPI_INT_EN = 0x00000001 125c49504beSRafal Jaworowski }; 126c49504beSRafal Jaworowski 127c49504beSRafal Jaworowski /* SI_CTRL register bit flags */ 128c49504beSRafal Jaworowski enum si_ctrl_flags { 129c49504beSRafal Jaworowski FETCH_32 = 1, 130c49504beSRafal Jaworowski FETCH_64 = 0 131c49504beSRafal Jaworowski }; 132c49504beSRafal Jaworowski 133c49504beSRafal Jaworowski #define SNOOP_RANGE_2GB 0x1E 134c49504beSRafal Jaworowski 135c49504beSRafal Jaworowski /* 136c49504beSRafal Jaworowski * Operational registers' offsets. 137c49504beSRafal Jaworowski * Offsets from USBCMD register, little-endian access. 138c49504beSRafal Jaworowski */ 139c49504beSRafal Jaworowski enum special_op_reg { 140c49504beSRafal Jaworowski USBMODE = 0x0A8, 141c49504beSRafal Jaworowski PORTSC = 0x084, 142c49504beSRafal Jaworowski ULPI_VIEWPORT = 0x70 143c49504beSRafal Jaworowski }; 144c49504beSRafal Jaworowski 145c49504beSRafal Jaworowski /* USBMODE register bit flags */ 146c49504beSRafal Jaworowski enum usbmode_flags { 147c49504beSRafal Jaworowski HOST_MODE = 0x3, 148c49504beSRafal Jaworowski DEVICE_MODE = 0x2 149c49504beSRafal Jaworowski }; 150c49504beSRafal Jaworowski 151c49504beSRafal Jaworowski #define PORT_POWER_MASK 0x00001000 152c49504beSRafal Jaworowski 153c49504beSRafal Jaworowski /* 154c49504beSRafal Jaworowski * Private methods 155c49504beSRafal Jaworowski */ 156c49504beSRafal Jaworowski 157c49504beSRafal Jaworowski static void 158c49504beSRafal Jaworowski set_to_host_mode(ehci_softc_t *sc) 159c49504beSRafal Jaworowski { 160c49504beSRafal Jaworowski int tmp; 161c49504beSRafal Jaworowski 162c49504beSRafal Jaworowski tmp = bus_space_read_4(sc->sc_io_tag, sc->sc_io_hdl, USBMODE); 163c49504beSRafal Jaworowski bus_space_write_4(sc->sc_io_tag, sc->sc_io_hdl, USBMODE, tmp | HOST_MODE); 164c49504beSRafal Jaworowski } 165c49504beSRafal Jaworowski 166c49504beSRafal Jaworowski static void 167c49504beSRafal Jaworowski enable_usb(device_t dev, bus_space_tag_t iot, bus_space_handle_t ioh) 168c49504beSRafal Jaworowski { 169c49504beSRafal Jaworowski int tmp; 170c49504beSRafal Jaworowski phandle_t node; 171c49504beSRafal Jaworowski char *phy_type; 172c49504beSRafal Jaworowski 173c49504beSRafal Jaworowski phy_type = NULL; 174c49504beSRafal Jaworowski tmp = bus_space_read_4(iot, ioh, CONTROL) | USB_EN; 175c49504beSRafal Jaworowski 176c49504beSRafal Jaworowski node = ofw_bus_get_node(dev); 177c49504beSRafal Jaworowski if ((node != 0) && 178c49504beSRafal Jaworowski (OF_getprop_alloc(node, "phy_type", 1, (void **)&phy_type) > 0)) { 179c49504beSRafal Jaworowski if (strncasecmp(phy_type, "utmi", strlen("utmi")) == 0) 180c49504beSRafal Jaworowski tmp |= UTMI_PHY_EN; 18127b917c8SOleksandr Tymoshenko OF_prop_free(phy_type); 182c49504beSRafal Jaworowski } 183c49504beSRafal Jaworowski bus_space_write_4(iot, ioh, CONTROL, tmp); 184c49504beSRafal Jaworowski } 185c49504beSRafal Jaworowski 186c49504beSRafal Jaworowski static void 187c49504beSRafal Jaworowski set_32b_prefetch(bus_space_tag_t iot, bus_space_handle_t ioh) 188c49504beSRafal Jaworowski { 189c49504beSRafal Jaworowski 190c49504beSRafal Jaworowski bus_space_write_4(iot, ioh, SI_CTRL, FETCH_32); 191c49504beSRafal Jaworowski } 192c49504beSRafal Jaworowski 193c49504beSRafal Jaworowski static void 194c49504beSRafal Jaworowski set_snooping(bus_space_tag_t iot, bus_space_handle_t ioh) 195c49504beSRafal Jaworowski { 196c49504beSRafal Jaworowski 197c49504beSRafal Jaworowski bus_space_write_4(iot, ioh, SNOOP1, SNOOP_RANGE_2GB); 198c49504beSRafal Jaworowski bus_space_write_4(iot, ioh, SNOOP2, 0x80000000 | SNOOP_RANGE_2GB); 199c49504beSRafal Jaworowski } 200c49504beSRafal Jaworowski 201c49504beSRafal Jaworowski static void 202c49504beSRafal Jaworowski clear_port_power(ehci_softc_t *sc) 203c49504beSRafal Jaworowski { 204c49504beSRafal Jaworowski int tmp; 205c49504beSRafal Jaworowski 206c49504beSRafal Jaworowski tmp = bus_space_read_4(sc->sc_io_tag, sc->sc_io_hdl, PORTSC); 207c49504beSRafal Jaworowski bus_space_write_4(sc->sc_io_tag, sc->sc_io_hdl, PORTSC, tmp & ~PORT_POWER_MASK); 208c49504beSRafal Jaworowski } 209c49504beSRafal Jaworowski 210c49504beSRafal Jaworowski /* 211c49504beSRafal Jaworowski * Public methods 212c49504beSRafal Jaworowski */ 213c49504beSRafal Jaworowski static int 214c49504beSRafal Jaworowski fsl_ehci_probe(device_t dev) 215c49504beSRafal Jaworowski { 216c49504beSRafal Jaworowski 217add35ed5SIan Lepore if (!ofw_bus_status_okay(dev)) 218add35ed5SIan Lepore return (ENXIO); 219add35ed5SIan Lepore 220c49504beSRafal Jaworowski if (((ofw_bus_is_compatible(dev, "fsl-usb2-dr")) == 0) && 221c49504beSRafal Jaworowski ((ofw_bus_is_compatible(dev, "fsl-usb2-mph")) == 0)) 222c49504beSRafal Jaworowski return (ENXIO); 223c49504beSRafal Jaworowski 224c49504beSRafal Jaworowski device_set_desc(dev, "Freescale integrated EHCI controller"); 225c49504beSRafal Jaworowski 226c49504beSRafal Jaworowski return (BUS_PROBE_DEFAULT); 227c49504beSRafal Jaworowski } 228c49504beSRafal Jaworowski 229c49504beSRafal Jaworowski static int 230c49504beSRafal Jaworowski fsl_ehci_attach(device_t self) 231c49504beSRafal Jaworowski { 232c49504beSRafal Jaworowski ehci_softc_t *sc; 233c49504beSRafal Jaworowski int rid; 234c49504beSRafal Jaworowski int err; 235c49504beSRafal Jaworowski bus_space_handle_t ioh; 236c49504beSRafal Jaworowski bus_space_tag_t iot; 237c49504beSRafal Jaworowski 238c49504beSRafal Jaworowski sc = device_get_softc(self); 239c49504beSRafal Jaworowski rid = 0; 240c49504beSRafal Jaworowski 241c49504beSRafal Jaworowski sc->sc_bus.parent = self; 242c49504beSRafal Jaworowski sc->sc_bus.devices = sc->sc_devices; 243c49504beSRafal Jaworowski sc->sc_bus.devices_max = EHCI_MAX_DEVICES; 244b217d184SHans Petter Selasky sc->sc_bus.dma_bits = 32; 245c49504beSRafal Jaworowski 246c49504beSRafal Jaworowski if (usb_bus_mem_alloc_all(&sc->sc_bus, 247c49504beSRafal Jaworowski USB_GET_DMA_TAG(self), &ehci_iterate_hw_softc)) 248c49504beSRafal Jaworowski return (ENOMEM); 249c49504beSRafal Jaworowski 250c49504beSRafal Jaworowski /* Allocate io resource for EHCI */ 251c49504beSRafal Jaworowski sc->sc_io_res = bus_alloc_resource_any(self, SYS_RES_MEMORY, &rid, 252c49504beSRafal Jaworowski RF_ACTIVE); 253c49504beSRafal Jaworowski if (sc->sc_io_res == NULL) { 254c49504beSRafal Jaworowski err = fsl_ehci_detach(self); 255c49504beSRafal Jaworowski if (err) { 256c49504beSRafal Jaworowski device_printf(self, 257c49504beSRafal Jaworowski "Detach of the driver failed with error %d\n", 258c49504beSRafal Jaworowski err); 259c49504beSRafal Jaworowski } 260c49504beSRafal Jaworowski return (ENXIO); 261c49504beSRafal Jaworowski } 262c49504beSRafal Jaworowski iot = rman_get_bustag(sc->sc_io_res); 263c49504beSRafal Jaworowski 264c49504beSRafal Jaworowski /* 265c49504beSRafal Jaworowski * Set handle to USB related registers subregion used by generic 266c49504beSRafal Jaworowski * EHCI driver 267c49504beSRafal Jaworowski */ 268c49504beSRafal Jaworowski ioh = rman_get_bushandle(sc->sc_io_res); 269c49504beSRafal Jaworowski 270c49504beSRafal Jaworowski err = bus_space_subregion(iot, ioh, FSL_EHCI_REG_OFF, FSL_EHCI_REG_SIZE, 271c49504beSRafal Jaworowski &sc->sc_io_hdl); 272c49504beSRafal Jaworowski if (err != 0) { 273c49504beSRafal Jaworowski err = fsl_ehci_detach(self); 274c49504beSRafal Jaworowski if (err) { 275c49504beSRafal Jaworowski device_printf(self, 276c49504beSRafal Jaworowski "Detach of the driver failed with error %d\n", 277c49504beSRafal Jaworowski err); 278c49504beSRafal Jaworowski } 279c49504beSRafal Jaworowski return (ENXIO); 280c49504beSRafal Jaworowski } 281c49504beSRafal Jaworowski 282c49504beSRafal Jaworowski /* Set little-endian tag for use by the generic EHCI driver */ 283c49504beSRafal Jaworowski sc->sc_io_tag = &bs_le_tag; 284c49504beSRafal Jaworowski 285c49504beSRafal Jaworowski /* Allocate irq */ 286c49504beSRafal Jaworowski sc->sc_irq_res = bus_alloc_resource_any(self, SYS_RES_IRQ, &rid, 287c49504beSRafal Jaworowski RF_ACTIVE); 288c49504beSRafal Jaworowski if (sc->sc_irq_res == NULL) { 289c49504beSRafal Jaworowski err = fsl_ehci_detach(self); 290c49504beSRafal Jaworowski if (err) { 291c49504beSRafal Jaworowski device_printf(self, 292c49504beSRafal Jaworowski "Detach of the driver failed with error %d\n", 293c49504beSRafal Jaworowski err); 294c49504beSRafal Jaworowski } 295c49504beSRafal Jaworowski return (ENXIO); 296c49504beSRafal Jaworowski } 297c49504beSRafal Jaworowski 298c49504beSRafal Jaworowski /* Setup interrupt handler */ 299c520cb4fSMichal Meloun err = bus_setup_intr(self, sc->sc_irq_res, INTR_TYPE_BIO | INTR_MPSAFE, 300c49504beSRafal Jaworowski NULL, (driver_intr_t *)ehci_interrupt, sc, &sc->sc_intr_hdl); 301c49504beSRafal Jaworowski if (err) { 302c49504beSRafal Jaworowski device_printf(self, "Could not setup irq, %d\n", err); 303c49504beSRafal Jaworowski sc->sc_intr_hdl = NULL; 304c49504beSRafal Jaworowski err = fsl_ehci_detach(self); 305c49504beSRafal Jaworowski if (err) { 306c49504beSRafal Jaworowski device_printf(self, 307c49504beSRafal Jaworowski "Detach of the driver failed with error %d\n", 308c49504beSRafal Jaworowski err); 309c49504beSRafal Jaworowski } 310c49504beSRafal Jaworowski return (ENXIO); 311c49504beSRafal Jaworowski } 312c49504beSRafal Jaworowski 313c49504beSRafal Jaworowski /* Add USB device */ 314c49504beSRafal Jaworowski sc->sc_bus.bdev = device_add_child(self, "usbus", -1); 315c49504beSRafal Jaworowski if (!sc->sc_bus.bdev) { 316c49504beSRafal Jaworowski device_printf(self, "Could not add USB device\n"); 317c49504beSRafal Jaworowski err = fsl_ehci_detach(self); 318c49504beSRafal Jaworowski if (err) { 319c49504beSRafal Jaworowski device_printf(self, 320c49504beSRafal Jaworowski "Detach of the driver failed with error %d\n", 321c49504beSRafal Jaworowski err); 322c49504beSRafal Jaworowski } 323c49504beSRafal Jaworowski return (ENOMEM); 324c49504beSRafal Jaworowski } 325c49504beSRafal Jaworowski device_set_ivars(sc->sc_bus.bdev, &sc->sc_bus); 326c49504beSRafal Jaworowski 327c49504beSRafal Jaworowski sc->sc_id_vendor = 0x1234; 328c49504beSRafal Jaworowski strlcpy(sc->sc_vendor, "Freescale", sizeof(sc->sc_vendor)); 329c49504beSRafal Jaworowski 330c49504beSRafal Jaworowski /* Enable USB */ 331c49504beSRafal Jaworowski err = ehci_reset(sc); 332c49504beSRafal Jaworowski if (err) { 333c49504beSRafal Jaworowski device_printf(self, "Could not reset the controller\n"); 334c49504beSRafal Jaworowski err = fsl_ehci_detach(self); 335c49504beSRafal Jaworowski if (err) { 336c49504beSRafal Jaworowski device_printf(self, 337c49504beSRafal Jaworowski "Detach of the driver failed with error %d\n", 338c49504beSRafal Jaworowski err); 339c49504beSRafal Jaworowski } 340c49504beSRafal Jaworowski return (ENXIO); 341c49504beSRafal Jaworowski } 342c49504beSRafal Jaworowski 343c49504beSRafal Jaworowski enable_usb(self, iot, ioh); 344c49504beSRafal Jaworowski set_snooping(iot, ioh); 345c49504beSRafal Jaworowski set_to_host_mode(sc); 346c49504beSRafal Jaworowski set_32b_prefetch(iot, ioh); 347c49504beSRafal Jaworowski 348c49504beSRafal Jaworowski /* 349c49504beSRafal Jaworowski * If usb subsystem is enabled in U-Boot, port power has to be turned 350c49504beSRafal Jaworowski * off to allow proper discovery of devices during boot up. 351c49504beSRafal Jaworowski */ 352c49504beSRafal Jaworowski clear_port_power(sc); 353c49504beSRafal Jaworowski 354c49504beSRafal Jaworowski /* Set flags */ 355c49504beSRafal Jaworowski sc->sc_flags |= EHCI_SCFLG_DONTRESET | EHCI_SCFLG_NORESTERM; 356c49504beSRafal Jaworowski 357c49504beSRafal Jaworowski err = ehci_init(sc); 358c49504beSRafal Jaworowski if (!err) { 359c49504beSRafal Jaworowski sc->sc_flags |= EHCI_SCFLG_DONEINIT; 360c49504beSRafal Jaworowski err = device_probe_and_attach(sc->sc_bus.bdev); 361c49504beSRafal Jaworowski } 362c49504beSRafal Jaworowski 363c49504beSRafal Jaworowski if (err) { 364c49504beSRafal Jaworowski device_printf(self, "USB init failed err=%d\n", err); 365c49504beSRafal Jaworowski err = fsl_ehci_detach(self); 366c49504beSRafal Jaworowski if (err) { 367c49504beSRafal Jaworowski device_printf(self, 368c49504beSRafal Jaworowski "Detach of the driver failed with error %d\n", 369c49504beSRafal Jaworowski err); 370c49504beSRafal Jaworowski } 371c49504beSRafal Jaworowski return (EIO); 372c49504beSRafal Jaworowski } 373c49504beSRafal Jaworowski 374c49504beSRafal Jaworowski return (0); 375c49504beSRafal Jaworowski } 376c49504beSRafal Jaworowski 377c49504beSRafal Jaworowski static int 378c49504beSRafal Jaworowski fsl_ehci_detach(device_t self) 379c49504beSRafal Jaworowski { 380c49504beSRafal Jaworowski 381c49504beSRafal Jaworowski int err; 382c49504beSRafal Jaworowski ehci_softc_t *sc; 383c49504beSRafal Jaworowski 384c49504beSRafal Jaworowski sc = device_get_softc(self); 385c49504beSRafal Jaworowski /* 386c49504beSRafal Jaworowski * only call ehci_detach() after ehci_init() 387c49504beSRafal Jaworowski */ 388c49504beSRafal Jaworowski if (sc->sc_flags & EHCI_SCFLG_DONEINIT) { 389c49504beSRafal Jaworowski ehci_detach(sc); 390c49504beSRafal Jaworowski sc->sc_flags &= ~EHCI_SCFLG_DONEINIT; 391c49504beSRafal Jaworowski } 392c49504beSRafal Jaworowski 393c49504beSRafal Jaworowski /* Disable interrupts that might have been switched on in ehci_init */ 394c49504beSRafal Jaworowski if (sc->sc_io_tag && sc->sc_io_hdl) 395c49504beSRafal Jaworowski bus_space_write_4(sc->sc_io_tag, sc->sc_io_hdl, EHCI_USBINTR, 0); 396c49504beSRafal Jaworowski 397c49504beSRafal Jaworowski if (sc->sc_irq_res && sc->sc_intr_hdl) { 398c49504beSRafal Jaworowski err = bus_teardown_intr(self, sc->sc_irq_res, sc->sc_intr_hdl); 399c49504beSRafal Jaworowski if (err) { 400c49504beSRafal Jaworowski device_printf(self, "Could not tear down irq, %d\n", 401c49504beSRafal Jaworowski err); 402c49504beSRafal Jaworowski return (err); 403c49504beSRafal Jaworowski } 404c49504beSRafal Jaworowski sc->sc_intr_hdl = NULL; 405c49504beSRafal Jaworowski } 406c49504beSRafal Jaworowski 407c49504beSRafal Jaworowski if (sc->sc_bus.bdev) { 408c49504beSRafal Jaworowski device_delete_child(self, sc->sc_bus.bdev); 409c49504beSRafal Jaworowski sc->sc_bus.bdev = NULL; 410c49504beSRafal Jaworowski } 411c49504beSRafal Jaworowski 412c49504beSRafal Jaworowski /* During module unload there are lots of children leftover */ 413c49504beSRafal Jaworowski device_delete_children(self); 414c49504beSRafal Jaworowski 415c49504beSRafal Jaworowski if (sc->sc_irq_res) { 416c49504beSRafal Jaworowski bus_release_resource(self, SYS_RES_IRQ, 0, sc->sc_irq_res); 417c49504beSRafal Jaworowski sc->sc_irq_res = NULL; 418c49504beSRafal Jaworowski } 419c49504beSRafal Jaworowski 420c49504beSRafal Jaworowski if (sc->sc_io_res) { 421c49504beSRafal Jaworowski bus_release_resource(self, SYS_RES_MEMORY, 0, sc->sc_io_res); 422c49504beSRafal Jaworowski sc->sc_io_res = NULL; 423c49504beSRafal Jaworowski sc->sc_io_tag = 0; 424c49504beSRafal Jaworowski sc->sc_io_hdl = 0; 425c49504beSRafal Jaworowski } 426c49504beSRafal Jaworowski 427c49504beSRafal Jaworowski return (0); 428c49504beSRafal Jaworowski } 429c49504beSRafal Jaworowski 430