forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
336 lines
8.6 KiB
336 lines
8.6 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* Freescale QUICC Engine USB Host Controller Driver |
|
* |
|
* Copyright (c) Freescale Semicondutor, Inc. 2006. |
|
* Shlomi Gridish <[email protected]> |
|
* Jerry Huang <[email protected]> |
|
* Copyright (c) Logic Product Development, Inc. 2007 |
|
* Peter Barada <[email protected]> |
|
* Copyright (c) MontaVista Software, Inc. 2008. |
|
* Anton Vorontsov <[email protected]> |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/types.h> |
|
#include <linux/spinlock.h> |
|
#include <linux/delay.h> |
|
#include <linux/errno.h> |
|
#include <linux/io.h> |
|
#include <linux/usb.h> |
|
#include <linux/usb/hcd.h> |
|
#include <linux/gpio.h> |
|
#include <soc/fsl/qe/qe.h> |
|
#include "fhci.h" |
|
|
|
/* virtual root hub specific descriptor */ |
|
static u8 root_hub_des[] = { |
|
0x09, /* blength */ |
|
USB_DT_HUB, /* bDescriptorType;hub-descriptor */ |
|
0x01, /* bNbrPorts */ |
|
HUB_CHAR_INDV_PORT_LPSM | HUB_CHAR_NO_OCPM, /* wHubCharacteristics */ |
|
0x00, /* per-port power, no overcurrent */ |
|
0x01, /* bPwrOn2pwrGood;2ms */ |
|
0x00, /* bHubContrCurrent;0mA */ |
|
0x00, /* DeviceRemoveable */ |
|
0xff, /* PortPwrCtrlMask */ |
|
}; |
|
|
|
static void fhci_gpio_set_value(struct fhci_hcd *fhci, int gpio_nr, bool on) |
|
{ |
|
int gpio = fhci->gpios[gpio_nr]; |
|
bool alow = fhci->alow_gpios[gpio_nr]; |
|
|
|
if (!gpio_is_valid(gpio)) |
|
return; |
|
|
|
gpio_set_value(gpio, on ^ alow); |
|
mdelay(5); |
|
} |
|
|
|
void fhci_config_transceiver(struct fhci_hcd *fhci, |
|
enum fhci_port_status status) |
|
{ |
|
fhci_dbg(fhci, "-> %s: %d\n", __func__, status); |
|
|
|
switch (status) { |
|
case FHCI_PORT_POWER_OFF: |
|
fhci_gpio_set_value(fhci, GPIO_POWER, false); |
|
break; |
|
case FHCI_PORT_DISABLED: |
|
case FHCI_PORT_WAITING: |
|
fhci_gpio_set_value(fhci, GPIO_POWER, true); |
|
break; |
|
case FHCI_PORT_LOW: |
|
fhci_gpio_set_value(fhci, GPIO_SPEED, false); |
|
break; |
|
case FHCI_PORT_FULL: |
|
fhci_gpio_set_value(fhci, GPIO_SPEED, true); |
|
break; |
|
default: |
|
WARN_ON(1); |
|
break; |
|
} |
|
|
|
fhci_dbg(fhci, "<- %s: %d\n", __func__, status); |
|
} |
|
|
|
/* disable the USB port by clearing the EN bit in the USBMOD register */ |
|
void fhci_port_disable(struct fhci_hcd *fhci) |
|
{ |
|
struct fhci_usb *usb = (struct fhci_usb *)fhci->usb_lld; |
|
enum fhci_port_status port_status; |
|
|
|
fhci_dbg(fhci, "-> %s\n", __func__); |
|
|
|
fhci_stop_sof_timer(fhci); |
|
|
|
fhci_flush_all_transmissions(usb); |
|
|
|
fhci_usb_disable_interrupt((struct fhci_usb *)fhci->usb_lld); |
|
port_status = usb->port_status; |
|
usb->port_status = FHCI_PORT_DISABLED; |
|
|
|
/* Enable IDLE since we want to know if something comes along */ |
|
usb->saved_msk |= USB_E_IDLE_MASK; |
|
out_be16(&usb->fhci->regs->usb_usbmr, usb->saved_msk); |
|
|
|
/* check if during the disconnection process attached new device */ |
|
if (port_status == FHCI_PORT_WAITING) |
|
fhci_device_connected_interrupt(fhci); |
|
usb->vroot_hub->port.wPortStatus &= ~USB_PORT_STAT_ENABLE; |
|
usb->vroot_hub->port.wPortChange |= USB_PORT_STAT_C_ENABLE; |
|
fhci_usb_enable_interrupt((struct fhci_usb *)fhci->usb_lld); |
|
|
|
fhci_dbg(fhci, "<- %s\n", __func__); |
|
} |
|
|
|
/* enable the USB port by setting the EN bit in the USBMOD register */ |
|
void fhci_port_enable(void *lld) |
|
{ |
|
struct fhci_usb *usb = (struct fhci_usb *)lld; |
|
struct fhci_hcd *fhci = usb->fhci; |
|
|
|
fhci_dbg(fhci, "-> %s\n", __func__); |
|
|
|
fhci_config_transceiver(fhci, usb->port_status); |
|
|
|
if ((usb->port_status != FHCI_PORT_FULL) && |
|
(usb->port_status != FHCI_PORT_LOW)) |
|
fhci_start_sof_timer(fhci); |
|
|
|
usb->vroot_hub->port.wPortStatus |= USB_PORT_STAT_ENABLE; |
|
usb->vroot_hub->port.wPortChange |= USB_PORT_STAT_C_ENABLE; |
|
|
|
fhci_dbg(fhci, "<- %s\n", __func__); |
|
} |
|
|
|
void fhci_io_port_generate_reset(struct fhci_hcd *fhci) |
|
{ |
|
fhci_dbg(fhci, "-> %s\n", __func__); |
|
|
|
gpio_direction_output(fhci->gpios[GPIO_USBOE], 0); |
|
gpio_direction_output(fhci->gpios[GPIO_USBTP], 0); |
|
gpio_direction_output(fhci->gpios[GPIO_USBTN], 0); |
|
|
|
mdelay(5); |
|
|
|
qe_pin_set_dedicated(fhci->pins[PIN_USBOE]); |
|
qe_pin_set_dedicated(fhci->pins[PIN_USBTP]); |
|
qe_pin_set_dedicated(fhci->pins[PIN_USBTN]); |
|
|
|
fhci_dbg(fhci, "<- %s\n", __func__); |
|
} |
|
|
|
/* generate the RESET condition on the bus */ |
|
void fhci_port_reset(void *lld) |
|
{ |
|
struct fhci_usb *usb = (struct fhci_usb *)lld; |
|
struct fhci_hcd *fhci = usb->fhci; |
|
u8 mode; |
|
u16 mask; |
|
|
|
fhci_dbg(fhci, "-> %s\n", __func__); |
|
|
|
fhci_stop_sof_timer(fhci); |
|
/* disable the USB controller */ |
|
mode = in_8(&fhci->regs->usb_usmod); |
|
out_8(&fhci->regs->usb_usmod, mode & (~USB_MODE_EN)); |
|
|
|
/* disable idle interrupts */ |
|
mask = in_be16(&fhci->regs->usb_usbmr); |
|
out_be16(&fhci->regs->usb_usbmr, mask & (~USB_E_IDLE_MASK)); |
|
|
|
fhci_io_port_generate_reset(fhci); |
|
|
|
/* enable interrupt on this endpoint */ |
|
out_be16(&fhci->regs->usb_usbmr, mask); |
|
|
|
/* enable the USB controller */ |
|
mode = in_8(&fhci->regs->usb_usmod); |
|
out_8(&fhci->regs->usb_usmod, mode | USB_MODE_EN); |
|
fhci_start_sof_timer(fhci); |
|
|
|
fhci_dbg(fhci, "<- %s\n", __func__); |
|
} |
|
|
|
int fhci_hub_status_data(struct usb_hcd *hcd, char *buf) |
|
{ |
|
struct fhci_hcd *fhci = hcd_to_fhci(hcd); |
|
int ret = 0; |
|
unsigned long flags; |
|
|
|
fhci_dbg(fhci, "-> %s\n", __func__); |
|
|
|
spin_lock_irqsave(&fhci->lock, flags); |
|
|
|
if (fhci->vroot_hub->port.wPortChange & (USB_PORT_STAT_C_CONNECTION | |
|
USB_PORT_STAT_C_ENABLE | USB_PORT_STAT_C_SUSPEND | |
|
USB_PORT_STAT_C_RESET | USB_PORT_STAT_C_OVERCURRENT)) { |
|
*buf = 1 << 1; |
|
ret = 1; |
|
fhci_dbg(fhci, "-- %s\n", __func__); |
|
} |
|
|
|
spin_unlock_irqrestore(&fhci->lock, flags); |
|
|
|
fhci_dbg(fhci, "<- %s\n", __func__); |
|
|
|
return ret; |
|
} |
|
|
|
int fhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue, |
|
u16 wIndex, char *buf, u16 wLength) |
|
{ |
|
struct fhci_hcd *fhci = hcd_to_fhci(hcd); |
|
int retval = 0; |
|
struct usb_hub_status *hub_status; |
|
struct usb_port_status *port_status; |
|
unsigned long flags; |
|
|
|
spin_lock_irqsave(&fhci->lock, flags); |
|
|
|
fhci_dbg(fhci, "-> %s\n", __func__); |
|
|
|
switch (typeReq) { |
|
case ClearHubFeature: |
|
switch (wValue) { |
|
case C_HUB_LOCAL_POWER: |
|
case C_HUB_OVER_CURRENT: |
|
break; |
|
default: |
|
goto error; |
|
} |
|
break; |
|
case ClearPortFeature: |
|
fhci->vroot_hub->feature &= (1 << wValue); |
|
|
|
switch (wValue) { |
|
case USB_PORT_FEAT_ENABLE: |
|
fhci->vroot_hub->port.wPortStatus &= |
|
~USB_PORT_STAT_ENABLE; |
|
fhci_port_disable(fhci); |
|
break; |
|
case USB_PORT_FEAT_C_ENABLE: |
|
fhci->vroot_hub->port.wPortChange &= |
|
~USB_PORT_STAT_C_ENABLE; |
|
break; |
|
case USB_PORT_FEAT_SUSPEND: |
|
fhci->vroot_hub->port.wPortStatus &= |
|
~USB_PORT_STAT_SUSPEND; |
|
fhci_stop_sof_timer(fhci); |
|
break; |
|
case USB_PORT_FEAT_C_SUSPEND: |
|
fhci->vroot_hub->port.wPortChange &= |
|
~USB_PORT_STAT_C_SUSPEND; |
|
break; |
|
case USB_PORT_FEAT_POWER: |
|
fhci->vroot_hub->port.wPortStatus &= |
|
~USB_PORT_STAT_POWER; |
|
fhci_config_transceiver(fhci, FHCI_PORT_POWER_OFF); |
|
break; |
|
case USB_PORT_FEAT_C_CONNECTION: |
|
fhci->vroot_hub->port.wPortChange &= |
|
~USB_PORT_STAT_C_CONNECTION; |
|
break; |
|
case USB_PORT_FEAT_C_OVER_CURRENT: |
|
fhci->vroot_hub->port.wPortChange &= |
|
~USB_PORT_STAT_C_OVERCURRENT; |
|
break; |
|
case USB_PORT_FEAT_C_RESET: |
|
fhci->vroot_hub->port.wPortChange &= |
|
~USB_PORT_STAT_C_RESET; |
|
break; |
|
default: |
|
goto error; |
|
} |
|
break; |
|
case GetHubDescriptor: |
|
memcpy(buf, root_hub_des, sizeof(root_hub_des)); |
|
break; |
|
case GetHubStatus: |
|
hub_status = (struct usb_hub_status *)buf; |
|
hub_status->wHubStatus = |
|
cpu_to_le16(fhci->vroot_hub->hub.wHubStatus); |
|
hub_status->wHubChange = |
|
cpu_to_le16(fhci->vroot_hub->hub.wHubChange); |
|
break; |
|
case GetPortStatus: |
|
port_status = (struct usb_port_status *)buf; |
|
port_status->wPortStatus = |
|
cpu_to_le16(fhci->vroot_hub->port.wPortStatus); |
|
port_status->wPortChange = |
|
cpu_to_le16(fhci->vroot_hub->port.wPortChange); |
|
break; |
|
case SetHubFeature: |
|
switch (wValue) { |
|
case C_HUB_OVER_CURRENT: |
|
case C_HUB_LOCAL_POWER: |
|
break; |
|
default: |
|
goto error; |
|
} |
|
break; |
|
case SetPortFeature: |
|
fhci->vroot_hub->feature |= (1 << wValue); |
|
|
|
switch (wValue) { |
|
case USB_PORT_FEAT_ENABLE: |
|
fhci->vroot_hub->port.wPortStatus |= |
|
USB_PORT_STAT_ENABLE; |
|
fhci_port_enable(fhci->usb_lld); |
|
break; |
|
case USB_PORT_FEAT_SUSPEND: |
|
fhci->vroot_hub->port.wPortStatus |= |
|
USB_PORT_STAT_SUSPEND; |
|
fhci_stop_sof_timer(fhci); |
|
break; |
|
case USB_PORT_FEAT_RESET: |
|
fhci->vroot_hub->port.wPortStatus |= |
|
USB_PORT_STAT_RESET; |
|
fhci_port_reset(fhci->usb_lld); |
|
fhci->vroot_hub->port.wPortStatus |= |
|
USB_PORT_STAT_ENABLE; |
|
fhci->vroot_hub->port.wPortStatus &= |
|
~USB_PORT_STAT_RESET; |
|
break; |
|
case USB_PORT_FEAT_POWER: |
|
fhci->vroot_hub->port.wPortStatus |= |
|
USB_PORT_STAT_POWER; |
|
fhci_config_transceiver(fhci, FHCI_PORT_WAITING); |
|
break; |
|
default: |
|
goto error; |
|
} |
|
break; |
|
default: |
|
error: |
|
retval = -EPIPE; |
|
} |
|
|
|
fhci_dbg(fhci, "<- %s\n", __func__); |
|
|
|
spin_unlock_irqrestore(&fhci->lock, flags); |
|
|
|
return retval; |
|
}
|
|
|