1
2
3
4
5
6
7
8
9
10
11
12
13
14
15static const __u8 root_hub_hub_des[] =
16{
17 0x09,
18 0x29,
19 0x02,
20 0x0a,
21 0x00,
22 0x01,
23 0x00,
24 0x00,
25 0xff
26};
27
28#define UHCI_RH_MAXCHILD 7
29
30
31#define WZ_BITS (USBPORTSC_RES2 | USBPORTSC_RES3 | USBPORTSC_RES4)
32
33
34#define RWC_BITS (USBPORTSC_OCC | USBPORTSC_PEC | USBPORTSC_CSC)
35
36
37#define SUSPEND_BITS (USBPORTSC_SUSP | USBPORTSC_RD)
38
39
40
41
42static int any_ports_active(struct uhci_hcd *uhci)
43{
44 int port;
45
46 for (port = 0; port < uhci->rh_numports; ++port) {
47 if ((uhci_readw(uhci, USBPORTSC1 + port * 2) &
48 (USBPORTSC_CCS | RWC_BITS)) ||
49 test_bit(port, &uhci->port_c_suspend))
50 return 1;
51 }
52 return 0;
53}
54
55static inline int get_hub_status_data(struct uhci_hcd *uhci, char *buf)
56{
57 int port;
58 int mask = RWC_BITS;
59
60
61
62
63
64
65
66 if (ignore_oc)
67 mask &= ~USBPORTSC_OCC;
68
69 *buf = 0;
70 for (port = 0; port < uhci->rh_numports; ++port) {
71 if ((uhci_readw(uhci, USBPORTSC1 + port * 2) & mask) ||
72 test_bit(port, &uhci->port_c_suspend))
73 *buf |= (1 << (port + 1));
74 }
75 return !!*buf;
76}
77
78#define OK(x) len = (x); break
79
80#define CLR_RH_PORTSTAT(x) \
81 status = uhci_readw(uhci, port_addr); \
82 status &= ~(RWC_BITS|WZ_BITS); \
83 status &= ~(x); \
84 status |= RWC_BITS & (x); \
85 uhci_writew(uhci, status, port_addr)
86
87#define SET_RH_PORTSTAT(x) \
88 status = uhci_readw(uhci, port_addr); \
89 status |= (x); \
90 status &= ~(RWC_BITS|WZ_BITS); \
91 uhci_writew(uhci, status, port_addr)
92
93
94
95
96static void uhci_finish_suspend(struct uhci_hcd *uhci, int port,
97 unsigned long port_addr)
98{
99 int status;
100 int i;
101
102 if (uhci_readw(uhci, port_addr) & SUSPEND_BITS) {
103 CLR_RH_PORTSTAT(SUSPEND_BITS);
104 if (test_bit(port, &uhci->resuming_ports))
105 set_bit(port, &uhci->port_c_suspend);
106
107
108
109
110
111
112 for (i = 0; i < 10; ++i) {
113 if (!(uhci_readw(uhci, port_addr) & SUSPEND_BITS))
114 break;
115 udelay(1);
116 }
117 }
118 clear_bit(port, &uhci->resuming_ports);
119}
120
121
122
123
124static void wait_for_HP(struct uhci_hcd *uhci, unsigned long port_addr)
125{
126 int i;
127
128 for (i = 10; i < 250; i += 10) {
129 if (uhci_readw(uhci, port_addr) & USBPORTSC_CSC)
130 return;
131 udelay(10);
132 }
133
134}
135
136static void uhci_check_ports(struct uhci_hcd *uhci)
137{
138 unsigned int port;
139 unsigned long port_addr;
140 int status;
141
142 for (port = 0; port < uhci->rh_numports; ++port) {
143 port_addr = USBPORTSC1 + 2 * port;
144 status = uhci_readw(uhci, port_addr);
145 if (unlikely(status & USBPORTSC_PR)) {
146 if (time_after_eq(jiffies, uhci->ports_timeout)) {
147 CLR_RH_PORTSTAT(USBPORTSC_PR);
148 udelay(10);
149
150
151
152 if (uhci->wait_for_hp)
153 wait_for_HP(uhci, port_addr);
154
155
156
157
158
159 CLR_RH_PORTSTAT(USBPORTSC_CSC | USBPORTSC_PEC);
160 SET_RH_PORTSTAT(USBPORTSC_PE);
161 }
162 }
163 if (unlikely(status & USBPORTSC_RD)) {
164 if (!test_bit(port, &uhci->resuming_ports)) {
165
166
167 set_bit(port, &uhci->resuming_ports);
168 uhci->ports_timeout = jiffies +
169 msecs_to_jiffies(25);
170
171
172
173 mod_timer(&uhci_to_hcd(uhci)->rh_timer,
174 uhci->ports_timeout);
175 } else if (time_after_eq(jiffies,
176 uhci->ports_timeout)) {
177 uhci_finish_suspend(uhci, port, port_addr);
178 }
179 }
180 }
181}
182
183static int uhci_hub_status_data(struct usb_hcd *hcd, char *buf)
184{
185 struct uhci_hcd *uhci = hcd_to_uhci(hcd);
186 unsigned long flags;
187 int status = 0;
188
189 spin_lock_irqsave(&uhci->lock, flags);
190
191 uhci_scan_schedule(uhci);
192 if (!HCD_HW_ACCESSIBLE(hcd) || uhci->dead)
193 goto done;
194 uhci_check_ports(uhci);
195
196 status = get_hub_status_data(uhci, buf);
197
198 switch (uhci->rh_state) {
199 case UHCI_RH_SUSPENDING:
200 case UHCI_RH_SUSPENDED:
201
202 if (status || uhci->resuming_ports)
203 usb_hcd_resume_root_hub(hcd);
204 break;
205
206 case UHCI_RH_AUTO_STOPPED:
207
208 if (status)
209 wakeup_rh(uhci);
210 break;
211
212 case UHCI_RH_RUNNING:
213
214 if (!any_ports_active(uhci)) {
215 uhci->rh_state = UHCI_RH_RUNNING_NODEVS;
216 uhci->auto_stop_time = jiffies + HZ;
217 }
218 break;
219
220 case UHCI_RH_RUNNING_NODEVS:
221
222 if (any_ports_active(uhci))
223 uhci->rh_state = UHCI_RH_RUNNING;
224 else if (time_after_eq(jiffies, uhci->auto_stop_time))
225 suspend_rh(uhci, UHCI_RH_AUTO_STOPPED);
226 break;
227
228 default:
229 break;
230 }
231
232done:
233 spin_unlock_irqrestore(&uhci->lock, flags);
234 return status;
235}
236
237
238static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
239 u16 wIndex, char *buf, u16 wLength)
240{
241 struct uhci_hcd *uhci = hcd_to_uhci(hcd);
242 int status, lstatus, retval = 0, len = 0;
243 unsigned int port = wIndex - 1;
244 unsigned long port_addr = USBPORTSC1 + 2 * port;
245 u16 wPortChange, wPortStatus;
246 unsigned long flags;
247
248 if (!HCD_HW_ACCESSIBLE(hcd) || uhci->dead)
249 return -ETIMEDOUT;
250
251 spin_lock_irqsave(&uhci->lock, flags);
252 switch (typeReq) {
253
254 case GetHubStatus:
255 *(__le32 *)buf = cpu_to_le32(0);
256 OK(4);
257 case GetPortStatus:
258 if (port >= uhci->rh_numports)
259 goto err;
260
261 uhci_check_ports(uhci);
262 status = uhci_readw(uhci, port_addr);
263
264
265
266
267
268 if (uhci->oc_low)
269 status ^= USBPORTSC_OC;
270
271
272 wPortChange = lstatus = 0;
273 if (status & USBPORTSC_CSC)
274 wPortChange |= USB_PORT_STAT_C_CONNECTION;
275 if (status & USBPORTSC_PEC)
276 wPortChange |= USB_PORT_STAT_C_ENABLE;
277 if ((status & USBPORTSC_OCC) && !ignore_oc)
278 wPortChange |= USB_PORT_STAT_C_OVERCURRENT;
279
280 if (test_bit(port, &uhci->port_c_suspend)) {
281 wPortChange |= USB_PORT_STAT_C_SUSPEND;
282 lstatus |= 1;
283 }
284 if (test_bit(port, &uhci->resuming_ports))
285 lstatus |= 4;
286
287
288 wPortStatus = USB_PORT_STAT_POWER;
289 if (status & USBPORTSC_CCS)
290 wPortStatus |= USB_PORT_STAT_CONNECTION;
291 if (status & USBPORTSC_PE) {
292 wPortStatus |= USB_PORT_STAT_ENABLE;
293 if (status & SUSPEND_BITS)
294 wPortStatus |= USB_PORT_STAT_SUSPEND;
295 }
296 if (status & USBPORTSC_OC)
297 wPortStatus |= USB_PORT_STAT_OVERCURRENT;
298 if (status & USBPORTSC_PR)
299 wPortStatus |= USB_PORT_STAT_RESET;
300 if (status & USBPORTSC_LSDA)
301 wPortStatus |= USB_PORT_STAT_LOW_SPEED;
302
303 if (wPortChange)
304 dev_dbg(uhci_dev(uhci), "port %d portsc %04x,%02x\n",
305 wIndex, status, lstatus);
306
307 *(__le16 *)buf = cpu_to_le16(wPortStatus);
308 *(__le16 *)(buf + 2) = cpu_to_le16(wPortChange);
309 OK(4);
310 case SetHubFeature:
311 case ClearHubFeature:
312 switch (wValue) {
313 case C_HUB_OVER_CURRENT:
314 case C_HUB_LOCAL_POWER:
315 OK(0);
316 default:
317 goto err;
318 }
319 break;
320 case SetPortFeature:
321 if (port >= uhci->rh_numports)
322 goto err;
323
324 switch (wValue) {
325 case USB_PORT_FEAT_SUSPEND:
326 SET_RH_PORTSTAT(USBPORTSC_SUSP);
327 OK(0);
328 case USB_PORT_FEAT_RESET:
329 SET_RH_PORTSTAT(USBPORTSC_PR);
330
331
332 uhci_finish_suspend(uhci, port, port_addr);
333
334
335 uhci->ports_timeout = jiffies + msecs_to_jiffies(50);
336 OK(0);
337 case USB_PORT_FEAT_POWER:
338
339 OK(0);
340 default:
341 goto err;
342 }
343 break;
344 case ClearPortFeature:
345 if (port >= uhci->rh_numports)
346 goto err;
347
348 switch (wValue) {
349 case USB_PORT_FEAT_ENABLE:
350 CLR_RH_PORTSTAT(USBPORTSC_PE);
351
352
353 uhci_finish_suspend(uhci, port, port_addr);
354 OK(0);
355 case USB_PORT_FEAT_C_ENABLE:
356 CLR_RH_PORTSTAT(USBPORTSC_PEC);
357 OK(0);
358 case USB_PORT_FEAT_SUSPEND:
359 if (!(uhci_readw(uhci, port_addr) & USBPORTSC_SUSP)) {
360
361
362 uhci_finish_suspend(uhci, port, port_addr);
363 } else if (!test_and_set_bit(port,
364 &uhci->resuming_ports)) {
365 SET_RH_PORTSTAT(USBPORTSC_RD);
366
367
368
369
370
371 if (!(uhci_readw(uhci, port_addr) &
372 USBPORTSC_RD))
373 uhci_finish_suspend(uhci, port,
374 port_addr);
375 else
376
377 uhci->ports_timeout = jiffies +
378 msecs_to_jiffies(20);
379 }
380 OK(0);
381 case USB_PORT_FEAT_C_SUSPEND:
382 clear_bit(port, &uhci->port_c_suspend);
383 OK(0);
384 case USB_PORT_FEAT_POWER:
385
386 goto err;
387 case USB_PORT_FEAT_C_CONNECTION:
388 CLR_RH_PORTSTAT(USBPORTSC_CSC);
389 OK(0);
390 case USB_PORT_FEAT_C_OVER_CURRENT:
391 CLR_RH_PORTSTAT(USBPORTSC_OCC);
392 OK(0);
393 case USB_PORT_FEAT_C_RESET:
394
395 OK(0);
396 default:
397 goto err;
398 }
399 break;
400 case GetHubDescriptor:
401 len = min_t(unsigned int, sizeof(root_hub_hub_des), wLength);
402 memcpy(buf, root_hub_hub_des, len);
403 if (len > 2)
404 buf[2] = uhci->rh_numports;
405 OK(len);
406 default:
407err:
408 retval = -EPIPE;
409 }
410 spin_unlock_irqrestore(&uhci->lock, flags);
411
412 return retval;
413}
414