738 lines
18 KiB
C
738 lines
18 KiB
C
|
/*
|
||
|
* (C) Copyright 2004
|
||
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
||
|
*
|
||
|
* This code is based on linux driver for sl811hs chip, source at
|
||
|
* drivers/usb/host/sl811.c:
|
||
|
*
|
||
|
* SL811 Host Controller Interface driver for USB.
|
||
|
*
|
||
|
* Copyright (c) 2003/06, Courage Co., Ltd.
|
||
|
*
|
||
|
* Based on:
|
||
|
* 1.uhci.c by Linus Torvalds, Johannes Erdfelt, Randy Dunlap,
|
||
|
* Georg Acher, Deti Fliegl, Thomas Sailer, Roman Weissgaerber,
|
||
|
* Adam Richter, Gregory P. Smith;
|
||
|
* 2.Original SL811 driver (hc_sl811.o) by Pei Liu <pbl@cypress.com>
|
||
|
* 3.Rewrited as sl811.o by Yin Aihua <yinah:couragetech.com.cn>
|
||
|
*
|
||
|
* See file CREDITS for list of people who contributed to this
|
||
|
* project.
|
||
|
*
|
||
|
* 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., 59 Temple Place, Suite 330, Boston,
|
||
|
* MA 02111-1307 USA
|
||
|
*/
|
||
|
|
||
|
#include <common.h>
|
||
|
#ifdef CONFIG_USB_SL811HS
|
||
|
#include <mpc8xx.h>
|
||
|
#include <usb.h>
|
||
|
#include "sl811.h"
|
||
|
|
||
|
#include "../board/kup/common/kup.h"
|
||
|
|
||
|
#ifdef __PPC__
|
||
|
# define EIEIO __asm__ volatile ("eieio")
|
||
|
#else
|
||
|
# define EIEIO /* nothing */
|
||
|
#endif
|
||
|
|
||
|
#define SL811_ADR (0x50000000)
|
||
|
#define SL811_DAT (0x50000001)
|
||
|
|
||
|
#define mdelay(n) ({unsigned long msec=(n); while (msec--) udelay(1000);})
|
||
|
|
||
|
#ifdef SL811_DEBUG
|
||
|
static int debug = 9;
|
||
|
#endif
|
||
|
|
||
|
static int root_hub_devnum = 0;
|
||
|
static struct usb_port_status rh_status = { 0 };/* root hub port status */
|
||
|
|
||
|
static int sl811_rh_submit_urb(struct usb_device *usb_dev, unsigned long pipe,
|
||
|
void *data, int buf_len, struct devrequest *cmd);
|
||
|
|
||
|
static void sl811_write (__u8 index, __u8 data)
|
||
|
{
|
||
|
*(volatile unsigned char *) (SL811_ADR) = index;
|
||
|
EIEIO;
|
||
|
*(volatile unsigned char *) (SL811_DAT) = data;
|
||
|
EIEIO;
|
||
|
}
|
||
|
|
||
|
static __u8 sl811_read (__u8 index)
|
||
|
{
|
||
|
__u8 data;
|
||
|
|
||
|
*(volatile unsigned char *) (SL811_ADR) = index;
|
||
|
EIEIO;
|
||
|
data = *(volatile unsigned char *) (SL811_DAT);
|
||
|
EIEIO;
|
||
|
return (data);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Read consecutive bytes of data from the SL811H/SL11H buffer
|
||
|
*/
|
||
|
static void inline sl811_read_buf(__u8 offset, __u8 *buf, __u8 size)
|
||
|
{
|
||
|
*(volatile unsigned char *) (SL811_ADR) = offset;
|
||
|
EIEIO;
|
||
|
while (size--) {
|
||
|
*buf++ = *(volatile unsigned char *) (SL811_DAT);
|
||
|
EIEIO;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Write consecutive bytes of data to the SL811H/SL11H buffer
|
||
|
*/
|
||
|
static void inline sl811_write_buf(__u8 offset, __u8 *buf, __u8 size)
|
||
|
{
|
||
|
*(volatile unsigned char *) (SL811_ADR) = offset;
|
||
|
EIEIO;
|
||
|
while (size--) {
|
||
|
*(volatile unsigned char *) (SL811_DAT) = *buf++;
|
||
|
EIEIO;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
int usb_init_kup4x (void)
|
||
|
{
|
||
|
volatile immap_t *immap = (immap_t *) CFG_IMMR;
|
||
|
volatile memctl8xx_t *memctl = &immap->im_memctl;
|
||
|
int i;
|
||
|
unsigned char tmp;
|
||
|
|
||
|
memctl = &immap->im_memctl;
|
||
|
memctl->memc_or7 = 0xFFFF8726;
|
||
|
memctl->memc_br7 = 0x50000401; /* start at 0x50000000 */
|
||
|
/* BP 14 low = USB ON */
|
||
|
immap->im_cpm.cp_pbdat &= ~(BP_USB_VCC);
|
||
|
/* PB 14 nomal port */
|
||
|
immap->im_cpm.cp_pbpar &= ~(BP_USB_VCC);
|
||
|
/* output */
|
||
|
immap->im_cpm.cp_pbdir |= (BP_USB_VCC);
|
||
|
|
||
|
puts ("USB: ");
|
||
|
|
||
|
for (i = 0x10; i < 0xff; i++) {
|
||
|
sl811_write(i, i);
|
||
|
tmp = (sl811_read(i));
|
||
|
if (tmp != i) {
|
||
|
printf ("SL811 compare error index=0x%02x read=0x%02x\n", i, tmp);
|
||
|
return (-1);
|
||
|
}
|
||
|
}
|
||
|
printf ("SL811 ready\n");
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* This function resets SL811HS controller and detects the speed of
|
||
|
* the connecting device
|
||
|
*
|
||
|
* Return: 0 = no device attached; 1 = USB device attached
|
||
|
*/
|
||
|
static int sl811_hc_reset(void)
|
||
|
{
|
||
|
int status ;
|
||
|
|
||
|
sl811_write(SL811_CTRL2, SL811_CTL2_HOST | SL811_12M_HI);
|
||
|
sl811_write(SL811_CTRL1, SL811_CTRL1_RESET);
|
||
|
|
||
|
mdelay(20);
|
||
|
|
||
|
/* Disable hardware SOF generation, clear all irq status. */
|
||
|
sl811_write(SL811_CTRL1, 0);
|
||
|
mdelay(2);
|
||
|
sl811_write(SL811_INTRSTS, 0xff);
|
||
|
status = sl811_read(SL811_INTRSTS);
|
||
|
|
||
|
if (status & SL811_INTR_NOTPRESENT) {
|
||
|
/* Device is not present */
|
||
|
PDEBUG(0, "Device not present\n");
|
||
|
rh_status.wPortStatus &= ~(USB_PORT_STAT_CONNECTION | USB_PORT_STAT_ENABLE);
|
||
|
rh_status.wPortChange |= USB_PORT_STAT_C_CONNECTION;
|
||
|
sl811_write(SL811_INTR, SL811_INTR_INSRMV);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* Send SOF to address 0, endpoint 0. */
|
||
|
sl811_write(SL811_LEN_B, 0);
|
||
|
sl811_write(SL811_PIDEP_B, PIDEP(USB_PID_SOF, 0));
|
||
|
sl811_write(SL811_DEV_B, 0x00);
|
||
|
sl811_write(SL811_SOFLOW, SL811_12M_LOW);
|
||
|
|
||
|
if (status & SL811_INTR_SPEED_FULL) {
|
||
|
/* full speed device connect directly to root hub */
|
||
|
PDEBUG (0, "Full speed Device attached\n");
|
||
|
|
||
|
sl811_write(SL811_CTRL1, SL811_CTRL1_RESET);
|
||
|
mdelay(20);
|
||
|
sl811_write(SL811_CTRL2, SL811_CTL2_HOST | SL811_12M_HI);
|
||
|
sl811_write(SL811_CTRL1, SL811_CTRL1_SOF);
|
||
|
|
||
|
/* start the SOF or EOP */
|
||
|
sl811_write(SL811_CTRL_B, SL811_USB_CTRL_ARM);
|
||
|
rh_status.wPortStatus |= USB_PORT_STAT_CONNECTION;
|
||
|
rh_status.wPortStatus &= ~USB_PORT_STAT_LOW_SPEED;
|
||
|
mdelay(2);
|
||
|
sl811_write(SL811_INTRSTS, 0xff);
|
||
|
} else {
|
||
|
/* slow speed device connect directly to root-hub */
|
||
|
PDEBUG(0, "Low speed Device attached\n");
|
||
|
|
||
|
sl811_write(SL811_CTRL1, SL811_CTRL1_RESET);
|
||
|
mdelay(20);
|
||
|
sl811_write(SL811_CTRL2, SL811_CTL2_HOST | SL811_CTL2_DSWAP | SL811_12M_HI);
|
||
|
sl811_write(SL811_CTRL1, SL811_CTRL1_SPEED_LOW | SL811_CTRL1_SOF);
|
||
|
|
||
|
/* start the SOF or EOP */
|
||
|
sl811_write(SL811_CTRL_B, SL811_USB_CTRL_ARM);
|
||
|
rh_status.wPortStatus |= USB_PORT_STAT_CONNECTION | USB_PORT_STAT_LOW_SPEED;
|
||
|
mdelay(2);
|
||
|
sl811_write(SL811_INTRSTS, 0xff);
|
||
|
}
|
||
|
|
||
|
rh_status.wPortChange |= USB_PORT_STAT_C_CONNECTION;
|
||
|
sl811_write(SL811_INTR, /*SL811_INTR_INSRMV*/SL811_INTR_DONE_A);
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
int usb_lowlevel_init(void)
|
||
|
{
|
||
|
root_hub_devnum = 0;
|
||
|
sl811_hc_reset();
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int usb_lowlevel_stop(void)
|
||
|
{
|
||
|
sl811_hc_reset();
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int calc_needed_buswidth(int bytes, int need_preamble)
|
||
|
{
|
||
|
return !need_preamble ? bytes * 8 + 256 : 8 * 8 * bytes + 2048;
|
||
|
}
|
||
|
|
||
|
static int sl811_send_packet(struct usb_device *dev, unsigned long pipe, __u8 *buffer, int len)
|
||
|
{
|
||
|
__u8 ctrl = SL811_USB_CTRL_ARM | SL811_USB_CTRL_ENABLE;
|
||
|
__u16 status = 0;
|
||
|
int err = 0, time_start = get_timer(0);
|
||
|
int need_preamble = !(rh_status.wPortStatus & USB_PORT_STAT_LOW_SPEED) &&
|
||
|
usb_pipeslow(pipe);
|
||
|
|
||
|
if (len > 239)
|
||
|
return -1;
|
||
|
|
||
|
if (usb_pipeout(pipe))
|
||
|
ctrl |= SL811_USB_CTRL_DIR_OUT;
|
||
|
if (usb_gettoggle(dev, usb_pipeendpoint(pipe), usb_pipeout(pipe)))
|
||
|
ctrl |= SL811_USB_CTRL_TOGGLE_1;
|
||
|
if (need_preamble)
|
||
|
ctrl |= SL811_USB_CTRL_PREAMBLE;
|
||
|
|
||
|
sl811_write(SL811_INTRSTS, 0xff);
|
||
|
|
||
|
while (err < 3) {
|
||
|
sl811_write(SL811_ADDR_A, 0x10);
|
||
|
sl811_write(SL811_LEN_A, len);
|
||
|
if (usb_pipeout(pipe) && len)
|
||
|
sl811_write_buf(0x10, buffer, len);
|
||
|
|
||
|
if (!(rh_status.wPortStatus & USB_PORT_STAT_LOW_SPEED) &&
|
||
|
sl811_read(SL811_SOFCNTDIV)*64 < calc_needed_buswidth(len, need_preamble))
|
||
|
ctrl |= SL811_USB_CTRL_SOF;
|
||
|
else
|
||
|
ctrl &= ~SL811_USB_CTRL_SOF;
|
||
|
|
||
|
sl811_write(SL811_CTRL_A, ctrl);
|
||
|
while (!(sl811_read(SL811_INTRSTS) & SL811_INTR_DONE_A)) {
|
||
|
if (5*CFG_HZ < get_timer(time_start)) {
|
||
|
printf("USB transmit timed out\n");
|
||
|
return -USB_ST_CRC_ERR;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
sl811_write(SL811_INTRSTS, 0xff);
|
||
|
status = sl811_read(SL811_STS_A);
|
||
|
|
||
|
if (status & SL811_USB_STS_ACK) {
|
||
|
int remainder = sl811_read(SL811_CNT_A);
|
||
|
if (remainder) {
|
||
|
PDEBUG(0, "usb transfer remainder = %d\n", remainder);
|
||
|
len -= remainder;
|
||
|
}
|
||
|
if (usb_pipein(pipe) && len)
|
||
|
sl811_read_buf(0x10, buffer, len);
|
||
|
return len;
|
||
|
}
|
||
|
|
||
|
if ((status & SL811_USB_STS_NAK) == SL811_USB_STS_NAK)
|
||
|
continue;
|
||
|
|
||
|
PDEBUG(0, "usb transfer error %#x\n", (int)status);
|
||
|
err++;
|
||
|
}
|
||
|
|
||
|
err = 0;
|
||
|
|
||
|
if (status & SL811_USB_STS_ERROR)
|
||
|
err |= USB_ST_BUF_ERR;
|
||
|
if (status & SL811_USB_STS_TIMEOUT)
|
||
|
err |= USB_ST_CRC_ERR;
|
||
|
if (status & SL811_USB_STS_STALL)
|
||
|
err |= USB_ST_STALLED;
|
||
|
|
||
|
return -err;
|
||
|
}
|
||
|
|
||
|
int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
|
||
|
int len)
|
||
|
{
|
||
|
int dir_out = usb_pipeout(pipe);
|
||
|
int ep = usb_pipeendpoint(pipe);
|
||
|
int max = usb_maxpacket(dev, pipe);
|
||
|
int done = 0;
|
||
|
|
||
|
PDEBUG(7, "dev = %ld pipe = %ld buf = %p size = %d dir_out = %d\n",
|
||
|
usb_pipedevice(pipe), usb_pipeendpoint(pipe), buffer, len, dir_out);
|
||
|
|
||
|
dev->status = 0;
|
||
|
|
||
|
sl811_write(SL811_DEV_A, usb_pipedevice(pipe));
|
||
|
sl811_write(SL811_PIDEP_A, PIDEP(!dir_out ? USB_PID_IN : USB_PID_OUT, ep));
|
||
|
while (done < len) {
|
||
|
int res = sl811_send_packet(dev, pipe, (__u8*)buffer+done,
|
||
|
max > len - done ? len - done : max);
|
||
|
if (res < 0) {
|
||
|
dev->status = -res;
|
||
|
return res;
|
||
|
}
|
||
|
|
||
|
if (!dir_out && res < max) /* short packet */
|
||
|
break;
|
||
|
|
||
|
done += res;
|
||
|
usb_dotoggle(dev, ep, dir_out);
|
||
|
}
|
||
|
|
||
|
dev->act_len = done;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int submit_control_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
|
||
|
int len,struct devrequest *setup)
|
||
|
{
|
||
|
int done = 0;
|
||
|
int devnum = usb_pipedevice(pipe);
|
||
|
int ep = usb_pipeendpoint(pipe);
|
||
|
|
||
|
dev->status = 0;
|
||
|
|
||
|
if (devnum == root_hub_devnum)
|
||
|
return sl811_rh_submit_urb(dev, pipe, buffer, len, setup);
|
||
|
|
||
|
PDEBUG(7, "dev = %d pipe = %ld buf = %p size = %d rt = %#x req = %#x bus = %i\n",
|
||
|
devnum, ep, buffer, len, (int)setup->requesttype,
|
||
|
(int)setup->request, sl811_read(SL811_SOFCNTDIV)*64);
|
||
|
|
||
|
sl811_write(SL811_DEV_A, devnum);
|
||
|
sl811_write(SL811_PIDEP_A, PIDEP(USB_PID_SETUP, ep));
|
||
|
/* setup phase */
|
||
|
usb_settoggle(dev, ep, 1, 0);
|
||
|
if (sl811_send_packet(dev, usb_sndctrlpipe(dev, ep),
|
||
|
(__u8*)setup, sizeof(*setup)) == sizeof(*setup)) {
|
||
|
int dir_in = usb_pipein(pipe);
|
||
|
int max = usb_maxpacket(dev, pipe);
|
||
|
|
||
|
/* data phase */
|
||
|
sl811_write(SL811_PIDEP_A,
|
||
|
PIDEP(dir_in ? USB_PID_IN : USB_PID_OUT, ep));
|
||
|
usb_settoggle(dev, ep, usb_pipeout(pipe), 1);
|
||
|
while (done < len) {
|
||
|
int res = sl811_send_packet(dev, pipe, (__u8*)buffer+done,
|
||
|
max > len - done ? len - done : max);
|
||
|
if (res < 0) {
|
||
|
PDEBUG(0, "status data failed!\n");
|
||
|
dev->status = -res;
|
||
|
return 0;
|
||
|
}
|
||
|
done += res;
|
||
|
usb_dotoggle(dev, ep, usb_pipeout(pipe));
|
||
|
if (dir_in && res < max) /* short packet */
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* status phase */
|
||
|
sl811_write(SL811_PIDEP_A,
|
||
|
PIDEP(!dir_in ? USB_PID_IN : USB_PID_OUT, ep));
|
||
|
usb_settoggle(dev, ep, !usb_pipeout(pipe), 1);
|
||
|
if (sl811_send_packet(dev,
|
||
|
!dir_in ? usb_rcvctrlpipe(dev, ep) :
|
||
|
usb_sndctrlpipe(dev, ep),
|
||
|
0, 0) < 0) {
|
||
|
PDEBUG(0, "status phase failed!\n");
|
||
|
dev->status = -1;
|
||
|
}
|
||
|
} else {
|
||
|
PDEBUG(0, "setup phase failed!\n");
|
||
|
dev->status = -1;
|
||
|
}
|
||
|
|
||
|
dev->act_len = done;
|
||
|
|
||
|
return done;
|
||
|
}
|
||
|
|
||
|
int submit_int_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
|
||
|
int len, int interval)
|
||
|
{
|
||
|
PDEBUG(0, "dev = %p pipe = %#lx buf = %p size = %d int = %d\n", dev, pipe,
|
||
|
buffer, len, interval);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* SL811 Virtual Root Hub
|
||
|
*/
|
||
|
|
||
|
/* Device descriptor */
|
||
|
static __u8 sl811_rh_dev_des[] =
|
||
|
{
|
||
|
0x12, /* __u8 bLength; */
|
||
|
0x01, /* __u8 bDescriptorType; Device */
|
||
|
0x10, /* __u16 bcdUSB; v1.1 */
|
||
|
0x01,
|
||
|
0x09, /* __u8 bDeviceClass; HUB_CLASSCODE */
|
||
|
0x00, /* __u8 bDeviceSubClass; */
|
||
|
0x00, /* __u8 bDeviceProtocol; */
|
||
|
0x08, /* __u8 bMaxPacketSize0; 8 Bytes */
|
||
|
0x00, /* __u16 idVendor; */
|
||
|
0x00,
|
||
|
0x00, /* __u16 idProduct; */
|
||
|
0x00,
|
||
|
0x00, /* __u16 bcdDevice; */
|
||
|
0x00,
|
||
|
0x00, /* __u8 iManufacturer; */
|
||
|
0x02, /* __u8 iProduct; */
|
||
|
0x01, /* __u8 iSerialNumber; */
|
||
|
0x01 /* __u8 bNumConfigurations; */
|
||
|
};
|
||
|
|
||
|
/* Configuration descriptor */
|
||
|
static __u8 sl811_rh_config_des[] =
|
||
|
{
|
||
|
0x09, /* __u8 bLength; */
|
||
|
0x02, /* __u8 bDescriptorType; Configuration */
|
||
|
0x19, /* __u16 wTotalLength; */
|
||
|
0x00,
|
||
|
0x01, /* __u8 bNumInterfaces; */
|
||
|
0x01, /* __u8 bConfigurationValue; */
|
||
|
0x00, /* __u8 iConfiguration; */
|
||
|
0x40, /* __u8 bmAttributes;
|
||
|
Bit 7: Bus-powered, 6: Self-powered, 5 Remote-wakwup,
|
||
|
4..0: resvd */
|
||
|
0x00, /* __u8 MaxPower; */
|
||
|
|
||
|
/* interface */
|
||
|
0x09, /* __u8 if_bLength; */
|
||
|
0x04, /* __u8 if_bDescriptorType; Interface */
|
||
|
0x00, /* __u8 if_bInterfaceNumber; */
|
||
|
0x00, /* __u8 if_bAlternateSetting; */
|
||
|
0x01, /* __u8 if_bNumEndpoints; */
|
||
|
0x09, /* __u8 if_bInterfaceClass; HUB_CLASSCODE */
|
||
|
0x00, /* __u8 if_bInterfaceSubClass; */
|
||
|
0x00, /* __u8 if_bInterfaceProtocol; */
|
||
|
0x00, /* __u8 if_iInterface; */
|
||
|
|
||
|
/* endpoint */
|
||
|
0x07, /* __u8 ep_bLength; */
|
||
|
0x05, /* __u8 ep_bDescriptorType; Endpoint */
|
||
|
0x81, /* __u8 ep_bEndpointAddress; IN Endpoint 1 */
|
||
|
0x03, /* __u8 ep_bmAttributes; Interrupt */
|
||
|
0x08, /* __u16 ep_wMaxPacketSize; */
|
||
|
0x00,
|
||
|
0xff /* __u8 ep_bInterval; 255 ms */
|
||
|
};
|
||
|
|
||
|
/* root hub class descriptor*/
|
||
|
static __u8 sl811_rh_hub_des[] =
|
||
|
{
|
||
|
0x09, /* __u8 bLength; */
|
||
|
0x29, /* __u8 bDescriptorType; Hub-descriptor */
|
||
|
0x01, /* __u8 bNbrPorts; */
|
||
|
0x00, /* __u16 wHubCharacteristics; */
|
||
|
0x00,
|
||
|
0x50, /* __u8 bPwrOn2pwrGood; 2ms */
|
||
|
0x00, /* __u8 bHubContrCurrent; 0 mA */
|
||
|
0xfc, /* __u8 DeviceRemovable; *** 7 Ports max *** */
|
||
|
0xff /* __u8 PortPwrCtrlMask; *** 7 ports max *** */
|
||
|
};
|
||
|
|
||
|
/*
|
||
|
* helper routine for returning string descriptors in UTF-16LE
|
||
|
* input can actually be ISO-8859-1; ASCII is its 7-bit subset
|
||
|
*/
|
||
|
static int ascii2utf (char *s, u8 *utf, int utfmax)
|
||
|
{
|
||
|
int retval;
|
||
|
|
||
|
for (retval = 0; *s && utfmax > 1; utfmax -= 2, retval += 2) {
|
||
|
*utf++ = *s++;
|
||
|
*utf++ = 0;
|
||
|
}
|
||
|
return retval;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* root_hub_string is used by each host controller's root hub code,
|
||
|
* so that they're identified consistently throughout the system.
|
||
|
*/
|
||
|
static int usb_root_hub_string (int id, int serial, char *type, __u8 *data, int len)
|
||
|
{
|
||
|
char buf [30];
|
||
|
|
||
|
/* assert (len > (2 * (sizeof (buf) + 1)));
|
||
|
assert (strlen (type) <= 8);*/
|
||
|
|
||
|
/* language ids */
|
||
|
if (id == 0) {
|
||
|
*data++ = 4; *data++ = 3; /* 4 bytes data */
|
||
|
*data++ = 0; *data++ = 0; /* some language id */
|
||
|
return 4;
|
||
|
|
||
|
/* serial number */
|
||
|
} else if (id == 1) {
|
||
|
sprintf (buf, "%#x", serial);
|
||
|
|
||
|
/* product description */
|
||
|
} else if (id == 2) {
|
||
|
sprintf (buf, "USB %s Root Hub", type);
|
||
|
|
||
|
/* id 3 == vendor description */
|
||
|
|
||
|
/* unsupported IDs --> "stall" */
|
||
|
} else
|
||
|
return 0;
|
||
|
|
||
|
ascii2utf (buf, data + 2, len - 2);
|
||
|
data [0] = 2 + strlen(buf) * 2;
|
||
|
data [1] = 3;
|
||
|
return data [0];
|
||
|
}
|
||
|
|
||
|
/* helper macro */
|
||
|
#define OK(x) len = (x); break
|
||
|
|
||
|
/*
|
||
|
* This function handles all USB request to the the virtual root hub
|
||
|
*/
|
||
|
static int sl811_rh_submit_urb(struct usb_device *usb_dev, unsigned long pipe,
|
||
|
void *data, int buf_len, struct devrequest *cmd)
|
||
|
{
|
||
|
__u8 data_buf[16];
|
||
|
__u8 *bufp = data_buf;
|
||
|
int len = 0;
|
||
|
int status = 0;
|
||
|
|
||
|
__u16 bmRType_bReq;
|
||
|
__u16 wValue;
|
||
|
__u16 wIndex;
|
||
|
__u16 wLength;
|
||
|
|
||
|
if (usb_pipeint(pipe)) {
|
||
|
PDEBUG(0, "interrupt transfer unimplemented!\n");
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
bmRType_bReq = cmd->requesttype | (cmd->request << 8);
|
||
|
wValue = le16_to_cpu (cmd->value);
|
||
|
wIndex = le16_to_cpu (cmd->index);
|
||
|
wLength = le16_to_cpu (cmd->length);
|
||
|
|
||
|
PDEBUG(5, "submit rh urb, req = %d(%x) val = %#x index = %#x len=%d\n",
|
||
|
bmRType_bReq, bmRType_bReq, wValue, wIndex, wLength);
|
||
|
|
||
|
/* Request Destination:
|
||
|
without flags: Device,
|
||
|
USB_RECIP_INTERFACE: interface,
|
||
|
USB_RECIP_ENDPOINT: endpoint,
|
||
|
USB_TYPE_CLASS means HUB here,
|
||
|
USB_RECIP_OTHER | USB_TYPE_CLASS almost ever means HUB_PORT here
|
||
|
*/
|
||
|
switch (bmRType_bReq) {
|
||
|
case RH_GET_STATUS:
|
||
|
*(__u16 *)bufp = cpu_to_le16(1);
|
||
|
OK(2);
|
||
|
|
||
|
case RH_GET_STATUS | USB_RECIP_INTERFACE:
|
||
|
*(__u16 *)bufp = cpu_to_le16(0);
|
||
|
OK(2);
|
||
|
|
||
|
case RH_GET_STATUS | USB_RECIP_ENDPOINT:
|
||
|
*(__u16 *)bufp = cpu_to_le16(0);
|
||
|
OK(2);
|
||
|
|
||
|
case RH_GET_STATUS | USB_TYPE_CLASS:
|
||
|
*(__u32 *)bufp = cpu_to_le32(0);
|
||
|
OK(4);
|
||
|
|
||
|
case RH_GET_STATUS | USB_RECIP_OTHER | USB_TYPE_CLASS:
|
||
|
*(__u32 *)bufp = cpu_to_le32(rh_status.wPortChange<<16 | rh_status.wPortStatus);
|
||
|
OK(4);
|
||
|
|
||
|
case RH_CLEAR_FEATURE | USB_RECIP_ENDPOINT:
|
||
|
switch (wValue) {
|
||
|
case 1:
|
||
|
OK(0);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case RH_CLEAR_FEATURE | USB_TYPE_CLASS:
|
||
|
switch (wValue) {
|
||
|
case C_HUB_LOCAL_POWER:
|
||
|
OK(0);
|
||
|
|
||
|
case C_HUB_OVER_CURRENT:
|
||
|
OK(0);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case RH_CLEAR_FEATURE | USB_RECIP_OTHER | USB_TYPE_CLASS:
|
||
|
switch (wValue) {
|
||
|
case USB_PORT_FEAT_ENABLE:
|
||
|
rh_status.wPortStatus &= ~USB_PORT_STAT_ENABLE;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_SUSPEND:
|
||
|
rh_status.wPortStatus &= ~USB_PORT_STAT_SUSPEND;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_POWER:
|
||
|
rh_status.wPortStatus &= ~USB_PORT_STAT_POWER;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_C_CONNECTION:
|
||
|
rh_status.wPortChange &= ~USB_PORT_STAT_C_CONNECTION;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_C_ENABLE:
|
||
|
rh_status.wPortChange &= ~USB_PORT_STAT_C_ENABLE;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_C_SUSPEND:
|
||
|
rh_status.wPortChange &= ~USB_PORT_STAT_C_SUSPEND;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_C_OVER_CURRENT:
|
||
|
rh_status.wPortChange &= ~USB_PORT_STAT_C_OVERCURRENT;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_C_RESET:
|
||
|
rh_status.wPortChange &= ~USB_PORT_STAT_C_RESET;
|
||
|
OK(0);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case RH_SET_FEATURE | USB_RECIP_OTHER | USB_TYPE_CLASS:
|
||
|
switch (wValue) {
|
||
|
case USB_PORT_FEAT_SUSPEND:
|
||
|
rh_status.wPortStatus |= USB_PORT_STAT_SUSPEND;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_RESET:
|
||
|
rh_status.wPortStatus |= USB_PORT_STAT_RESET;
|
||
|
rh_status.wPortChange = 0;
|
||
|
rh_status.wPortChange |= USB_PORT_STAT_C_RESET;
|
||
|
rh_status.wPortStatus &= ~USB_PORT_STAT_RESET;
|
||
|
rh_status.wPortStatus |= USB_PORT_STAT_ENABLE;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_POWER:
|
||
|
rh_status.wPortStatus |= USB_PORT_STAT_POWER;
|
||
|
OK(0);
|
||
|
|
||
|
case USB_PORT_FEAT_ENABLE:
|
||
|
rh_status.wPortStatus |= USB_PORT_STAT_ENABLE;
|
||
|
OK(0);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case RH_SET_ADDRESS:
|
||
|
root_hub_devnum = wValue;
|
||
|
OK(0);
|
||
|
|
||
|
case RH_GET_DESCRIPTOR:
|
||
|
switch ((wValue & 0xff00) >> 8) {
|
||
|
case USB_DT_DEVICE:
|
||
|
len = sizeof(sl811_rh_dev_des);
|
||
|
bufp = sl811_rh_dev_des;
|
||
|
OK(len);
|
||
|
|
||
|
case USB_DT_CONFIG:
|
||
|
len = sizeof(sl811_rh_config_des);
|
||
|
bufp = sl811_rh_config_des;
|
||
|
OK(len);
|
||
|
|
||
|
case USB_DT_STRING:
|
||
|
len = usb_root_hub_string(wValue & 0xff, (int)(long)0, "SL811HS", data, wLength);
|
||
|
if (len > 0) {
|
||
|
bufp = data;
|
||
|
OK(len);
|
||
|
}
|
||
|
|
||
|
default:
|
||
|
status = -32;
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case RH_GET_DESCRIPTOR | USB_TYPE_CLASS:
|
||
|
len = sizeof(sl811_rh_hub_des);
|
||
|
bufp = sl811_rh_hub_des;
|
||
|
OK(len);
|
||
|
|
||
|
case RH_GET_CONFIGURATION:
|
||
|
bufp[0] = 0x01;
|
||
|
OK(1);
|
||
|
|
||
|
case RH_SET_CONFIGURATION:
|
||
|
OK(0);
|
||
|
|
||
|
default:
|
||
|
PDEBUG(1, "unsupported root hub command\n");
|
||
|
status = -32;
|
||
|
}
|
||
|
|
||
|
len = min(len, buf_len);
|
||
|
if (data != bufp)
|
||
|
memcpy(data, bufp, len);
|
||
|
|
||
|
PDEBUG(5, "len = %d, status = %d\n", len, status);
|
||
|
|
||
|
usb_dev->status = status;
|
||
|
usb_dev->act_len = len;
|
||
|
|
||
|
return status == 0 ? len : status;
|
||
|
}
|
||
|
|
||
|
#endif /* CONFIG_USB_SL811HS */
|