2005-04-17 06:20:36 +08:00
|
|
|
/*
|
2005-05-08 04:21:50 +08:00
|
|
|
* Copyright (C) 2001-2004 by David Brownell
|
2006-08-31 05:50:06 +08:00
|
|
|
*
|
2005-04-17 06:20:36 +08:00
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms of the GNU General Public License as published by the
|
|
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
|
|
* option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful, but
|
|
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
|
|
|
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
|
|
|
* for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software Foundation,
|
|
|
|
* Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* this file is part of ehci-hcd.c */
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* EHCI Root Hub ... the nonsharable stuff
|
|
|
|
*
|
|
|
|
* Registers don't need cpu_to_le32, that happens transparently
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
#ifdef CONFIG_PM
|
|
|
|
|
2005-10-14 05:08:02 +08:00
|
|
|
static int ehci_bus_suspend (struct usb_hcd *hcd)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct ehci_hcd *ehci = hcd_to_ehci (hcd);
|
|
|
|
int port;
|
2006-11-10 03:42:16 +08:00
|
|
|
int mask;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (time_before (jiffies, ehci->next_statechange))
|
|
|
|
msleep(5);
|
|
|
|
|
|
|
|
port = HCS_N_PORTS (ehci->hcs_params);
|
|
|
|
spin_lock_irq (&ehci->lock);
|
|
|
|
|
|
|
|
/* stop schedules, clean any completed work */
|
|
|
|
if (HC_IS_RUNNING(hcd->state)) {
|
|
|
|
ehci_quiesce (ehci);
|
|
|
|
hcd->state = HC_STATE_QUIESCING;
|
|
|
|
}
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci->command = ehci_readl(ehci, &ehci->regs->command);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (ehci->reclaim)
|
2006-10-18 04:57:18 +08:00
|
|
|
ehci->reclaim_ready = 1;
|
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers
Maintain a per-CPU global "struct pt_regs *" variable which can be used instead
of passing regs around manually through all ~1800 interrupt handlers in the
Linux kernel.
The regs pointer is used in few places, but it potentially costs both stack
space and code to pass it around. On the FRV arch, removing the regs parameter
from all the genirq function results in a 20% speed up of the IRQ exit path
(ie: from leaving timer_interrupt() to leaving do_IRQ()).
Where appropriate, an arch may override the generic storage facility and do
something different with the variable. On FRV, for instance, the address is
maintained in GR28 at all times inside the kernel as part of general exception
handling.
Having looked over the code, it appears that the parameter may be handed down
through up to twenty or so layers of functions. Consider a USB character
device attached to a USB hub, attached to a USB controller that posts its
interrupts through a cascaded auxiliary interrupt controller. A character
device driver may want to pass regs to the sysrq handler through the input
layer which adds another few layers of parameter passing.
I've build this code with allyesconfig for x86_64 and i386. I've runtested the
main part of the code on FRV and i386, though I can't test most of the drivers.
I've also done partial conversion for powerpc and MIPS - these at least compile
with minimal configurations.
This will affect all archs. Mostly the changes should be relatively easy.
Take do_IRQ(), store the regs pointer at the beginning, saving the old one:
struct pt_regs *old_regs = set_irq_regs(regs);
And put the old one back at the end:
set_irq_regs(old_regs);
Don't pass regs through to generic_handle_irq() or __do_IRQ().
In timer_interrupt(), this sort of change will be necessary:
- update_process_times(user_mode(regs));
- profile_tick(CPU_PROFILING, regs);
+ update_process_times(user_mode(get_irq_regs()));
+ profile_tick(CPU_PROFILING);
I'd like to move update_process_times()'s use of get_irq_regs() into itself,
except that i386, alone of the archs, uses something other than user_mode().
Some notes on the interrupt handling in the drivers:
(*) input_dev() is now gone entirely. The regs pointer is no longer stored in
the input_dev struct.
(*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking. It does
something different depending on whether it's been supplied with a regs
pointer or not.
(*) Various IRQ handler function pointers have been moved to type
irq_handler_t.
Signed-Off-By: David Howells <dhowells@redhat.com>
(cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
2006-10-05 21:55:46 +08:00
|
|
|
ehci_work(ehci);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-11-10 03:42:16 +08:00
|
|
|
/* Unlike other USB host controller types, EHCI doesn't have
|
|
|
|
* any notion of "global" or bus-wide suspend. The driver has
|
|
|
|
* to manually suspend all the active unsuspended ports, and
|
|
|
|
* then manually resume them in the bus_resume() routine.
|
|
|
|
*/
|
|
|
|
ehci->bus_suspended = 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
while (port--) {
|
|
|
|
u32 __iomem *reg = &ehci->regs->port_status [port];
|
2006-12-15 03:54:08 +08:00
|
|
|
u32 t1 = ehci_readl(ehci, reg) & ~PORT_RWC_BITS;
|
2005-04-17 06:20:36 +08:00
|
|
|
u32 t2 = t1;
|
|
|
|
|
2006-11-10 03:42:16 +08:00
|
|
|
/* keep track of which ports we suspend */
|
|
|
|
if ((t1 & PORT_PE) && !(t1 & PORT_OWNER) &&
|
|
|
|
!(t1 & PORT_SUSPEND)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
t2 |= PORT_SUSPEND;
|
2006-11-10 03:42:16 +08:00
|
|
|
set_bit(port, &ehci->bus_suspended);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* enable remote wakeup on all ports */
|
2005-11-08 07:24:46 +08:00
|
|
|
if (device_may_wakeup(&hcd->self.root_hub->dev))
|
2005-04-17 06:20:36 +08:00
|
|
|
t2 |= PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E;
|
|
|
|
else
|
|
|
|
t2 &= ~(PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E);
|
|
|
|
|
|
|
|
if (t1 != t2) {
|
|
|
|
ehci_vdbg (ehci, "port %d, %08x -> %08x\n",
|
|
|
|
port + 1, t1, t2);
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, t2, reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* turn off now-idle HC */
|
2005-05-10 08:23:51 +08:00
|
|
|
del_timer_sync (&ehci->watchdog);
|
2005-04-17 06:20:36 +08:00
|
|
|
ehci_halt (ehci);
|
|
|
|
hcd->state = HC_STATE_SUSPENDED;
|
|
|
|
|
2006-11-10 03:42:16 +08:00
|
|
|
/* allow remote wakeup */
|
|
|
|
mask = INTR_MASK;
|
|
|
|
if (!device_may_wakeup(&hcd->self.root_hub->dev))
|
|
|
|
mask &= ~STS_PCD;
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, mask, &ehci->regs->intr_enable);
|
|
|
|
ehci_readl(ehci, &ehci->regs->intr_enable);
|
2006-11-10 03:42:16 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
ehci->next_statechange = jiffies + msecs_to_jiffies(10);
|
|
|
|
spin_unlock_irq (&ehci->lock);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* caller has locked the root hub, and should reset/reinit on error */
|
2005-10-14 05:08:02 +08:00
|
|
|
static int ehci_bus_resume (struct usb_hcd *hcd)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct ehci_hcd *ehci = hcd_to_ehci (hcd);
|
|
|
|
u32 temp;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
if (time_before (jiffies, ehci->next_statechange))
|
|
|
|
msleep(5);
|
|
|
|
spin_lock_irq (&ehci->lock);
|
|
|
|
|
2005-11-24 07:45:28 +08:00
|
|
|
/* Ideally and we've got a real resume here, and no port's power
|
|
|
|
* was lost. (For PCI, that means Vaux was maintained.) But we
|
|
|
|
* could instead be restoring a swsusp snapshot -- so that BIOS was
|
|
|
|
* the last user of the controller, not reset/pm hardware keeping
|
|
|
|
* state we gave to it.
|
|
|
|
*/
|
2006-12-15 03:54:08 +08:00
|
|
|
temp = ehci_readl(ehci, &ehci->regs->intr_enable);
|
2006-11-10 03:42:16 +08:00
|
|
|
ehci_dbg(ehci, "resume root hub%s\n", temp ? "" : " after power loss");
|
2005-11-24 07:45:28 +08:00
|
|
|
|
2006-11-10 03:42:16 +08:00
|
|
|
/* at least some APM implementations will try to deliver
|
|
|
|
* IRQs right away, so delay them until we're ready.
|
|
|
|
*/
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, 0, &ehci->regs->intr_enable);
|
2006-11-10 03:42:16 +08:00
|
|
|
|
|
|
|
/* re-init operational registers */
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, 0, &ehci->regs->segment);
|
|
|
|
ehci_writel(ehci, ehci->periodic_dma, &ehci->regs->frame_list);
|
|
|
|
ehci_writel(ehci, (u32) ehci->async->qh_dma, &ehci->regs->async_next);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/* restore CMD_RUN, framelist size, and irq threshold */
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, ehci->command, &ehci->regs->command);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-11-10 03:42:16 +08:00
|
|
|
/* manually resume the ports we suspended during bus_suspend() */
|
2005-04-17 06:20:36 +08:00
|
|
|
i = HCS_N_PORTS (ehci->hcs_params);
|
|
|
|
while (i--) {
|
2006-12-15 03:54:08 +08:00
|
|
|
temp = ehci_readl(ehci, &ehci->regs->port_status [i]);
|
2005-09-01 01:55:38 +08:00
|
|
|
temp &= ~(PORT_RWC_BITS
|
|
|
|
| PORT_WKOC_E | PORT_WKDISC_E | PORT_WKCONN_E);
|
2006-11-10 03:42:16 +08:00
|
|
|
if (test_bit(i, &ehci->bus_suspended) &&
|
|
|
|
(temp & PORT_SUSPEND)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
ehci->reset_done [i] = jiffies + msecs_to_jiffies (20);
|
|
|
|
temp |= PORT_RESUME;
|
|
|
|
}
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, temp, &ehci->regs->port_status [i]);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
i = HCS_N_PORTS (ehci->hcs_params);
|
|
|
|
mdelay (20);
|
|
|
|
while (i--) {
|
2006-12-15 03:54:08 +08:00
|
|
|
temp = ehci_readl(ehci, &ehci->regs->port_status [i]);
|
2006-11-10 03:42:16 +08:00
|
|
|
if (test_bit(i, &ehci->bus_suspended) &&
|
|
|
|
(temp & PORT_SUSPEND)) {
|
|
|
|
temp &= ~(PORT_RWC_BITS | PORT_RESUME);
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, temp, &ehci->regs->port_status [i]);
|
2006-11-10 03:42:16 +08:00
|
|
|
ehci_vdbg (ehci, "resumed port %d\n", i + 1);
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2006-12-15 03:54:08 +08:00
|
|
|
(void) ehci_readl(ehci, &ehci->regs->command);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/* maybe re-activate the schedule(s) */
|
|
|
|
temp = 0;
|
|
|
|
if (ehci->async->qh_next.qh)
|
|
|
|
temp |= CMD_ASE;
|
|
|
|
if (ehci->periodic_sched)
|
|
|
|
temp |= CMD_PSE;
|
|
|
|
if (temp) {
|
|
|
|
ehci->command |= temp;
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, ehci->command, &ehci->regs->command);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
ehci->next_statechange = jiffies + msecs_to_jiffies(5);
|
|
|
|
hcd->state = HC_STATE_RUNNING;
|
|
|
|
|
|
|
|
/* Now we can safely re-enable irqs */
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, INTR_MASK, &ehci->regs->intr_enable);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
spin_unlock_irq (&ehci->lock);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
2005-10-14 05:08:02 +08:00
|
|
|
#define ehci_bus_suspend NULL
|
|
|
|
#define ehci_bus_resume NULL
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#endif /* CONFIG_PM */
|
|
|
|
|
2007-01-17 00:59:45 +08:00
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
/* Display the ports dedicated to the companion controller */
|
|
|
|
static ssize_t show_companion(struct class_device *class_dev, char *buf)
|
|
|
|
{
|
|
|
|
struct ehci_hcd *ehci;
|
|
|
|
int nports, index, n;
|
|
|
|
int count = PAGE_SIZE;
|
|
|
|
char *ptr = buf;
|
|
|
|
|
|
|
|
ehci = hcd_to_ehci(bus_to_hcd(class_get_devdata(class_dev)));
|
|
|
|
nports = HCS_N_PORTS(ehci->hcs_params);
|
|
|
|
|
|
|
|
for (index = 0; index < nports; ++index) {
|
|
|
|
if (test_bit(index, &ehci->companion_ports)) {
|
|
|
|
n = scnprintf(ptr, count, "%d\n", index + 1);
|
|
|
|
ptr += n;
|
|
|
|
count -= n;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return ptr - buf;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Dedicate or undedicate a port to the companion controller.
|
|
|
|
* Syntax is "[-]portnum", where a leading '-' sign means
|
|
|
|
* return control of the port to the EHCI controller.
|
|
|
|
*/
|
|
|
|
static ssize_t store_companion(struct class_device *class_dev,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
struct ehci_hcd *ehci;
|
|
|
|
int portnum, new_owner, try;
|
|
|
|
u32 __iomem *status_reg;
|
|
|
|
u32 port_status;
|
|
|
|
|
|
|
|
ehci = hcd_to_ehci(bus_to_hcd(class_get_devdata(class_dev)));
|
|
|
|
new_owner = PORT_OWNER; /* Owned by companion */
|
|
|
|
if (sscanf(buf, "%d", &portnum) != 1)
|
|
|
|
return -EINVAL;
|
|
|
|
if (portnum < 0) {
|
|
|
|
portnum = - portnum;
|
|
|
|
new_owner = 0; /* Owned by EHCI */
|
|
|
|
}
|
|
|
|
if (portnum <= 0 || portnum > HCS_N_PORTS(ehci->hcs_params))
|
|
|
|
return -ENOENT;
|
|
|
|
status_reg = &ehci->regs->port_status[--portnum];
|
|
|
|
if (new_owner)
|
|
|
|
set_bit(portnum, &ehci->companion_ports);
|
|
|
|
else
|
|
|
|
clear_bit(portnum, &ehci->companion_ports);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The controller won't set the OWNER bit if the port is
|
|
|
|
* enabled, so this loop will sometimes require at least two
|
|
|
|
* iterations: one to disable the port and one to set OWNER.
|
|
|
|
*/
|
|
|
|
|
|
|
|
for (try = 4; try > 0; --try) {
|
|
|
|
spin_lock_irq(&ehci->lock);
|
|
|
|
port_status = ehci_readl(ehci, status_reg);
|
|
|
|
if ((port_status & PORT_OWNER) == new_owner
|
|
|
|
|| (port_status & (PORT_OWNER | PORT_CONNECT))
|
|
|
|
== 0)
|
|
|
|
try = 0;
|
|
|
|
else {
|
|
|
|
port_status ^= PORT_OWNER;
|
|
|
|
port_status &= ~(PORT_PE | PORT_RWC_BITS);
|
|
|
|
ehci_writel(ehci, port_status, status_reg);
|
|
|
|
}
|
|
|
|
spin_unlock_irq(&ehci->lock);
|
|
|
|
if (try > 1)
|
|
|
|
msleep(5);
|
|
|
|
}
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
static CLASS_DEVICE_ATTR(companion, 0644, show_companion, store_companion);
|
|
|
|
|
|
|
|
static inline void create_companion_file(struct ehci_hcd *ehci)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* with integrated TT there is no companion! */
|
|
|
|
if (!ehci_is_TDI(ehci))
|
|
|
|
i = class_device_create_file(ehci_to_hcd(ehci)->self.class_dev,
|
|
|
|
&class_device_attr_companion);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void remove_companion_file(struct ehci_hcd *ehci)
|
|
|
|
{
|
|
|
|
/* with integrated TT there is no companion! */
|
|
|
|
if (!ehci_is_TDI(ehci))
|
|
|
|
class_device_remove_file(ehci_to_hcd(ehci)->self.class_dev,
|
|
|
|
&class_device_attr_companion);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
static int check_reset_complete (
|
|
|
|
struct ehci_hcd *ehci,
|
|
|
|
int index,
|
2007-01-17 00:58:00 +08:00
|
|
|
u32 __iomem *status_reg,
|
2005-04-17 06:20:36 +08:00
|
|
|
int port_status
|
|
|
|
) {
|
|
|
|
if (!(port_status & PORT_CONNECT)) {
|
|
|
|
ehci->reset_done [index] = 0;
|
|
|
|
return port_status;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* if reset finished and it's still not enabled -- handoff */
|
|
|
|
if (!(port_status & PORT_PE)) {
|
|
|
|
|
|
|
|
/* with integrated TT, there's nobody to hand it to! */
|
|
|
|
if (ehci_is_TDI(ehci)) {
|
|
|
|
ehci_dbg (ehci,
|
|
|
|
"Failed to enable port %d on root hub TT\n",
|
|
|
|
index+1);
|
|
|
|
return port_status;
|
|
|
|
}
|
|
|
|
|
|
|
|
ehci_dbg (ehci, "port %d full speed --> companion\n",
|
|
|
|
index + 1);
|
|
|
|
|
|
|
|
// what happens if HCS_N_CC(params) == 0 ?
|
|
|
|
port_status |= PORT_OWNER;
|
2005-09-01 01:55:38 +08:00
|
|
|
port_status &= ~PORT_RWC_BITS;
|
2007-01-17 00:58:00 +08:00
|
|
|
ehci_writel(ehci, port_status, status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
} else
|
|
|
|
ehci_dbg (ehci, "port %d high speed\n", index + 1);
|
|
|
|
|
|
|
|
return port_status;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
|
|
/* build "status change" packet (one or two bytes) from HC registers */
|
|
|
|
|
|
|
|
static int
|
|
|
|
ehci_hub_status_data (struct usb_hcd *hcd, char *buf)
|
|
|
|
{
|
|
|
|
struct ehci_hcd *ehci = hcd_to_ehci (hcd);
|
|
|
|
u32 temp, status = 0;
|
2006-11-17 15:34:58 +08:00
|
|
|
u32 mask;
|
2005-04-17 06:20:36 +08:00
|
|
|
int ports, i, retval = 1;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
/* if !USB_SUSPEND, root hub timers won't get shut down ... */
|
|
|
|
if (!HC_IS_RUNNING(hcd->state))
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
/* init status to no-changes */
|
|
|
|
buf [0] = 0;
|
|
|
|
ports = HCS_N_PORTS (ehci->hcs_params);
|
|
|
|
if (ports > 7) {
|
|
|
|
buf [1] = 0;
|
|
|
|
retval++;
|
|
|
|
}
|
2006-08-31 05:50:06 +08:00
|
|
|
|
2006-11-17 15:34:58 +08:00
|
|
|
/* Some boards (mostly VIA?) report bogus overcurrent indications,
|
|
|
|
* causing massive log spam unless we completely ignore them. It
|
|
|
|
* may be relevant that VIA VT8235 controlers, where PORT_POWER is
|
|
|
|
* always set, seem to clear PORT_OCC and PORT_CSC when writing to
|
|
|
|
* PORT_POWER; that's surprising, but maybe within-spec.
|
|
|
|
*/
|
|
|
|
if (!ignore_oc)
|
|
|
|
mask = PORT_CSC | PORT_PEC | PORT_OCC;
|
|
|
|
else
|
|
|
|
mask = PORT_CSC | PORT_PEC;
|
|
|
|
// PORT_RESUME from hardware ~= PORT_STAT_C_SUSPEND
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/* no hub change reports (bit 0) for now (power, ...) */
|
|
|
|
|
|
|
|
/* port N changes (bit N)? */
|
|
|
|
spin_lock_irqsave (&ehci->lock, flags);
|
|
|
|
for (i = 0; i < ports; i++) {
|
2006-12-15 03:54:08 +08:00
|
|
|
temp = ehci_readl(ehci, &ehci->regs->port_status [i]);
|
2007-01-17 00:58:47 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Return status information even for ports with OWNER set.
|
|
|
|
* Otherwise khubd wouldn't see the disconnect event when a
|
|
|
|
* high-speed device is switched over to the companion
|
|
|
|
* controller by the user.
|
|
|
|
*/
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
if (!(temp & PORT_CONNECT))
|
|
|
|
ehci->reset_done [i] = 0;
|
2006-11-17 15:34:58 +08:00
|
|
|
if ((temp & mask) != 0
|
2005-04-17 06:20:36 +08:00
|
|
|
|| ((temp & PORT_RESUME) != 0
|
2007-01-23 05:08:53 +08:00
|
|
|
&& time_after_eq(jiffies,
|
|
|
|
ehci->reset_done[i]))) {
|
2005-04-17 06:20:36 +08:00
|
|
|
if (i < 7)
|
|
|
|
buf [0] |= 1 << (i + 1);
|
|
|
|
else
|
|
|
|
buf [1] |= 1 << (i - 7);
|
|
|
|
status = STS_PCD;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/* FIXME autosuspend idle root hubs */
|
|
|
|
spin_unlock_irqrestore (&ehci->lock, flags);
|
|
|
|
return status ? retval : 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
static void
|
|
|
|
ehci_hub_descriptor (
|
|
|
|
struct ehci_hcd *ehci,
|
|
|
|
struct usb_hub_descriptor *desc
|
|
|
|
) {
|
|
|
|
int ports = HCS_N_PORTS (ehci->hcs_params);
|
|
|
|
u16 temp;
|
|
|
|
|
|
|
|
desc->bDescriptorType = 0x29;
|
|
|
|
desc->bPwrOn2PwrGood = 10; /* ehci 1.0, 2.3.9 says 20ms max */
|
|
|
|
desc->bHubContrCurrent = 0;
|
|
|
|
|
|
|
|
desc->bNbrPorts = ports;
|
|
|
|
temp = 1 + (ports / 8);
|
|
|
|
desc->bDescLength = 7 + 2 * temp;
|
|
|
|
|
|
|
|
/* two bitmaps: ports removable, and usb 1.0 legacy PortPwrCtrlMask */
|
|
|
|
memset (&desc->bitmap [0], 0, temp);
|
|
|
|
memset (&desc->bitmap [temp], 0xff, temp);
|
|
|
|
|
|
|
|
temp = 0x0008; /* per-port overcurrent reporting */
|
|
|
|
if (HCS_PPC (ehci->hcs_params))
|
|
|
|
temp |= 0x0001; /* per-port power control */
|
2005-04-10 00:00:29 +08:00
|
|
|
else
|
|
|
|
temp |= 0x0002; /* no power switching */
|
2005-04-17 06:20:36 +08:00
|
|
|
#if 0
|
|
|
|
// re-enable when we support USB_PORT_FEAT_INDICATOR below.
|
|
|
|
if (HCS_INDICATOR (ehci->hcs_params))
|
|
|
|
temp |= 0x0080; /* per-port indicators (LEDs) */
|
|
|
|
#endif
|
|
|
|
desc->wHubCharacteristics = (__force __u16)cpu_to_le16 (temp);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
|
2006-08-31 05:50:06 +08:00
|
|
|
#define PORT_WAKE_BITS (PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
static int ehci_hub_control (
|
|
|
|
struct usb_hcd *hcd,
|
|
|
|
u16 typeReq,
|
|
|
|
u16 wValue,
|
|
|
|
u16 wIndex,
|
|
|
|
char *buf,
|
|
|
|
u16 wLength
|
|
|
|
) {
|
|
|
|
struct ehci_hcd *ehci = hcd_to_ehci (hcd);
|
|
|
|
int ports = HCS_N_PORTS (ehci->hcs_params);
|
2007-01-17 00:58:00 +08:00
|
|
|
u32 __iomem *status_reg = &ehci->regs->port_status[wIndex - 1];
|
2005-04-17 06:20:36 +08:00
|
|
|
u32 temp, status;
|
|
|
|
unsigned long flags;
|
|
|
|
int retval = 0;
|
2006-11-17 15:56:15 +08:00
|
|
|
unsigned selector;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* FIXME: support SetPortFeatures USB_PORT_FEAT_INDICATOR.
|
|
|
|
* HCS_INDICATOR may say we can change LEDs to off/amber/green.
|
|
|
|
* (track current state ourselves) ... blink for diagnostics,
|
|
|
|
* power, "this is the one", etc. EHCI spec supports this.
|
|
|
|
*/
|
|
|
|
|
|
|
|
spin_lock_irqsave (&ehci->lock, flags);
|
|
|
|
switch (typeReq) {
|
|
|
|
case ClearHubFeature:
|
|
|
|
switch (wValue) {
|
|
|
|
case C_HUB_LOCAL_POWER:
|
|
|
|
case C_HUB_OVER_CURRENT:
|
|
|
|
/* no hub-wide feature/status flags */
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case ClearPortFeature:
|
|
|
|
if (!wIndex || wIndex > ports)
|
|
|
|
goto error;
|
|
|
|
wIndex--;
|
2007-01-17 00:58:00 +08:00
|
|
|
temp = ehci_readl(ehci, status_reg);
|
2007-01-17 00:58:47 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Even if OWNER is set, so the port is owned by the
|
|
|
|
* companion controller, khubd needs to be able to clear
|
|
|
|
* the port-change status bits (especially
|
|
|
|
* USB_PORT_FEAT_C_CONNECTION).
|
|
|
|
*/
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
switch (wValue) {
|
|
|
|
case USB_PORT_FEAT_ENABLE:
|
2007-01-17 00:58:00 +08:00
|
|
|
ehci_writel(ehci, temp & ~PORT_PE, status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_C_ENABLE:
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, (temp & ~PORT_RWC_BITS) | PORT_PEC,
|
2007-01-17 00:58:00 +08:00
|
|
|
status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_SUSPEND:
|
|
|
|
if (temp & PORT_RESET)
|
|
|
|
goto error;
|
2006-01-21 05:55:14 +08:00
|
|
|
if (ehci->no_selective_suspend)
|
|
|
|
break;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (temp & PORT_SUSPEND) {
|
|
|
|
if ((temp & PORT_PE) == 0)
|
|
|
|
goto error;
|
|
|
|
/* resume signaling for 20 msec */
|
2005-09-01 01:55:38 +08:00
|
|
|
temp &= ~(PORT_RWC_BITS | PORT_WAKE_BITS);
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, temp | PORT_RESUME,
|
2007-01-17 00:58:00 +08:00
|
|
|
status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
ehci->reset_done [wIndex] = jiffies
|
|
|
|
+ msecs_to_jiffies (20);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_C_SUSPEND:
|
|
|
|
/* we auto-clear this feature */
|
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_POWER:
|
|
|
|
if (HCS_PPC (ehci->hcs_params))
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci,
|
|
|
|
temp & ~(PORT_RWC_BITS | PORT_POWER),
|
2007-01-17 00:58:00 +08:00
|
|
|
status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_C_CONNECTION:
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, (temp & ~PORT_RWC_BITS) | PORT_CSC,
|
2007-01-17 00:58:00 +08:00
|
|
|
status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_C_OVER_CURRENT:
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, (temp & ~PORT_RWC_BITS) | PORT_OCC,
|
2007-01-17 00:58:00 +08:00
|
|
|
status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_C_RESET:
|
|
|
|
/* GetPortStatus clears reset */
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
goto error;
|
|
|
|
}
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_readl(ehci, &ehci->regs->command); /* unblock posted write */
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case GetHubDescriptor:
|
|
|
|
ehci_hub_descriptor (ehci, (struct usb_hub_descriptor *)
|
|
|
|
buf);
|
|
|
|
break;
|
|
|
|
case GetHubStatus:
|
|
|
|
/* no hub-wide feature/status flags */
|
|
|
|
memset (buf, 0, 4);
|
|
|
|
//cpu_to_le32s ((u32 *) buf);
|
|
|
|
break;
|
|
|
|
case GetPortStatus:
|
|
|
|
if (!wIndex || wIndex > ports)
|
|
|
|
goto error;
|
|
|
|
wIndex--;
|
|
|
|
status = 0;
|
2007-01-17 00:58:00 +08:00
|
|
|
temp = ehci_readl(ehci, status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
// wPortChange bits
|
|
|
|
if (temp & PORT_CSC)
|
|
|
|
status |= 1 << USB_PORT_FEAT_C_CONNECTION;
|
|
|
|
if (temp & PORT_PEC)
|
|
|
|
status |= 1 << USB_PORT_FEAT_C_ENABLE;
|
2006-11-17 15:34:58 +08:00
|
|
|
if ((temp & PORT_OCC) && !ignore_oc)
|
2005-04-17 06:20:36 +08:00
|
|
|
status |= 1 << USB_PORT_FEAT_C_OVER_CURRENT;
|
|
|
|
|
|
|
|
/* whoever resumes must GetPortStatus to complete it!! */
|
2007-01-23 05:08:53 +08:00
|
|
|
if (temp & PORT_RESUME) {
|
|
|
|
|
|
|
|
/* Remote Wakeup received? */
|
|
|
|
if (!ehci->reset_done[wIndex]) {
|
|
|
|
/* resume signaling for 20 msec */
|
|
|
|
ehci->reset_done[wIndex] = jiffies
|
|
|
|
+ msecs_to_jiffies(20);
|
|
|
|
/* check the port again */
|
|
|
|
mod_timer(&ehci_to_hcd(ehci)->rh_timer,
|
|
|
|
ehci->reset_done[wIndex]);
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2007-01-23 05:08:53 +08:00
|
|
|
/* resume completed? */
|
|
|
|
else if (time_after_eq(jiffies,
|
|
|
|
ehci->reset_done[wIndex])) {
|
|
|
|
status |= 1 << USB_PORT_FEAT_C_SUSPEND;
|
|
|
|
ehci->reset_done[wIndex] = 0;
|
|
|
|
|
|
|
|
/* stop resume signaling */
|
|
|
|
temp = ehci_readl(ehci, status_reg);
|
|
|
|
ehci_writel(ehci,
|
2007-01-17 00:58:00 +08:00
|
|
|
temp & ~(PORT_RWC_BITS | PORT_RESUME),
|
|
|
|
status_reg);
|
2007-01-23 05:08:53 +08:00
|
|
|
retval = handshake(ehci, status_reg,
|
2006-12-15 03:54:08 +08:00
|
|
|
PORT_RESUME, 0, 2000 /* 2msec */);
|
2007-01-23 05:08:53 +08:00
|
|
|
if (retval != 0) {
|
|
|
|
ehci_err(ehci,
|
|
|
|
"port %d resume error %d\n",
|
|
|
|
wIndex + 1, retval);
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
temp &= ~(PORT_SUSPEND|PORT_RESUME|(3<<10));
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* whoever resets must GetPortStatus to complete it!! */
|
|
|
|
if ((temp & PORT_RESET)
|
2007-01-23 05:08:53 +08:00
|
|
|
&& time_after_eq(jiffies,
|
|
|
|
ehci->reset_done[wIndex])) {
|
2005-04-17 06:20:36 +08:00
|
|
|
status |= 1 << USB_PORT_FEAT_C_RESET;
|
|
|
|
ehci->reset_done [wIndex] = 0;
|
|
|
|
|
|
|
|
/* force reset to complete */
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, temp & ~(PORT_RWC_BITS | PORT_RESET),
|
2007-01-17 00:58:00 +08:00
|
|
|
status_reg);
|
2005-06-13 22:15:28 +08:00
|
|
|
/* REVISIT: some hardware needs 550+ usec to clear
|
|
|
|
* this bit; seems too long to spin routinely...
|
|
|
|
*/
|
2007-01-17 00:58:00 +08:00
|
|
|
retval = handshake(ehci, status_reg,
|
2005-06-13 22:15:28 +08:00
|
|
|
PORT_RESET, 0, 750);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (retval != 0) {
|
|
|
|
ehci_err (ehci, "port %d reset error %d\n",
|
|
|
|
wIndex + 1, retval);
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* see what we found out */
|
2007-01-17 00:58:00 +08:00
|
|
|
temp = check_reset_complete (ehci, wIndex, status_reg,
|
|
|
|
ehci_readl(ehci, status_reg));
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2007-01-17 00:59:45 +08:00
|
|
|
/* transfer dedicated ports to the companion hc */
|
|
|
|
if ((temp & PORT_CONNECT) &&
|
|
|
|
test_bit(wIndex, &ehci->companion_ports)) {
|
|
|
|
temp &= ~PORT_RWC_BITS;
|
|
|
|
temp |= PORT_OWNER;
|
|
|
|
ehci_writel(ehci, temp, status_reg);
|
|
|
|
ehci_dbg(ehci, "port %d --> companion\n", wIndex + 1);
|
|
|
|
temp = ehci_readl(ehci, status_reg);
|
|
|
|
}
|
|
|
|
|
2007-01-17 00:58:47 +08:00
|
|
|
/*
|
|
|
|
* Even if OWNER is set, there's no harm letting khubd
|
|
|
|
* see the wPortStatus values (they should all be 0 except
|
|
|
|
* for PORT_POWER anyway).
|
|
|
|
*/
|
|
|
|
|
|
|
|
if (temp & PORT_CONNECT) {
|
|
|
|
status |= 1 << USB_PORT_FEAT_CONNECTION;
|
|
|
|
// status may be from integrated TT
|
|
|
|
status |= ehci_port_speed(ehci, temp);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2007-01-17 00:58:47 +08:00
|
|
|
if (temp & PORT_PE)
|
|
|
|
status |= 1 << USB_PORT_FEAT_ENABLE;
|
|
|
|
if (temp & (PORT_SUSPEND|PORT_RESUME))
|
|
|
|
status |= 1 << USB_PORT_FEAT_SUSPEND;
|
|
|
|
if (temp & PORT_OC)
|
|
|
|
status |= 1 << USB_PORT_FEAT_OVER_CURRENT;
|
|
|
|
if (temp & PORT_RESET)
|
|
|
|
status |= 1 << USB_PORT_FEAT_RESET;
|
|
|
|
if (temp & PORT_POWER)
|
|
|
|
status |= 1 << USB_PORT_FEAT_POWER;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#ifndef EHCI_VERBOSE_DEBUG
|
|
|
|
if (status & ~0xffff) /* only if wPortChange is interesting */
|
|
|
|
#endif
|
|
|
|
dbg_port (ehci, "GetStatus", wIndex + 1, temp);
|
|
|
|
// we "know" this alignment is good, caller used kmalloc()...
|
|
|
|
*((__le32 *) buf) = cpu_to_le32 (status);
|
|
|
|
break;
|
|
|
|
case SetHubFeature:
|
|
|
|
switch (wValue) {
|
|
|
|
case C_HUB_LOCAL_POWER:
|
|
|
|
case C_HUB_OVER_CURRENT:
|
|
|
|
/* no hub-wide feature/status flags */
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
goto error;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case SetPortFeature:
|
2006-11-17 15:56:15 +08:00
|
|
|
selector = wIndex >> 8;
|
|
|
|
wIndex &= 0xff;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (!wIndex || wIndex > ports)
|
|
|
|
goto error;
|
|
|
|
wIndex--;
|
2007-01-17 00:58:00 +08:00
|
|
|
temp = ehci_readl(ehci, status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (temp & PORT_OWNER)
|
|
|
|
break;
|
|
|
|
|
2005-09-01 01:55:38 +08:00
|
|
|
temp &= ~PORT_RWC_BITS;
|
2005-04-17 06:20:36 +08:00
|
|
|
switch (wValue) {
|
|
|
|
case USB_PORT_FEAT_SUSPEND:
|
2006-01-21 05:55:14 +08:00
|
|
|
if (ehci->no_selective_suspend)
|
|
|
|
break;
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((temp & PORT_PE) == 0
|
|
|
|
|| (temp & PORT_RESET) != 0)
|
|
|
|
goto error;
|
2005-11-08 07:24:46 +08:00
|
|
|
if (device_may_wakeup(&hcd->self.root_hub->dev))
|
2005-04-17 06:20:36 +08:00
|
|
|
temp |= PORT_WAKE_BITS;
|
2007-01-17 00:58:00 +08:00
|
|
|
ehci_writel(ehci, temp | PORT_SUSPEND, status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_POWER:
|
|
|
|
if (HCS_PPC (ehci->hcs_params))
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_writel(ehci, temp | PORT_POWER,
|
2007-01-17 00:58:00 +08:00
|
|
|
status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
case USB_PORT_FEAT_RESET:
|
|
|
|
if (temp & PORT_RESUME)
|
|
|
|
goto error;
|
|
|
|
/* line status bits may report this as low speed,
|
|
|
|
* which can be fine if this root hub has a
|
|
|
|
* transaction translator built in.
|
|
|
|
*/
|
|
|
|
if ((temp & (PORT_PE|PORT_CONNECT)) == PORT_CONNECT
|
|
|
|
&& !ehci_is_TDI(ehci)
|
|
|
|
&& PORT_USB11 (temp)) {
|
|
|
|
ehci_dbg (ehci,
|
|
|
|
"port %d low speed --> companion\n",
|
|
|
|
wIndex + 1);
|
|
|
|
temp |= PORT_OWNER;
|
|
|
|
} else {
|
|
|
|
ehci_vdbg (ehci, "port %d reset\n", wIndex + 1);
|
|
|
|
temp |= PORT_RESET;
|
|
|
|
temp &= ~PORT_PE;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* caller must wait, then call GetPortStatus
|
|
|
|
* usb 2.0 spec says 50 ms resets on root
|
|
|
|
*/
|
|
|
|
ehci->reset_done [wIndex] = jiffies
|
|
|
|
+ msecs_to_jiffies (50);
|
|
|
|
}
|
2007-01-17 00:58:00 +08:00
|
|
|
ehci_writel(ehci, temp, status_reg);
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
2006-11-17 15:56:15 +08:00
|
|
|
|
|
|
|
/* For downstream facing ports (these): one hub port is put
|
|
|
|
* into test mode according to USB2 11.24.2.13, then the hub
|
|
|
|
* must be reset (which for root hub now means rmmod+modprobe,
|
|
|
|
* or else system reboot). See EHCI 2.3.9 and 4.14 for info
|
|
|
|
* about the EHCI-specific stuff.
|
|
|
|
*/
|
|
|
|
case USB_PORT_FEAT_TEST:
|
|
|
|
if (!selector || selector > 5)
|
|
|
|
goto error;
|
|
|
|
ehci_quiesce(ehci);
|
|
|
|
ehci_halt(ehci);
|
|
|
|
temp |= selector << 16;
|
2007-01-17 00:58:00 +08:00
|
|
|
ehci_writel(ehci, temp, status_reg);
|
2006-11-17 15:56:15 +08:00
|
|
|
break;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
default:
|
|
|
|
goto error;
|
|
|
|
}
|
2006-12-15 03:54:08 +08:00
|
|
|
ehci_readl(ehci, &ehci->regs->command); /* unblock posted writes */
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
error:
|
|
|
|
/* "stall" on error */
|
|
|
|
retval = -EPIPE;
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore (&ehci->lock, flags);
|
|
|
|
return retval;
|
|
|
|
}
|