drivers/usb/host/r8a66597-hcd.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * R8A66597 HCD (Host Controller Driver) for u-boot
   4  *
   5  * Copyright (C) 2008  Yoshihiro Shimoda <shimoda.yoshihiro@renesas.com>
   6  */
   7
   8 #include <common.h>
   9 #include <console.h>
  10 #include <usb.h>
  11 #include <asm/io.h>
  12 #include <linux/iopoll.h>
  13
  14 #include "r8a66597.h"
  15
  16 #ifdef R8A66597_DEBUG
  17 #define R8A66597_DPRINT         printf
  18 #else
  19 #define R8A66597_DPRINT(...)
  20 #endif
  21
  22 static struct r8a66597 gr8a66597;
  23
  24 static void get_hub_data(struct usb_device *dev, u16 *hub_devnum, u16 *hubport)
  25 {
  26         int i;
  27
  28         *hub_devnum = 0;
  29         *hubport = 0;
  30
  31         /* check a device connected to root_hub */
  32         if ((dev->parent && dev->parent->devnum == 1) ||
  33             (dev->devnum == 1))
  34                 return;
  35
  36         for (i = 0; i < USB_MAXCHILDREN; i++) {
  37                 if (dev->parent->children[i] == dev) {
  38                         *hub_devnum = (u8)dev->parent->devnum;
  39                         *hubport = i;
  40                         return;
  41                 }
  42         }
  43
  44         printf("get_hub_data error.\n");
  45 }
  46
  47 static void set_devadd(struct r8a66597 *r8a66597, u8 r8a66597_address,
  48                         struct usb_device *dev, int port)
  49 {
  50         u16 val, usbspd, upphub, hubport;
  51         unsigned long devadd_reg = get_devadd_addr(r8a66597_address);
  52
  53         get_hub_data(dev, &upphub, &hubport);
  54         usbspd = r8a66597->speed;
  55         val = (upphub << 11) | (hubport << 8) | (usbspd << 6) | (port & 0x0001);
  56         r8a66597_write(r8a66597, val, devadd_reg);
  57 }
  58
  59 static int r8a66597_clock_enable(struct r8a66597 *r8a66597)
  60 {
  61         u16 tmp;
  62         int i = 0;
  63
  64 #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597)
  65         do {
  66                 r8a66597_write(r8a66597, SCKE, SYSCFG0);
  67                 tmp = r8a66597_read(r8a66597, SYSCFG0);
  68                 if (i++ > 1000) {
  69                         printf("register access fail.\n");
  70                         return -1;
  71                 }
  72         } while ((tmp & SCKE) != SCKE);
  73         r8a66597_write(r8a66597, 0x04, 0x02);
  74 #else
  75         do {
  76                 r8a66597_write(r8a66597, USBE, SYSCFG0);
  77                 tmp = r8a66597_read(r8a66597, SYSCFG0);
  78                 if (i++ > 1000) {
  79                         printf("register access fail.\n");
  80                         return -1;
  81                 }
  82         } while ((tmp & USBE) != USBE);
  83         r8a66597_bclr(r8a66597, USBE, SYSCFG0);
  84 #if !defined(CONFIG_RZA_USB)
  85         r8a66597_mdfy(r8a66597, CONFIG_R8A66597_XTAL, XTAL, SYSCFG0);
  86
  87         i = 0;
  88         r8a66597_bset(r8a66597, XCKE, SYSCFG0);
  89         do {
  90                 udelay(1000);
  91                 tmp = r8a66597_read(r8a66597, SYSCFG0);
  92                 if (i++ > 500) {
  93                         printf("register access fail.\n");
  94                         return -1;
  95                 }
  96         } while ((tmp & SCKE) != SCKE);
  97 #else
  98         /*
  99          * RZ/A Only:
 100          * Bits XTAL(UCKSEL) and UPLLE in SYSCFG0 for USB0 controls both USB0
 101          * and USB1, so we must always set the USB0 register
 102          */
 103 #if (CONFIG_R8A66597_XTAL == 1)
 104         setbits(le16, R8A66597_BASE0, XTAL);
 105 #endif
 106         mdelay(1);
 107         setbits(le16, R8A66597_BASE0, UPLLE);
 108         mdelay(1);
 109         r8a66597_bset(r8a66597, SUSPM, SUSPMODE0);
 110 #endif /* CONFIG_RZA_USB */
 111 #endif  /* #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) */
 112
 113         return 0;
 114 }
 115
 116 static void r8a66597_clock_disable(struct r8a66597 *r8a66597)
 117 {
 118 #if !defined(CONFIG_RZA_USB)
 119         r8a66597_bclr(r8a66597, SCKE, SYSCFG0);
 120         udelay(1);
 121 #if !defined(CONFIG_SUPERH_ON_CHIP_R8A66597)
 122         r8a66597_bclr(r8a66597, PLLC, SYSCFG0);
 123         r8a66597_bclr(r8a66597, XCKE, SYSCFG0);
 124         r8a66597_bclr(r8a66597, USBE, SYSCFG0);
 125 #endif
 126 #else
 127         r8a66597_bclr(r8a66597, SUSPM, SUSPMODE0);
 128
 129         clrbits(le16, R8A66597_BASE0, UPLLE);
 130         mdelay(1);
 131         r8a66597_bclr(r8a66597, USBE, SYSCFG0);
 132         mdelay(1);
 133
 134 #endif
 135 }
 136
 137 static void r8a66597_enable_port(struct r8a66597 *r8a66597, int port)
 138 {
 139         u16 val;
 140
 141         val = port ? DRPD : DCFM | DRPD;
 142         r8a66597_bset(r8a66597, val, get_syscfg_reg(port));
 143         r8a66597_bset(r8a66597, HSE, get_syscfg_reg(port));
 144
 145 #if !defined(CONFIG_RZA_USB)
 146         r8a66597_write(r8a66597, BURST | CPU_ADR_RD_WR, get_dmacfg_reg(port));
 147 #endif
 148 }
 149
 150 static void r8a66597_disable_port(struct r8a66597 *r8a66597, int port)
 151 {
 152         u16 val, tmp;
 153
 154         r8a66597_write(r8a66597, 0, get_intenb_reg(port));
 155         r8a66597_write(r8a66597, 0, get_intsts_reg(port));
 156
 157         r8a66597_port_power(r8a66597, port, 0);
 158
 159         do {
 160                 tmp = r8a66597_read(r8a66597, SOFCFG) & EDGESTS;
 161                 udelay(640);
 162         } while (tmp == EDGESTS);
 163
 164         val = port ? DRPD : DCFM | DRPD;
 165         r8a66597_bclr(r8a66597, val, get_syscfg_reg(port));
 166         r8a66597_bclr(r8a66597, HSE, get_syscfg_reg(port));
 167 }
 168
 169 static int enable_controller(struct r8a66597 *r8a66597)
 170 {
 171         int ret, port;
 172
 173         ret = r8a66597_clock_enable(r8a66597);
 174         if (ret < 0)
 175                 return ret;
 176
 177 #if !defined(CONFIG_RZA_USB)
 178         r8a66597_bset(r8a66597, CONFIG_R8A66597_LDRV & LDRV, PINCFG);
 179 #endif
 180         r8a66597_bset(r8a66597, USBE, SYSCFG0);
 181
 182         r8a66597_bset(r8a66597, INTL, SOFCFG);
 183         r8a66597_write(r8a66597, 0, INTENB0);
 184         for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++)
 185                 r8a66597_write(r8a66597, 0, get_intenb_reg(port));
 186
 187         r8a66597_bset(r8a66597, CONFIG_R8A66597_ENDIAN & BIGEND, CFIFOSEL);
 188         r8a66597_bset(r8a66597, CONFIG_R8A66597_ENDIAN & BIGEND, D0FIFOSEL);
 189         r8a66597_bset(r8a66597, CONFIG_R8A66597_ENDIAN & BIGEND, D1FIFOSEL);
 190         r8a66597_bset(r8a66597, TRNENSEL, SOFCFG);
 191
 192         for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++)
 193                 r8a66597_enable_port(r8a66597, port);
 194
 195         return 0;
 196 }
 197
 198 static void disable_controller(struct r8a66597 *r8a66597)
 199 {
 200         int i;
 201
 202         if (!(r8a66597_read(r8a66597, SYSCFG0) & USBE))
 203                 return;
 204
 205         r8a66597_write(r8a66597, 0, INTENB0);
 206         r8a66597_write(r8a66597, 0, INTSTS0);
 207
 208         r8a66597_write(r8a66597, 0, D0FIFOSEL);
 209         r8a66597_write(r8a66597, 0, D1FIFOSEL);
 210         r8a66597_write(r8a66597, 0, DCPCFG);
 211         r8a66597_write(r8a66597, 0x40, DCPMAXP);
 212         r8a66597_write(r8a66597, 0, DCPCTR);
 213
 214         for (i = 0; i <= 10; i++)
 215                 r8a66597_write(r8a66597, 0, get_devadd_addr(i));
 216         for (i = 1; i <= 5; i++) {
 217                 r8a66597_write(r8a66597, 0, get_pipetre_addr(i));
 218                 r8a66597_write(r8a66597, 0, get_pipetrn_addr(i));
 219         }
 220         for (i = 1; i < R8A66597_MAX_NUM_PIPE; i++) {
 221                 r8a66597_write(r8a66597, 0, get_pipectr_addr(i));
 222                 r8a66597_write(r8a66597, i, PIPESEL);
 223                 r8a66597_write(r8a66597, 0, PIPECFG);
 224                 r8a66597_write(r8a66597, 0, PIPEBUF);
 225                 r8a66597_write(r8a66597, 0, PIPEMAXP);
 226                 r8a66597_write(r8a66597, 0, PIPEPERI);
 227         }
 228
 229         for (i = 0; i < R8A66597_MAX_ROOT_HUB; i++)
 230                 r8a66597_disable_port(r8a66597, i);
 231
 232         r8a66597_clock_disable(r8a66597);
 233 }
 234
 235 static void r8a66597_reg_wait(struct r8a66597 *r8a66597, unsigned long reg,
 236                               u16 mask, u16 loop)
 237 {
 238         u16 tmp;
 239         int i = 0;
 240
 241         do {
 242                 tmp = r8a66597_read(r8a66597, reg);
 243                 if (i++ > 1000000) {
 244                         printf("register%lx, loop %x is timeout\n", reg, loop);
 245                         break;
 246                 }
 247         } while ((tmp & mask) != loop);
 248 }
 249
 250 static void pipe_buffer_setting(struct r8a66597 *r8a66597,
 251                                 struct usb_device *dev, unsigned long pipe)
 252 {
 253         u16 val = 0;
 254         u16 pipenum, bufnum, maxpacket;
 255
 256         if (usb_pipein(pipe)) {
 257                 pipenum = BULK_IN_PIPENUM;
 258                 bufnum = BULK_IN_BUFNUM;
 259                 maxpacket = dev->epmaxpacketin[usb_pipeendpoint(pipe)];
 260         } else {
 261                 pipenum = BULK_OUT_PIPENUM;
 262                 bufnum = BULK_OUT_BUFNUM;
 263                 maxpacket = dev->epmaxpacketout[usb_pipeendpoint(pipe)];
 264         }
 265
 266         if (r8a66597->pipe_config & (1 << pipenum))
 267                 return;
 268         r8a66597->pipe_config |= (1 << pipenum);
 269
 270         r8a66597_bset(r8a66597, ACLRM, get_pipectr_addr(pipenum));
 271         r8a66597_bclr(r8a66597, ACLRM, get_pipectr_addr(pipenum));
 272         r8a66597_write(r8a66597, pipenum, PIPESEL);
 273
 274         /* FIXME: This driver support bulk transfer only. */
 275         if (!usb_pipein(pipe))
 276                 val |= R8A66597_DIR;
 277         else
 278                 val |= R8A66597_SHTNAK;
 279         val |= R8A66597_BULK | R8A66597_DBLB | usb_pipeendpoint(pipe);
 280         r8a66597_write(r8a66597, val, PIPECFG);
 281
 282         r8a66597_write(r8a66597, (8 << 10) | bufnum, PIPEBUF);
 283         r8a66597_write(r8a66597, make_devsel(usb_pipedevice(pipe)) |
 284                                  maxpacket, PIPEMAXP);
 285         r8a66597_write(r8a66597, 0, PIPEPERI);
 286         r8a66597_write(r8a66597, SQCLR, get_pipectr_addr(pipenum));
 287 }
 288
 289 static int send_setup_packet(struct r8a66597 *r8a66597, struct usb_device *dev,
 290                              struct devrequest *setup)
 291 {
 292         int i;
 293         unsigned short *p = (unsigned short *)setup;
 294         unsigned long setup_addr = USBREQ;
 295         u16 intsts1;
 296         int timeout = 3000;
 297 #if defined(CONFIG_RZA_USB)
 298         u16 dcpctr;
 299 #endif
 300         u16 devsel = setup->request == USB_REQ_SET_ADDRESS ? 0 : dev->devnum;
 301
 302         r8a66597_write(r8a66597, make_devsel(devsel) |
 303                                  (8 << dev->maxpacketsize), DCPMAXP);
 304         r8a66597_write(r8a66597, ~(SIGN | SACK), INTSTS1);
 305
 306 #if defined(CONFIG_RZA_USB)
 307         dcpctr = r8a66597_read(r8a66597, DCPCTR);
 308         if ((dcpctr & PID) == PID_BUF) {
 309                 if (readw_poll_timeout(r8a66597->reg + DCPCTR, dcpctr,
 310                                        dcpctr & BSTS, 1000) < 0) {
 311                         printf("DCPCTR BSTS timeout!\n");
 312                         return -ETIMEDOUT;
 313                 }
 314         }
 315 #endif
 316
 317         for (i = 0; i < 4; i++) {
 318                 r8a66597_write(r8a66597, le16_to_cpu(p[i]), setup_addr);
 319                 setup_addr += 2;
 320         }
 321         r8a66597_write(r8a66597, ~0x0001, BRDYSTS);
 322         r8a66597_write(r8a66597, SUREQ, DCPCTR);
 323
 324         while (1) {
 325                 intsts1 = r8a66597_read(r8a66597, INTSTS1);
 326                 if (intsts1 & SACK)
 327                         break;
 328                 if (intsts1 & SIGN) {
 329                         printf("setup packet send error\n");
 330                         return -1;
 331                 }
 332                 if (timeout-- < 0) {
 333                         printf("setup packet timeout\n");
 334                         return -1;
 335                 }
 336                 udelay(500);
 337         }
 338
 339         return 0;
 340 }
 341
 342 static int send_bulk_packet(struct r8a66597 *r8a66597, struct usb_device *dev,
 343                             unsigned long pipe, void *buffer, int transfer_len)
 344 {
 345         u16 tmp, bufsize;
 346         u16 *buf;
 347         size_t size;
 348
 349         R8A66597_DPRINT("%s\n", __func__);
 350
 351         r8a66597_mdfy(r8a66597, MBW | BULK_OUT_PIPENUM,
 352                         MBW | CURPIPE, CFIFOSEL);
 353         r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, BULK_OUT_PIPENUM);
 354         tmp = r8a66597_read(r8a66597, CFIFOCTR);
 355         if ((tmp & FRDY) == 0) {
 356                 printf("%s FRDY is not set (%x)\n", __func__, tmp);
 357                 return -1;
 358         }
 359
 360         /* prepare parameters */
 361         bufsize = dev->epmaxpacketout[usb_pipeendpoint(pipe)];
 362         buf = (u16 *)(buffer + dev->act_len);
 363         size = min((int)bufsize, transfer_len - dev->act_len);
 364
 365         /* write fifo */
 366         r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS);
 367         if (buffer) {
 368                 r8a66597_write_fifo(r8a66597, CFIFO, buf, size);
 369                 r8a66597_write(r8a66597, BVAL, CFIFOCTR);
 370         }
 371
 372         /* update parameters */
 373         dev->act_len += size;
 374
 375         r8a66597_mdfy(r8a66597, PID_BUF, PID,
 376                         get_pipectr_addr(BULK_OUT_PIPENUM));
 377
 378         while (!(r8a66597_read(r8a66597, BEMPSTS) & (1 << BULK_OUT_PIPENUM)))
 379                 if (ctrlc())
 380                         return -1;
 381         r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS);
 382
 383         if (dev->act_len >= transfer_len)
 384                 r8a66597_mdfy(r8a66597, PID_NAK, PID,
 385                                 get_pipectr_addr(BULK_OUT_PIPENUM));
 386
 387         return 0;
 388 }
 389
 390 static int receive_bulk_packet(struct r8a66597 *r8a66597,
 391                                struct usb_device *dev,
 392                                unsigned long pipe,
 393                                void *buffer, int transfer_len)
 394 {
 395         u16 tmp;
 396         u16 *buf;
 397         const u16 pipenum = BULK_IN_PIPENUM;
 398         int rcv_len;
 399         int maxpacket = dev->epmaxpacketin[usb_pipeendpoint(pipe)];
 400
 401         R8A66597_DPRINT("%s\n", __func__);
 402
 403         /* prepare */
 404         if (dev->act_len == 0) {
 405                 r8a66597_mdfy(r8a66597, PID_NAK, PID,
 406                                 get_pipectr_addr(pipenum));
 407                 r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS);
 408
 409                 r8a66597_write(r8a66597, TRCLR, get_pipetre_addr(pipenum));
 410                 r8a66597_write(r8a66597,
 411                                 (transfer_len + maxpacket - 1) / maxpacket,
 412                                 get_pipetrn_addr(pipenum));
 413                 r8a66597_bset(r8a66597, TRENB, get_pipetre_addr(pipenum));
 414
 415                 r8a66597_mdfy(r8a66597, PID_BUF, PID,
 416                                 get_pipectr_addr(pipenum));
 417         }
 418
 419         r8a66597_mdfy(r8a66597, MBW | pipenum, MBW | CURPIPE, CFIFOSEL);
 420         r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, pipenum);
 421
 422         while (!(r8a66597_read(r8a66597, BRDYSTS) & (1 << pipenum)))
 423                 if (ctrlc())
 424                         return -1;
 425         r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS);
 426
 427         tmp = r8a66597_read(r8a66597, CFIFOCTR);
 428         if ((tmp & FRDY) == 0) {
 429                 printf("%s FRDY is not set. (%x)\n", __func__, tmp);
 430                 return -1;
 431         }
 432
 433         buf = (u16 *)(buffer + dev->act_len);
 434         rcv_len = tmp & DTLN;
 435         dev->act_len += rcv_len;
 436
 437         if (buffer) {
 438                 if (rcv_len == 0)
 439                         r8a66597_write(r8a66597, BCLR, CFIFOCTR);
 440                 else
 441                         r8a66597_read_fifo(r8a66597, CFIFO, buf, rcv_len);
 442         }
 443
 444         return 0;
 445 }
 446
 447 static int receive_control_packet(struct r8a66597 *r8a66597,
 448                                   struct usb_device *dev,
 449                                   void *buffer, int transfer_len)
 450 {
 451         u16 tmp;
 452         int rcv_len;
 453
 454         /* FIXME: limit transfer size : 64byte or less */
 455
 456         r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG);
 457         r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL);
 458         r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
 459         r8a66597_bset(r8a66597, SQSET, DCPCTR);
 460         r8a66597_write(r8a66597, BCLR, CFIFOCTR);
 461         r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR);
 462
 463         while (!(r8a66597_read(r8a66597, BRDYSTS) & 0x0001))
 464                 if (ctrlc())
 465                         return -1;
 466         r8a66597_write(r8a66597, ~0x0001, BRDYSTS);
 467
 468         r8a66597_mdfy(r8a66597, MBW, MBW | CURPIPE, CFIFOSEL);
 469         r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
 470
 471         tmp = r8a66597_read(r8a66597, CFIFOCTR);
 472         if ((tmp & FRDY) == 0) {
 473                 printf("%s FRDY is not set. (%x)\n", __func__, tmp);
 474                 return -1;
 475         }
 476
 477         rcv_len = tmp & DTLN;
 478         dev->act_len += rcv_len;
 479
 480         r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR);
 481
 482         if (buffer) {
 483                 if (rcv_len == 0)
 484                         r8a66597_write(r8a66597, BCLR, DCPCTR);
 485                 else
 486                         r8a66597_read_fifo(r8a66597, CFIFO, buffer, rcv_len);
 487         }
 488
 489         return 0;
 490 }
 491
 492 static int send_status_packet(struct r8a66597 *r8a66597,
 493                                unsigned long pipe)
 494 {
 495         r8a66597_bset(r8a66597, SQSET, DCPCTR);
 496         r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR);
 497
 498         if (usb_pipein(pipe)) {
 499                 r8a66597_bset(r8a66597, R8A66597_DIR, DCPCFG);
 500                 r8a66597_mdfy(r8a66597, ISEL, ISEL | CURPIPE, CFIFOSEL);
 501                 r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
 502                 r8a66597_write(r8a66597, ~BEMP0, BEMPSTS);
 503                 r8a66597_write(r8a66597, BCLR | BVAL, CFIFOCTR);
 504         } else {
 505                 r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG);
 506                 r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL);
 507                 r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
 508                 r8a66597_write(r8a66597, BCLR, CFIFOCTR);
 509         }
 510         r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR);
 511
 512         while (!(r8a66597_read(r8a66597, BEMPSTS) & 0x0001))
 513                 if (ctrlc())
 514                         return -1;
 515
 516         return 0;
 517 }
 518
 519 static void r8a66597_check_syssts(struct r8a66597 *r8a66597, int port)
 520 {
 521         int count = R8A66597_MAX_SAMPLING;
 522         unsigned short syssts, old_syssts;
 523
 524         R8A66597_DPRINT("%s\n", __func__);
 525
 526         old_syssts = r8a66597_read(r8a66597, get_syssts_reg(port) & LNST);
 527         while (count > 0) {
 528                 mdelay(R8A66597_RH_POLL_TIME);
 529
 530                 syssts = r8a66597_read(r8a66597, get_syssts_reg(port) & LNST);
 531                 if (syssts == old_syssts) {
 532                         count--;
 533                 } else {
 534                         count = R8A66597_MAX_SAMPLING;
 535                         old_syssts = syssts;
 536                 }
 537         }
 538 }
 539
 540 static void r8a66597_bus_reset(struct r8a66597 *r8a66597, int port)
 541 {
 542         mdelay(10);
 543         r8a66597_mdfy(r8a66597, USBRST, USBRST | UACT, get_dvstctr_reg(port));
 544         mdelay(50);
 545         r8a66597_mdfy(r8a66597, UACT, USBRST | UACT, get_dvstctr_reg(port));
 546         mdelay(50);
 547 }
 548
 549 static int check_usb_device_connecting(struct r8a66597 *r8a66597)
 550 {
 551         int timeout = 10000;    /* 100usec * 10000 = 1sec */
 552         int i;
 553
 554         for (i = 0; i < 5; i++) {
 555                 /* check a usb cable connect */
 556                 while (!(r8a66597_read(r8a66597, INTSTS1) & ATTCH)) {
 557                         if (timeout-- < 0) {
 558                                 printf("%s timeout.\n", __func__);
 559                                 return -1;
 560                         }
 561                         udelay(100);
 562                 }
 563
 564                 /* check a data line */
 565                 r8a66597_check_syssts(r8a66597, 0);
 566
 567                 r8a66597_bus_reset(r8a66597, 0);
 568                 r8a66597->speed = get_rh_usb_speed(r8a66597, 0);
 569
 570                 if (!(r8a66597_read(r8a66597, INTSTS1) & DTCH)) {
 571                         r8a66597->port_change = USB_PORT_STAT_C_CONNECTION;
 572                         r8a66597->port_status = USB_PORT_STAT_CONNECTION |
 573                                                 USB_PORT_STAT_ENABLE;
 574                         return 0;       /* success */
 575                 }
 576
 577                 R8A66597_DPRINT("USB device has detached. retry = %d\n", i);
 578                 r8a66597_write(r8a66597, ~DTCH, INTSTS1);
 579         }
 580
 581         return -1;      /* fail */
 582 }
 583
 584 /*-------------------------------------------------------------------------*
 585  * Virtual Root Hub
 586  *-------------------------------------------------------------------------*/
 587
 588 #include <usbroothubdes.h>
 589
 590 static int r8a66597_submit_rh_msg(struct usb_device *dev, unsigned long pipe,
 591                         void *buffer, int transfer_len, struct devrequest *cmd)
 592 {
 593         struct r8a66597 *r8a66597 = &gr8a66597;
 594         int leni = transfer_len;
 595         int len = 0;
 596         int stat = 0;
 597         __u16 bmRType_bReq;
 598         __u16 wValue;
 599         __u16 wLength;
 600         unsigned char data[32];
 601
 602         R8A66597_DPRINT("%s\n", __func__);
 603
 604         if (usb_pipeint(pipe)) {
 605                 printf("Root-Hub submit IRQ: NOT implemented");
 606                 return 0;
 607         }
 608
 609         bmRType_bReq  = cmd->requesttype | (cmd->request << 8);
 610         wValue        = cpu_to_le16 (cmd->value);
 611         wLength       = cpu_to_le16 (cmd->length);
 612
 613         switch (bmRType_bReq) {
 614         case RH_GET_STATUS:
 615                 *(__u16 *)buffer = cpu_to_le16(1);
 616                 len = 2;
 617                 break;
 618         case RH_GET_STATUS | RH_INTERFACE:
 619                 *(__u16 *)buffer = cpu_to_le16(0);
 620                 len = 2;
 621                 break;
 622         case RH_GET_STATUS | RH_ENDPOINT:
 623                 *(__u16 *)buffer = cpu_to_le16(0);
 624                 len = 2;
 625                 break;
 626         case RH_GET_STATUS | RH_CLASS:
 627                 *(__u32 *)buffer = cpu_to_le32(0);
 628                 len = 4;
 629                 break;
 630         case RH_GET_STATUS | RH_OTHER | RH_CLASS:
 631                 *(__u32 *)buffer = cpu_to_le32(r8a66597->port_status |
 632                                                 (r8a66597->port_change << 16));
 633                 len = 4;
 634                 break;
 635         case RH_CLEAR_FEATURE | RH_ENDPOINT:
 636         case RH_CLEAR_FEATURE | RH_CLASS:
 637                 break;
 638
 639         case RH_CLEAR_FEATURE | RH_OTHER | RH_CLASS:
 640                 switch (wValue) {
 641                 case RH_C_PORT_CONNECTION:
 642                         r8a66597->port_change &= ~USB_PORT_STAT_C_CONNECTION;
 643                         break;
 644                 }
 645                 break;
 646
 647         case RH_SET_FEATURE | RH_OTHER | RH_CLASS:
 648                 switch (wValue) {
 649                 case (RH_PORT_SUSPEND):
 650                         break;
 651                 case (RH_PORT_RESET):
 652                         r8a66597_bus_reset(r8a66597, 0);
 653                         break;
 654                 case (RH_PORT_POWER):
 655                         break;
 656                 case (RH_PORT_ENABLE):
 657                         break;
 658                 }
 659                 break;
 660         case RH_SET_ADDRESS:
 661                 gr8a66597.rh_devnum = wValue;
 662                 break;
 663         case RH_GET_DESCRIPTOR:
 664                 switch ((wValue & 0xff00) >> 8) {
 665                 case (0x01): /* device descriptor */
 666                         len = min_t(unsigned int,
 667                                   leni,
 668                                   min_t(unsigned int,
 669                                       sizeof(root_hub_dev_des),
 670                                       wLength));
 671                         memcpy(buffer, root_hub_dev_des, len);
 672                         break;
 673                 case (0x02): /* configuration descriptor */
 674                         len = min_t(unsigned int,
 675                                   leni,
 676                                   min_t(unsigned int,
 677                                       sizeof(root_hub_config_des),
 678                                       wLength));
 679                         memcpy(buffer, root_hub_config_des, len);
 680                         break;
 681                 case (0x03): /* string descriptors */
 682                         if (wValue == 0x0300) {
 683                                 len = min_t(unsigned int,
 684                                           leni,
 685                                           min_t(unsigned int,
 686                                               sizeof(root_hub_str_index0),
 687                                               wLength));
 688                                 memcpy(buffer, root_hub_str_index0, len);
 689                         }
 690                         if (wValue == 0x0301) {
 691                                 len = min_t(unsigned int,
 692                                           leni,
 693                                           min_t(unsigned int,
 694                                               sizeof(root_hub_str_index1),
 695                                               wLength));
 696                                 memcpy(buffer, root_hub_str_index1, len);
 697                         }
 698                         break;
 699                 default:
 700                         stat = USB_ST_STALLED;
 701                 }
 702                 break;
 703
 704         case RH_GET_DESCRIPTOR | RH_CLASS:
 705         {
 706                 __u32 temp = 0x00000001;
 707
 708                 data[0] = 9;            /* min length; */
 709                 data[1] = 0x29;
 710                 data[2] = temp & RH_A_NDP;
 711                 data[3] = 0;
 712                 if (temp & RH_A_PSM)
 713                         data[3] |= 0x1;
 714                 if (temp & RH_A_NOCP)
 715                         data[3] |= 0x10;
 716                 else if (temp & RH_A_OCPM)
 717                         data[3] |= 0x8;
 718
 719                 /* corresponds to data[4-7] */
 720                 data[5] = (temp & RH_A_POTPGT) >> 24;
 721                 data[7] = temp & RH_B_DR;
 722                 if (data[2] < 7) {
 723                         data[8] = 0xff;
 724                 } else {
 725                         data[0] += 2;
 726                         data[8] = (temp & RH_B_DR) >> 8;
 727                         data[10] = data[9] = 0xff;
 728                 }
 729
 730                 len = min_t(unsigned int, leni,
 731                             min_t(unsigned int, data[0], wLength));
 732                 memcpy(buffer, data, len);
 733                 break;
 734         }
 735
 736         case RH_GET_CONFIGURATION:
 737                 *(__u8 *) buffer = 0x01;
 738                 len = 1;
 739                 break;
 740         case RH_SET_CONFIGURATION:
 741                 break;
 742         default:
 743                 R8A66597_DPRINT("unsupported root hub command");
 744                 stat = USB_ST_STALLED;
 745         }
 746
 747         mdelay(1);
 748
 749         len = min_t(int, len, leni);
 750
 751         dev->act_len = len;
 752         dev->status = stat;
 753
 754         return stat;
 755 }
 756
 757 int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
 758                     int transfer_len)
 759 {
 760         struct r8a66597 *r8a66597 = &gr8a66597;
 761         int ret = 0;
 762
 763         R8A66597_DPRINT("%s\n", __func__);
 764         R8A66597_DPRINT("pipe = %08x, buffer = %p, len = %d, devnum = %d\n",
 765                         pipe, buffer, transfer_len, dev->devnum);
 766
 767         set_devadd(r8a66597, dev->devnum, dev, 0);
 768
 769         pipe_buffer_setting(r8a66597, dev, pipe);
 770
 771         dev->act_len = 0;
 772         while (dev->act_len < transfer_len && ret == 0) {
 773                 if (ctrlc())
 774                         return -1;
 775
 776                 if (usb_pipein(pipe))
 777                         ret = receive_bulk_packet(r8a66597, dev, pipe, buffer,
 778                                                         transfer_len);
 779                 else
 780                         ret = send_bulk_packet(r8a66597, dev, pipe, buffer,
 781                                                         transfer_len);
 782         }
 783
 784         if (ret == 0)
 785                 dev->status = 0;
 786
 787         return ret;
 788 }
 789
 790 int submit_control_msg(struct usb_device *dev, unsigned long pipe,
 791                        void *buffer, int transfer_len, struct devrequest *setup)
 792 {
 793         struct r8a66597 *r8a66597 = &gr8a66597;
 794         u16 r8a66597_address = setup->request == USB_REQ_SET_ADDRESS ?
 795                                         0 : dev->devnum;
 796
 797         R8A66597_DPRINT("%s\n", __func__);
 798         if (usb_pipedevice(pipe) == r8a66597->rh_devnum)
 799                 return r8a66597_submit_rh_msg(dev, pipe, buffer, transfer_len,
 800                                                 setup);
 801
 802         R8A66597_DPRINT("%s: setup\n", __func__);
 803         set_devadd(r8a66597, r8a66597_address, dev, 0);
 804
 805         if (send_setup_packet(r8a66597, dev, setup) < 0) {
 806                 printf("setup packet send error\n");
 807                 return -1;
 808         }
 809
 810         dev->act_len = 0;
 811         if (usb_pipein(pipe))
 812                 if (receive_control_packet(r8a66597, dev, buffer,
 813                                                 transfer_len) < 0)
 814                         return -1;
 815
 816         if (send_status_packet(r8a66597, pipe) < 0)
 817                 return -1;
 818
 819         dev->status = 0;
 820
 821         return 0;
 822 }
 823
 824 int submit_int_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
 825                         int transfer_len, int interval)
 826 {
 827         /* no implement */
 828         R8A66597_DPRINT("%s\n", __func__);
 829         return 0;
 830 }
 831
 832 int usb_lowlevel_init(int index, enum usb_init_type init, void **controller)
 833 {
 834         struct r8a66597 *r8a66597 = &gr8a66597;
 835
 836         R8A66597_DPRINT("%s\n", __func__);
 837
 838         memset(r8a66597, 0, sizeof(*r8a66597));
 839         r8a66597->reg = CONFIG_R8A66597_BASE_ADDR;
 840
 841         disable_controller(r8a66597);
 842         mdelay(100);
 843
 844         enable_controller(r8a66597);
 845         r8a66597_port_power(r8a66597, 0 , 1);
 846
 847         /* check usb device */
 848         check_usb_device_connecting(r8a66597);
 849
 850         mdelay(50);
 851
 852         return 0;
 853 }
 854
 855 int usb_lowlevel_stop(int index)
 856 {
 857         disable_controller(&gr8a66597);
 858
 859         return 0;
 860 }