e08da6130bd5ca7d53f71c688c4250d41aad79ee
[oweals/u-boot.git] / drivers / usb / host / sl811-hcd.c
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * (C) Copyright 2004
4  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5  *
6  * This code is based on linux driver for sl811hs chip, source at
7  * drivers/usb/host/sl811.c:
8  *
9  * SL811 Host Controller Interface driver for USB.
10  *
11  * Copyright (c) 2003/06, Courage Co., Ltd.
12  *
13  * Based on:
14  *      1.uhci.c by Linus Torvalds, Johannes Erdfelt, Randy Dunlap,
15  *        Georg Acher, Deti Fliegl, Thomas Sailer, Roman Weissgaerber,
16  *        Adam Richter, Gregory P. Smith;
17  *      2.Original SL811 driver (hc_sl811.o) by Pei Liu <pbl@cypress.com>
18  *      3.Rewrited as sl811.o by Yin Aihua <yinah:couragetech.com.cn>
19  */
20
21 #include <common.h>
22 #include <mpc8xx.h>
23 #include <usb.h>
24 #include "sl811.h"
25
26 #include "../../../board/kup/common/kup.h"
27
28 #ifdef __PPC__
29 # define EIEIO          __asm__ volatile ("eieio")
30 #else
31 # define EIEIO          /* nothing */
32 #endif
33
34 #define  SL811_ADR (0x50000000)
35 #define  SL811_DAT (0x50000001)
36
37 #ifdef SL811_DEBUG
38 static int debug = 9;
39 #endif
40
41 static int root_hub_devnum = 0;
42 static struct usb_port_status rh_status = { 0 };/* root hub port status */
43
44 static int sl811_rh_submit_urb(struct usb_device *usb_dev, unsigned long pipe,
45                                void *data, int buf_len, struct devrequest *cmd);
46
47 static void sl811_write (__u8 index, __u8 data)
48 {
49         *(volatile unsigned char *) (SL811_ADR) = index;
50         EIEIO;
51         *(volatile unsigned char *) (SL811_DAT) = data;
52         EIEIO;
53 }
54
55 static __u8 sl811_read (__u8 index)
56 {
57         __u8 data;
58
59         *(volatile unsigned char *) (SL811_ADR) = index;
60         EIEIO;
61         data = *(volatile unsigned char *) (SL811_DAT);
62         EIEIO;
63         return (data);
64 }
65
66 /*
67  * Read consecutive bytes of data from the SL811H/SL11H buffer
68  */
69 static void inline sl811_read_buf(__u8 offset, __u8 *buf, __u8 size)
70 {
71         *(volatile unsigned char *) (SL811_ADR) = offset;
72         EIEIO;
73         while (size--) {
74                 *buf++ = *(volatile unsigned char *) (SL811_DAT);
75                 EIEIO;
76         }
77 }
78
79 /*
80  * Write consecutive bytes of data to the SL811H/SL11H buffer
81  */
82 static void inline sl811_write_buf(__u8 offset, __u8 *buf, __u8 size)
83 {
84         *(volatile unsigned char *) (SL811_ADR) = offset;
85         EIEIO;
86         while (size--) {
87                 *(volatile unsigned char *) (SL811_DAT) = *buf++;
88                 EIEIO;
89         }
90 }
91
92 int usb_init_kup4x (void)
93 {
94         volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
95         volatile memctl8xx_t *memctl = &immap->im_memctl;
96         int i;
97         unsigned char tmp;
98
99         memctl = &immap->im_memctl;
100         memctl->memc_or7 = 0xFFFF8726;
101         memctl->memc_br7 = 0x50000401;  /* start at 0x50000000 */
102         /* BP 14 low = USB ON */
103         immap->im_cpm.cp_pbdat &= ~(BP_USB_VCC);
104         /* PB 14 nomal port */
105         immap->im_cpm.cp_pbpar &= ~(BP_USB_VCC);
106         /* output */
107         immap->im_cpm.cp_pbdir |= (BP_USB_VCC);
108
109         puts ("USB:   ");
110
111         for (i = 0x10; i < 0xff; i++) {
112                 sl811_write(i, i);
113                 tmp = (sl811_read(i));
114                 if (tmp != i) {
115                         printf ("SL811 compare error index=0x%02x read=0x%02x\n", i, tmp);
116                         return (-1);
117                 }
118         }
119         printf ("SL811 ready\n");
120         return (0);
121 }
122
123 /*
124  * This function resets SL811HS controller and detects the speed of
125  * the connecting device
126  *
127  * Return: 0 = no device attached; 1 = USB device attached
128  */
129 static int sl811_hc_reset(void)
130 {
131         int status ;
132
133         sl811_write(SL811_CTRL2, SL811_CTL2_HOST | SL811_12M_HI);
134         sl811_write(SL811_CTRL1, SL811_CTRL1_RESET);
135
136         mdelay(20);
137
138         /* Disable hardware SOF generation, clear all irq status. */
139         sl811_write(SL811_CTRL1, 0);
140         mdelay(2);
141         sl811_write(SL811_INTRSTS, 0xff);
142         status = sl811_read(SL811_INTRSTS);
143
144         if (status & SL811_INTR_NOTPRESENT) {
145                 /* Device is not present */
146                 PDEBUG(0, "Device not present\n");
147                 rh_status.wPortStatus &= ~(USB_PORT_STAT_CONNECTION | USB_PORT_STAT_ENABLE);
148                 rh_status.wPortChange |= USB_PORT_STAT_C_CONNECTION;
149                 sl811_write(SL811_INTR, SL811_INTR_INSRMV);
150                 return 0;
151         }
152
153         /* Send SOF to address 0, endpoint 0. */
154         sl811_write(SL811_LEN_B, 0);
155         sl811_write(SL811_PIDEP_B, PIDEP(USB_PID_SOF, 0));
156         sl811_write(SL811_DEV_B, 0x00);
157         sl811_write(SL811_SOFLOW, SL811_12M_LOW);
158
159         if (status & SL811_INTR_SPEED_FULL) {
160                 /* full speed device connect directly to root hub */
161                 PDEBUG (0, "Full speed Device attached\n");
162
163                 sl811_write(SL811_CTRL1, SL811_CTRL1_RESET);
164                 mdelay(20);
165                 sl811_write(SL811_CTRL2, SL811_CTL2_HOST | SL811_12M_HI);
166                 sl811_write(SL811_CTRL1, SL811_CTRL1_SOF);
167
168                 /* start the SOF or EOP */
169                 sl811_write(SL811_CTRL_B, SL811_USB_CTRL_ARM);
170                 rh_status.wPortStatus |= USB_PORT_STAT_CONNECTION;
171                 rh_status.wPortStatus &= ~USB_PORT_STAT_LOW_SPEED;
172                 mdelay(2);
173                 sl811_write(SL811_INTRSTS, 0xff);
174         } else {
175                 /* slow speed device connect directly to root-hub */
176                 PDEBUG(0, "Low speed Device attached\n");
177
178                 sl811_write(SL811_CTRL1, SL811_CTRL1_RESET);
179                 mdelay(20);
180                 sl811_write(SL811_CTRL2, SL811_CTL2_HOST | SL811_CTL2_DSWAP | SL811_12M_HI);
181                 sl811_write(SL811_CTRL1, SL811_CTRL1_SPEED_LOW | SL811_CTRL1_SOF);
182
183                 /* start the SOF or EOP */
184                 sl811_write(SL811_CTRL_B, SL811_USB_CTRL_ARM);
185                 rh_status.wPortStatus |= USB_PORT_STAT_CONNECTION | USB_PORT_STAT_LOW_SPEED;
186                 mdelay(2);
187                 sl811_write(SL811_INTRSTS, 0xff);
188         }
189
190         rh_status.wPortChange |= USB_PORT_STAT_C_CONNECTION;
191         sl811_write(SL811_INTR, /*SL811_INTR_INSRMV*/SL811_INTR_DONE_A);
192
193         return 1;
194 }
195
196 int usb_lowlevel_init(int index, enum usb_init_type init, void **controller)
197 {
198         root_hub_devnum = 0;
199         sl811_hc_reset();
200         return 0;
201 }
202
203 int usb_lowlevel_stop(int index)
204 {
205         sl811_hc_reset();
206         return 0;
207 }
208
209 static int calc_needed_buswidth(int bytes, int need_preamble)
210 {
211         return !need_preamble ? bytes * 8 + 256 : 8 * 8 * bytes + 2048;
212 }
213
214 static int sl811_send_packet(struct usb_device *dev, unsigned long pipe, __u8 *buffer, int len)
215 {
216         __u8 ctrl = SL811_USB_CTRL_ARM | SL811_USB_CTRL_ENABLE;
217         __u16 status = 0;
218         int err = 0, time_start = get_timer(0);
219         int need_preamble = !(rh_status.wPortStatus & USB_PORT_STAT_LOW_SPEED) &&
220                 (dev->speed == USB_SPEED_LOW);
221
222         if (len > 239)
223                 return -1;
224
225         if (usb_pipeout(pipe))
226                 ctrl |= SL811_USB_CTRL_DIR_OUT;
227         if (usb_gettoggle(dev, usb_pipeendpoint(pipe), usb_pipeout(pipe)))
228                 ctrl |= SL811_USB_CTRL_TOGGLE_1;
229         if (need_preamble)
230                 ctrl |= SL811_USB_CTRL_PREAMBLE;
231
232         sl811_write(SL811_INTRSTS, 0xff);
233
234         while (err < 3) {
235                 sl811_write(SL811_ADDR_A, 0x10);
236                 sl811_write(SL811_LEN_A, len);
237                 if (usb_pipeout(pipe) && len)
238                         sl811_write_buf(0x10, buffer, len);
239
240                 if (!(rh_status.wPortStatus & USB_PORT_STAT_LOW_SPEED) &&
241                     sl811_read(SL811_SOFCNTDIV)*64 < calc_needed_buswidth(len, need_preamble))
242                         ctrl |= SL811_USB_CTRL_SOF;
243                 else
244                         ctrl &= ~SL811_USB_CTRL_SOF;
245
246                 sl811_write(SL811_CTRL_A, ctrl);
247                 while (!(sl811_read(SL811_INTRSTS) & SL811_INTR_DONE_A)) {
248                         if (5*CONFIG_SYS_HZ < get_timer(time_start)) {
249                                 printf("USB transmit timed out\n");
250                                 return -USB_ST_CRC_ERR;
251                         }
252                 }
253
254                 sl811_write(SL811_INTRSTS, 0xff);
255                 status = sl811_read(SL811_STS_A);
256
257                 if (status & SL811_USB_STS_ACK) {
258                         int remainder = sl811_read(SL811_CNT_A);
259                         if (remainder) {
260                                 PDEBUG(0, "usb transfer remainder = %d\n", remainder);
261                                 len -= remainder;
262                         }
263                         if (usb_pipein(pipe) && len)
264                                 sl811_read_buf(0x10, buffer, len);
265                         return len;
266                 }
267
268                 if ((status & SL811_USB_STS_NAK) == SL811_USB_STS_NAK)
269                         continue;
270
271                 PDEBUG(0, "usb transfer error %#x\n", (int)status);
272                 err++;
273         }
274
275         err = 0;
276
277         if (status & SL811_USB_STS_ERROR)
278                 err |= USB_ST_BUF_ERR;
279         if (status & SL811_USB_STS_TIMEOUT)
280                 err |= USB_ST_CRC_ERR;
281         if (status & SL811_USB_STS_STALL)
282                 err |= USB_ST_STALLED;
283
284         return -err;
285 }
286
287 int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
288                     int len)
289 {
290         int dir_out = usb_pipeout(pipe);
291         int ep = usb_pipeendpoint(pipe);
292         int max = usb_maxpacket(dev, pipe);
293         int done = 0;
294
295         PDEBUG(7, "dev = %ld pipe = %ld buf = %p size = %d dir_out = %d\n",
296                usb_pipedevice(pipe), usb_pipeendpoint(pipe), buffer, len, dir_out);
297
298         dev->status = 0;
299
300         sl811_write(SL811_DEV_A, usb_pipedevice(pipe));
301         sl811_write(SL811_PIDEP_A, PIDEP(!dir_out ? USB_PID_IN : USB_PID_OUT, ep));
302         while (done < len) {
303                 int res = sl811_send_packet(dev, pipe, (__u8*)buffer+done,
304                                             max > len - done ? len - done : max);
305                 if (res < 0) {
306                         dev->status = -res;
307                         return res;
308                 }
309
310                 if (!dir_out && res < max) /* short packet */
311                         break;
312
313                 done += res;
314                 usb_dotoggle(dev, ep, dir_out);
315         }
316
317         dev->act_len = done;
318
319         return 0;
320 }
321
322 int submit_control_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
323                        int len,struct devrequest *setup)
324 {
325         int done = 0;
326         int devnum = usb_pipedevice(pipe);
327         int ep = usb_pipeendpoint(pipe);
328
329         dev->status = 0;
330
331         if (devnum == root_hub_devnum)
332                 return sl811_rh_submit_urb(dev, pipe, buffer, len, setup);
333
334         PDEBUG(7, "dev = %d pipe = %ld buf = %p size = %d rt = %#x req = %#x bus = %i\n",
335                devnum, ep, buffer, len, (int)setup->requesttype,
336                (int)setup->request, sl811_read(SL811_SOFCNTDIV)*64);
337
338         sl811_write(SL811_DEV_A, devnum);
339         sl811_write(SL811_PIDEP_A, PIDEP(USB_PID_SETUP, ep));
340         /* setup phase */
341         usb_settoggle(dev, ep, 1, 0);
342         if (sl811_send_packet(dev, usb_sndctrlpipe(dev, ep),
343                               (__u8*)setup, sizeof(*setup)) == sizeof(*setup)) {
344                 int dir_in = usb_pipein(pipe);
345                 int max = usb_maxpacket(dev, pipe);
346
347                 /* data phase */
348                 sl811_write(SL811_PIDEP_A,
349                             PIDEP(dir_in ? USB_PID_IN : USB_PID_OUT, ep));
350                 usb_settoggle(dev, ep, usb_pipeout(pipe), 1);
351                 while (done < len) {
352                         int res = sl811_send_packet(dev, pipe, (__u8*)buffer+done,
353                                                     max > len - done ? len - done : max);
354                         if (res < 0) {
355                                 PDEBUG(0, "status data failed!\n");
356                                 dev->status = -res;
357                                 return 0;
358                         }
359                         done += res;
360                         usb_dotoggle(dev, ep, usb_pipeout(pipe));
361                         if (dir_in && res < max) /* short packet */
362                                 break;
363                 }
364
365                 /* status phase */
366                 sl811_write(SL811_PIDEP_A,
367                             PIDEP(!dir_in ? USB_PID_IN : USB_PID_OUT, ep));
368                 usb_settoggle(dev, ep, !usb_pipeout(pipe), 1);
369                 if (sl811_send_packet(dev,
370                                       !dir_in ? usb_rcvctrlpipe(dev, ep) :
371                                       usb_sndctrlpipe(dev, ep),
372                                       0, 0) < 0) {
373                         PDEBUG(0, "status phase failed!\n");
374                         dev->status = -1;
375                 }
376         } else {
377                 PDEBUG(0, "setup phase failed!\n");
378                 dev->status = -1;
379         }
380
381         dev->act_len = done;
382
383         return done;
384 }
385
386 int submit_int_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
387                    int len, int interval, bool nonblock)
388 {
389         PDEBUG(0, "dev = %p pipe = %#lx buf = %p size = %d int = %d\n", dev, pipe,
390                buffer, len, interval);
391         return -1;
392 }
393
394 /*
395  * SL811 Virtual Root Hub
396  */
397
398 /* Device descriptor */
399 static __u8 sl811_rh_dev_des[] =
400 {
401         0x12,       /*  __u8  bLength; */
402         0x01,       /*  __u8  bDescriptorType; Device */
403         0x10,       /*  __u16 bcdUSB; v1.1 */
404         0x01,
405         0x09,       /*  __u8  bDeviceClass; HUB_CLASSCODE */
406         0x00,       /*  __u8  bDeviceSubClass; */
407         0x00,       /*  __u8  bDeviceProtocol; */
408         0x08,       /*  __u8  bMaxPacketSize0; 8 Bytes */
409         0x00,       /*  __u16 idVendor; */
410         0x00,
411         0x00,       /*  __u16 idProduct; */
412         0x00,
413         0x00,       /*  __u16 bcdDevice; */
414         0x00,
415         0x00,       /*  __u8  iManufacturer; */
416         0x02,       /*  __u8  iProduct; */
417         0x01,       /*  __u8  iSerialNumber; */
418         0x01        /*  __u8  bNumConfigurations; */
419 };
420
421 /* Configuration descriptor */
422 static __u8 sl811_rh_config_des[] =
423 {
424         0x09,       /*  __u8  bLength; */
425         0x02,       /*  __u8  bDescriptorType; Configuration */
426         0x19,       /*  __u16 wTotalLength; */
427         0x00,
428         0x01,       /*  __u8  bNumInterfaces; */
429         0x01,       /*  __u8  bConfigurationValue; */
430         0x00,       /*  __u8  iConfiguration; */
431         0x40,       /*  __u8  bmAttributes;
432                     Bit 7: Bus-powered, 6: Self-powered, 5 Remote-wakwup,
433                     4..0: resvd */
434         0x00,       /*  __u8  MaxPower; */
435
436         /* interface */
437         0x09,       /*  __u8  if_bLength; */
438         0x04,       /*  __u8  if_bDescriptorType; Interface */
439         0x00,       /*  __u8  if_bInterfaceNumber; */
440         0x00,       /*  __u8  if_bAlternateSetting; */
441         0x01,       /*  __u8  if_bNumEndpoints; */
442         0x09,       /*  __u8  if_bInterfaceClass; HUB_CLASSCODE */
443         0x00,       /*  __u8  if_bInterfaceSubClass; */
444         0x00,       /*  __u8  if_bInterfaceProtocol; */
445         0x00,       /*  __u8  if_iInterface; */
446
447         /* endpoint */
448         0x07,       /*  __u8  ep_bLength; */
449         0x05,       /*  __u8  ep_bDescriptorType; Endpoint */
450         0x81,       /*  __u8  ep_bEndpointAddress; IN Endpoint 1 */
451         0x03,       /*  __u8  ep_bmAttributes; Interrupt */
452         0x08,       /*  __u16 ep_wMaxPacketSize; */
453         0x00,
454         0xff        /*  __u8  ep_bInterval; 255 ms */
455 };
456
457 /* root hub class descriptor*/
458 static __u8 sl811_rh_hub_des[] =
459 {
460         0x09,                   /*  __u8  bLength; */
461         0x29,                   /*  __u8  bDescriptorType; Hub-descriptor */
462         0x01,                   /*  __u8  bNbrPorts; */
463         0x00,                   /* __u16  wHubCharacteristics; */
464         0x00,
465         0x50,                   /*  __u8  bPwrOn2pwrGood; 2ms */
466         0x00,                   /*  __u8  bHubContrCurrent; 0 mA */
467         0xfc,                   /*  __u8  DeviceRemovable; *** 7 Ports max *** */
468         0xff                    /*  __u8  PortPwrCtrlMask; *** 7 ports max *** */
469 };
470
471 /*
472  * helper routine for returning string descriptors in UTF-16LE
473  * input can actually be ISO-8859-1; ASCII is its 7-bit subset
474  */
475 static int ascii2utf (char *s, u8 *utf, int utfmax)
476 {
477         int retval;
478
479         for (retval = 0; *s && utfmax > 1; utfmax -= 2, retval += 2) {
480                 *utf++ = *s++;
481                 *utf++ = 0;
482         }
483         return retval;
484 }
485
486 /*
487  * root_hub_string is used by each host controller's root hub code,
488  * so that they're identified consistently throughout the system.
489  */
490 static int usb_root_hub_string (int id, int serial, char *type, __u8 *data, int len)
491 {
492         char buf [30];
493
494         /* assert (len > (2 * (sizeof (buf) + 1)));
495            assert (strlen (type) <= 8);*/
496
497         /* language ids */
498         if (id == 0) {
499                 *data++ = 4; *data++ = 3;       /* 4 bytes data */
500                 *data++ = 0; *data++ = 0;       /* some language id */
501                 return 4;
502
503         /* serial number */
504         } else if (id == 1) {
505                 sprintf (buf, "%#x", serial);
506
507         /* product description */
508         } else if (id == 2) {
509                 sprintf (buf, "USB %s Root Hub", type);
510
511         /* id 3 == vendor description */
512
513         /* unsupported IDs --> "stall" */
514         } else
515             return 0;
516
517         ascii2utf (buf, data + 2, len - 2);
518         data [0] = 2 + strlen(buf) * 2;
519         data [1] = 3;
520         return data [0];
521 }
522
523 /* helper macro */
524 #define OK(x)   len = (x); break
525
526 /*
527  * This function handles all USB request to the the virtual root hub
528  */
529 static int sl811_rh_submit_urb(struct usb_device *usb_dev, unsigned long pipe,
530                                void *data, int buf_len, struct devrequest *cmd)
531 {
532         __u8 data_buf[16];
533         __u8 *bufp = data_buf;
534         int len = 0;
535         int status = 0;
536         __u16 bmRType_bReq;
537         __u16 wValue  = le16_to_cpu (cmd->value);
538         __u16 wLength = le16_to_cpu (cmd->length);
539 #ifdef SL811_DEBUG
540         __u16 wIndex  = le16_to_cpu (cmd->index);
541 #endif
542
543         if (usb_pipeint(pipe)) {
544                 PDEBUG(0, "interrupt transfer unimplemented!\n");
545                 return 0;
546         }
547
548         bmRType_bReq  = cmd->requesttype | (cmd->request << 8);
549
550         PDEBUG(5, "submit rh urb, req = %d(%x) val = %#x index = %#x len=%d\n",
551                bmRType_bReq, bmRType_bReq, wValue, wIndex, wLength);
552
553         /* Request Destination:
554                    without flags: Device,
555                    USB_RECIP_INTERFACE: interface,
556                    USB_RECIP_ENDPOINT: endpoint,
557                    USB_TYPE_CLASS means HUB here,
558                    USB_RECIP_OTHER | USB_TYPE_CLASS  almost ever means HUB_PORT here
559         */
560         switch (bmRType_bReq) {
561         case RH_GET_STATUS:
562                 *(__u16 *)bufp = cpu_to_le16(1);
563                 OK(2);
564
565         case RH_GET_STATUS | USB_RECIP_INTERFACE:
566                 *(__u16 *)bufp = cpu_to_le16(0);
567                 OK(2);
568
569         case RH_GET_STATUS | USB_RECIP_ENDPOINT:
570                 *(__u16 *)bufp = cpu_to_le16(0);
571                 OK(2);
572
573         case RH_GET_STATUS | USB_TYPE_CLASS:
574                 *(__u32 *)bufp = cpu_to_le32(0);
575                 OK(4);
576
577         case RH_GET_STATUS | USB_RECIP_OTHER | USB_TYPE_CLASS:
578                 *(__u32 *)bufp = cpu_to_le32(rh_status.wPortChange<<16 | rh_status.wPortStatus);
579                 OK(4);
580
581         case RH_CLEAR_FEATURE | USB_RECIP_ENDPOINT:
582                 switch (wValue) {
583                 case 1:
584                         OK(0);
585                 }
586                 break;
587
588         case RH_CLEAR_FEATURE | USB_TYPE_CLASS:
589                 switch (wValue) {
590                 case C_HUB_LOCAL_POWER:
591                         OK(0);
592
593                 case C_HUB_OVER_CURRENT:
594                         OK(0);
595                 }
596                 break;
597
598         case RH_CLEAR_FEATURE | USB_RECIP_OTHER | USB_TYPE_CLASS:
599                 switch (wValue) {
600                 case USB_PORT_FEAT_ENABLE:
601                         rh_status.wPortStatus &= ~USB_PORT_STAT_ENABLE;
602                         OK(0);
603
604                 case USB_PORT_FEAT_SUSPEND:
605                         rh_status.wPortStatus &= ~USB_PORT_STAT_SUSPEND;
606                         OK(0);
607
608                 case USB_PORT_FEAT_POWER:
609                         rh_status.wPortStatus &= ~USB_PORT_STAT_POWER;
610                         OK(0);
611
612                 case USB_PORT_FEAT_C_CONNECTION:
613                         rh_status.wPortChange &= ~USB_PORT_STAT_C_CONNECTION;
614                         OK(0);
615
616                 case USB_PORT_FEAT_C_ENABLE:
617                         rh_status.wPortChange &= ~USB_PORT_STAT_C_ENABLE;
618                         OK(0);
619
620                 case USB_PORT_FEAT_C_SUSPEND:
621                         rh_status.wPortChange &= ~USB_PORT_STAT_C_SUSPEND;
622                         OK(0);
623
624                 case USB_PORT_FEAT_C_OVER_CURRENT:
625                         rh_status.wPortChange &= ~USB_PORT_STAT_C_OVERCURRENT;
626                         OK(0);
627
628                 case USB_PORT_FEAT_C_RESET:
629                         rh_status.wPortChange &= ~USB_PORT_STAT_C_RESET;
630                         OK(0);
631                 }
632                 break;
633
634         case RH_SET_FEATURE | USB_RECIP_OTHER | USB_TYPE_CLASS:
635                 switch (wValue) {
636                 case USB_PORT_FEAT_SUSPEND:
637                         rh_status.wPortStatus |= USB_PORT_STAT_SUSPEND;
638                         OK(0);
639
640                 case USB_PORT_FEAT_RESET:
641                         rh_status.wPortStatus |= USB_PORT_STAT_RESET;
642                         rh_status.wPortChange = 0;
643                         rh_status.wPortChange |= USB_PORT_STAT_C_RESET;
644                         rh_status.wPortStatus &= ~USB_PORT_STAT_RESET;
645                         rh_status.wPortStatus |= USB_PORT_STAT_ENABLE;
646                         OK(0);
647
648                 case USB_PORT_FEAT_POWER:
649                         rh_status.wPortStatus |= USB_PORT_STAT_POWER;
650                         OK(0);
651
652                 case USB_PORT_FEAT_ENABLE:
653                         rh_status.wPortStatus |= USB_PORT_STAT_ENABLE;
654                         OK(0);
655                 }
656                 break;
657
658         case RH_SET_ADDRESS:
659                 root_hub_devnum = wValue;
660                 OK(0);
661
662         case RH_GET_DESCRIPTOR:
663                 switch ((wValue & 0xff00) >> 8) {
664                 case USB_DT_DEVICE:
665                         len = sizeof(sl811_rh_dev_des);
666                         bufp = sl811_rh_dev_des;
667                         OK(len);
668
669                 case USB_DT_CONFIG:
670                         len = sizeof(sl811_rh_config_des);
671                         bufp = sl811_rh_config_des;
672                         OK(len);
673
674                 case USB_DT_STRING:
675                         len = usb_root_hub_string(wValue & 0xff, (int)(long)0,  "SL811HS", data, wLength);
676                         if (len > 0) {
677                                 bufp = data;
678                                 OK(len);
679                         }
680
681                 default:
682                         status = -32;
683                 }
684                 break;
685
686         case RH_GET_DESCRIPTOR | USB_TYPE_CLASS:
687                 len = sizeof(sl811_rh_hub_des);
688                 bufp = sl811_rh_hub_des;
689                 OK(len);
690
691         case RH_GET_CONFIGURATION:
692                 bufp[0] = 0x01;
693                 OK(1);
694
695         case RH_SET_CONFIGURATION:
696                 OK(0);
697
698         default:
699                 PDEBUG(1, "unsupported root hub command\n");
700                 status = -32;
701         }
702
703         len = min(len, buf_len);
704         if (data != bufp)
705                 memcpy(data, bufp, len);
706
707         PDEBUG(5, "len = %d, status = %d\n", len, status);
708
709         usb_dev->status = status;
710         usb_dev->act_len = len;
711
712         return status == 0 ? len : status;
713 }