static int pxaohci_detach(device_t self, int flags) { struct pxaohci_softc *sc = device_private(self); int error; error = ohci_detach(&sc->sc, flags); if (error) return error; #if 0 if (sc->sc.sc_powerhook) { powerhook_disestablish(sc->sc.sc_powerhook); sc->sc.sc_powerhook = NULL; } #endif if (sc->sc_ih) { pxa2x0_intr_disestablish(sc->sc_ih); sc->sc_ih = NULL; } pxaohci_disable(sc); /* stop clock */ pxa2x0_clkman_config(CKEN_USBHC, 0); if (sc->sc.sc_size) { bus_space_unmap(sc->sc.iot, sc->sc.ioh, sc->sc.sc_size); sc->sc.sc_size = 0; } return 0; }
int pxaohci_detach(struct device *self, int flags) { struct pxaohci_softc *sc = (struct pxaohci_softc *)self; int rv; rv = ohci_detach(self, flags); if (rv) return (rv); if (sc->sc_ih != NULL) { pxa2x0_intr_disestablish(sc->sc_ih); sc->sc_ih = NULL; } pxaohci_disable(sc); /* stop clock */ pxa2x0_clkman_config(CKEN_USBHC, 0); if (sc->sc.sc_size) { bus_space_unmap(sc->sc.iot, sc->sc.ioh, sc->sc.sc_size); sc->sc.sc_size = 0; } return (0); }
static void pxaohci_attach(device_t parent, device_t self, void *aux) { struct pxaohci_softc *sc = device_private(self); struct pxaip_attach_args *pxa = aux; #ifdef USB_DEBUG { //extern int ohcidebug; //ohcidebug = 16; } #endif sc->sc.iot = pxa->pxa_iot; sc->sc.sc_bus.ub_dmatag = pxa->pxa_dmat; sc->sc.sc_size = 0; sc->sc_ih = NULL; sc->sc.sc_dev = self; sc->sc.sc_bus.ub_hcpriv = sc; aprint_normal("\n"); aprint_naive("\n"); /* Map I/O space */ if (bus_space_map(sc->sc.iot, pxa->pxa_addr, pxa->pxa_size, 0, &sc->sc.ioh)) { aprint_error_dev(sc->sc.sc_dev, "couldn't map memory space\n"); return; } sc->sc.sc_size = pxa->pxa_size; /* XXX copied from ohci_pci.c. needed? */ bus_space_barrier(sc->sc.iot, sc->sc.ioh, 0, sc->sc.sc_size, BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE); /* start the usb clock */ pxa2x0_clkman_config(CKEN_USBHC, 1); pxaohci_enable(sc); /* Disable interrupts, so we don't get any spurious ones. */ bus_space_write_4(sc->sc.iot, sc->sc.ioh, OHCI_INTERRUPT_DISABLE, OHCI_MIE); sc->sc_ih = pxa2x0_intr_establish(PXA2X0_INT_USBH1, IPL_USB, ohci_intr, &sc->sc); if (sc->sc_ih == NULL) { aprint_error_dev(sc->sc.sc_dev, "unable to establish interrupt\n"); goto free_map; } strlcpy(sc->sc.sc_vendor, "PXA27x", sizeof(sc->sc.sc_vendor)); int err = ohci_init(&sc->sc); if (err) { aprint_error_dev(sc->sc.sc_dev, "init failed, error=%d\n", err); goto free_intr; } #if 0 sc->sc.sc_powerhook = powerhook_establish(device_xname(sc->sc.sc_bus.bdev), pxaohci_power, sc); if (sc->sc.sc_powerhook == NULL) { aprint_error_dev(sc->sc.sc_dev->sc_bus.bdev, "cannot establish powerhook\n"); } #endif sc->sc.sc_child = config_found(self, &sc->sc.sc_bus, usbctlprint); return; free_intr: pxa2x0_intr_disestablish(sc->sc_ih); sc->sc_ih = NULL; free_map: pxaohci_disable(sc); pxa2x0_clkman_config(CKEN_USBHC, 0); bus_space_unmap(sc->sc.iot, sc->sc.ioh, sc->sc.sc_size); sc->sc.sc_size = 0; }
void pxaohci_attach(struct device *parent, struct device *self, void *aux) { struct pxaohci_softc *sc = (struct pxaohci_softc *)self; struct pxaip_attach_args *pxa = aux; usbd_status r; sc->sc.iot = pxa->pxa_iot; sc->sc.sc_bus.dmatag = pxa->pxa_dmat; sc->sc_ih = NULL; sc->sc.sc_size = 0; /* Map I/O space */ if (bus_space_map(sc->sc.iot, PXA2X0_USBHC_BASE, PXA2X0_USBHC_SIZE, 0, &sc->sc.ioh)) { printf(": cannot map mem space\n"); return; } sc->sc.sc_size = PXA2X0_USBHC_SIZE; /* XXX copied from ohci_pci.c. needed? */ bus_space_barrier(sc->sc.iot, sc->sc.ioh, 0, sc->sc.sc_size, BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE); /* start the usb clock */ pxa2x0_clkman_config(CKEN_USBHC, 1); pxaohci_enable(sc); /* Disable interrupts, so we don't get any spurious ones. */ bus_space_write_4(sc->sc.iot, sc->sc.ioh, OHCI_INTERRUPT_DISABLE, OHCI_MIE); sc->sc_ih = pxa2x0_intr_establish(PXA2X0_INT_USBH1, IPL_USB, ohci_intr, &sc->sc, sc->sc.sc_bus.bdev.dv_xname); if (sc->sc_ih == NULL) { printf(": unable to establish interrupt\n"); pxaohci_disable(sc); pxa2x0_clkman_config(CKEN_USBHC, 0); bus_space_unmap(sc->sc.iot, sc->sc.ioh, sc->sc.sc_size); sc->sc.sc_size = 0; return; } strlcpy(sc->sc.sc_vendor, "PXA27x", sizeof(sc->sc.sc_vendor)); if (ohci_checkrev(&sc->sc) != USBD_NORMAL_COMPLETION) goto unsupported; r = ohci_init(&sc->sc); if (r != USBD_NORMAL_COMPLETION) { printf("%s: init failed, error=%d\n", sc->sc.sc_bus.bdev.dv_xname, r); unsupported: pxa2x0_intr_disestablish(sc->sc_ih); sc->sc_ih = NULL; pxaohci_disable(sc); pxa2x0_clkman_config(CKEN_USBHC, 0); bus_space_unmap(sc->sc.iot, sc->sc.ioh, sc->sc.sc_size); sc->sc.sc_size = 0; return; } config_found(self, &sc->sc.sc_bus, usbctlprint); }