mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-08 17:18:05 -04:00
Fixed MTP to work with TWRP
This commit is contained in:
awab228
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
7
drivers/usb/c67x00/Makefile
Normal file
7
drivers/usb/c67x00/Makefile
Normal file
|
|
@ -0,0 +1,7 @@
|
|||
#
|
||||
# Makefile for Cypress C67X00 USB Controller
|
||||
#
|
||||
|
||||
obj-$(CONFIG_USB_C67X00_HCD) += c67x00.o
|
||||
|
||||
c67x00-y := c67x00-drv.o c67x00-ll-hpi.o c67x00-hcd.o c67x00-sched.o
|
||||
234
drivers/usb/c67x00/c67x00-drv.c
Normal file
234
drivers/usb/c67x00/c67x00-drv.c
Normal file
|
|
@ -0,0 +1,234 @@
|
|||
/*
|
||||
* c67x00-drv.c: Cypress C67X00 USB Common infrastructure
|
||||
*
|
||||
* Copyright (C) 2006-2008 Barco N.V.
|
||||
* Derived from the Cypress cy7c67200/300 ezusb linux driver and
|
||||
* based on multiple host controller drivers inside the linux kernel.
|
||||
*
|
||||
* 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., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301 USA.
|
||||
*/
|
||||
|
||||
/*
|
||||
* This file implements the common infrastructure for using the c67x00.
|
||||
* It is both the link between the platform configuration and subdrivers and
|
||||
* the link between the common hardware parts and the subdrivers (e.g.
|
||||
* interrupt handling).
|
||||
*
|
||||
* The c67x00 has 2 SIE's (serial interface engine) which can be configured
|
||||
* to be host, device or OTG (with some limitations, E.G. only SIE1 can be OTG).
|
||||
*
|
||||
* Depending on the platform configuration, the SIE's are created and
|
||||
* the corresponding subdriver is initialized (c67x00_probe_sie).
|
||||
*/
|
||||
|
||||
#include <linux/device.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/usb.h>
|
||||
#include <linux/usb/c67x00.h>
|
||||
|
||||
#include "c67x00.h"
|
||||
#include "c67x00-hcd.h"
|
||||
|
||||
static void c67x00_probe_sie(struct c67x00_sie *sie,
|
||||
struct c67x00_device *dev, int sie_num)
|
||||
{
|
||||
spin_lock_init(&sie->lock);
|
||||
sie->dev = dev;
|
||||
sie->sie_num = sie_num;
|
||||
sie->mode = c67x00_sie_config(dev->pdata->sie_config, sie_num);
|
||||
|
||||
switch (sie->mode) {
|
||||
case C67X00_SIE_HOST:
|
||||
c67x00_hcd_probe(sie);
|
||||
break;
|
||||
|
||||
case C67X00_SIE_UNUSED:
|
||||
dev_info(sie_dev(sie),
|
||||
"Not using SIE %d as requested\n", sie->sie_num);
|
||||
break;
|
||||
|
||||
default:
|
||||
dev_err(sie_dev(sie),
|
||||
"Unsupported configuration: 0x%x for SIE %d\n",
|
||||
sie->mode, sie->sie_num);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void c67x00_remove_sie(struct c67x00_sie *sie)
|
||||
{
|
||||
switch (sie->mode) {
|
||||
case C67X00_SIE_HOST:
|
||||
c67x00_hcd_remove(sie);
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static irqreturn_t c67x00_irq(int irq, void *__dev)
|
||||
{
|
||||
struct c67x00_device *c67x00 = __dev;
|
||||
struct c67x00_sie *sie;
|
||||
u16 msg, int_status;
|
||||
int i, count = 8;
|
||||
|
||||
int_status = c67x00_ll_hpi_status(c67x00);
|
||||
if (!int_status)
|
||||
return IRQ_NONE;
|
||||
|
||||
while (int_status != 0 && (count-- >= 0)) {
|
||||
c67x00_ll_irq(c67x00, int_status);
|
||||
for (i = 0; i < C67X00_SIES; i++) {
|
||||
sie = &c67x00->sie[i];
|
||||
msg = 0;
|
||||
if (int_status & SIEMSG_FLG(i))
|
||||
msg = c67x00_ll_fetch_siemsg(c67x00, i);
|
||||
if (sie->irq)
|
||||
sie->irq(sie, int_status, msg);
|
||||
}
|
||||
int_status = c67x00_ll_hpi_status(c67x00);
|
||||
}
|
||||
|
||||
if (int_status)
|
||||
dev_warn(&c67x00->pdev->dev, "Not all interrupts handled! "
|
||||
"status = 0x%04x\n", int_status);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
/* ------------------------------------------------------------------------- */
|
||||
|
||||
static int c67x00_drv_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct c67x00_device *c67x00;
|
||||
struct c67x00_platform_data *pdata;
|
||||
struct resource *res, *res2;
|
||||
int ret, i;
|
||||
|
||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
if (!res)
|
||||
return -ENODEV;
|
||||
|
||||
res2 = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
|
||||
if (!res2)
|
||||
return -ENODEV;
|
||||
|
||||
pdata = dev_get_platdata(&pdev->dev);
|
||||
if (!pdata)
|
||||
return -ENODEV;
|
||||
|
||||
c67x00 = kzalloc(sizeof(*c67x00), GFP_KERNEL);
|
||||
if (!c67x00)
|
||||
return -ENOMEM;
|
||||
|
||||
if (!request_mem_region(res->start, resource_size(res),
|
||||
pdev->name)) {
|
||||
dev_err(&pdev->dev, "Memory region busy\n");
|
||||
ret = -EBUSY;
|
||||
goto request_mem_failed;
|
||||
}
|
||||
c67x00->hpi.base = ioremap(res->start, resource_size(res));
|
||||
if (!c67x00->hpi.base) {
|
||||
dev_err(&pdev->dev, "Unable to map HPI registers\n");
|
||||
ret = -EIO;
|
||||
goto map_failed;
|
||||
}
|
||||
|
||||
spin_lock_init(&c67x00->hpi.lock);
|
||||
c67x00->hpi.regstep = pdata->hpi_regstep;
|
||||
c67x00->pdata = dev_get_platdata(&pdev->dev);
|
||||
c67x00->pdev = pdev;
|
||||
|
||||
c67x00_ll_init(c67x00);
|
||||
c67x00_ll_hpi_reg_init(c67x00);
|
||||
|
||||
ret = request_irq(res2->start, c67x00_irq, 0, pdev->name, c67x00);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "Cannot claim IRQ\n");
|
||||
goto request_irq_failed;
|
||||
}
|
||||
|
||||
ret = c67x00_ll_reset(c67x00);
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "Device reset failed\n");
|
||||
goto reset_failed;
|
||||
}
|
||||
|
||||
for (i = 0; i < C67X00_SIES; i++)
|
||||
c67x00_probe_sie(&c67x00->sie[i], c67x00, i);
|
||||
|
||||
platform_set_drvdata(pdev, c67x00);
|
||||
|
||||
return 0;
|
||||
|
||||
reset_failed:
|
||||
free_irq(res2->start, c67x00);
|
||||
request_irq_failed:
|
||||
iounmap(c67x00->hpi.base);
|
||||
map_failed:
|
||||
release_mem_region(res->start, resource_size(res));
|
||||
request_mem_failed:
|
||||
kfree(c67x00);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int c67x00_drv_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct c67x00_device *c67x00 = platform_get_drvdata(pdev);
|
||||
struct resource *res;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < C67X00_SIES; i++)
|
||||
c67x00_remove_sie(&c67x00->sie[i]);
|
||||
|
||||
c67x00_ll_release(c67x00);
|
||||
|
||||
res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
|
||||
if (res)
|
||||
free_irq(res->start, c67x00);
|
||||
|
||||
iounmap(c67x00->hpi.base);
|
||||
|
||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
if (res)
|
||||
release_mem_region(res->start, resource_size(res));
|
||||
|
||||
kfree(c67x00);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver c67x00_driver = {
|
||||
.probe = c67x00_drv_probe,
|
||||
.remove = c67x00_drv_remove,
|
||||
.driver = {
|
||||
.owner = THIS_MODULE,
|
||||
.name = "c67x00",
|
||||
},
|
||||
};
|
||||
|
||||
module_platform_driver(c67x00_driver);
|
||||
|
||||
MODULE_AUTHOR("Peter Korsgaard, Jan Veldeman, Grant Likely");
|
||||
MODULE_DESCRIPTION("Cypress C67X00 USB Controller Driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_ALIAS("platform:c67x00");
|
||||
413
drivers/usb/c67x00/c67x00-hcd.c
Normal file
413
drivers/usb/c67x00/c67x00-hcd.c
Normal file
|
|
@ -0,0 +1,413 @@
|
|||
/*
|
||||
* c67x00-hcd.c: Cypress C67X00 USB Host Controller Driver
|
||||
*
|
||||
* Copyright (C) 2006-2008 Barco N.V.
|
||||
* Derived from the Cypress cy7c67200/300 ezusb linux driver and
|
||||
* based on multiple host controller drivers inside the linux kernel.
|
||||
*
|
||||
* 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., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301 USA.
|
||||
*/
|
||||
|
||||
#include <linux/device.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/usb.h>
|
||||
|
||||
#include "c67x00.h"
|
||||
#include "c67x00-hcd.h"
|
||||
|
||||
/* --------------------------------------------------------------------------
|
||||
* Root Hub Support
|
||||
*/
|
||||
|
||||
static __u8 c67x00_hub_des[] = {
|
||||
0x09, /* __u8 bLength; */
|
||||
0x29, /* __u8 bDescriptorType; Hub-descriptor */
|
||||
0x02, /* __u8 bNbrPorts; */
|
||||
0x00, /* __u16 wHubCharacteristics; */
|
||||
0x00, /* (per-port OC, no power switching) */
|
||||
0x32, /* __u8 bPwrOn2pwrGood; 2ms */
|
||||
0x00, /* __u8 bHubContrCurrent; 0 mA */
|
||||
0x00, /* __u8 DeviceRemovable; ** 7 Ports max ** */
|
||||
0xff, /* __u8 PortPwrCtrlMask; ** 7 ports max ** */
|
||||
};
|
||||
|
||||
static void c67x00_hub_reset_host_port(struct c67x00_sie *sie, int port)
|
||||
{
|
||||
struct c67x00_hcd *c67x00 = sie->private_data;
|
||||
unsigned long flags;
|
||||
|
||||
c67x00_ll_husb_reset(sie, port);
|
||||
|
||||
spin_lock_irqsave(&c67x00->lock, flags);
|
||||
c67x00_ll_husb_reset_port(sie, port);
|
||||
spin_unlock_irqrestore(&c67x00->lock, flags);
|
||||
|
||||
c67x00_ll_set_husb_eot(sie->dev, DEFAULT_EOT);
|
||||
}
|
||||
|
||||
static int c67x00_hub_status_data(struct usb_hcd *hcd, char *buf)
|
||||
{
|
||||
struct c67x00_hcd *c67x00 = hcd_to_c67x00_hcd(hcd);
|
||||
struct c67x00_sie *sie = c67x00->sie;
|
||||
u16 status;
|
||||
int i;
|
||||
|
||||
*buf = 0;
|
||||
status = c67x00_ll_usb_get_status(sie);
|
||||
for (i = 0; i < C67X00_PORTS; i++)
|
||||
if (status & PORT_CONNECT_CHANGE(i))
|
||||
*buf |= (1 << i);
|
||||
|
||||
/* bit 0 denotes hub change, b1..n port change */
|
||||
*buf <<= 1;
|
||||
|
||||
return !!*buf;
|
||||
}
|
||||
|
||||
static int c67x00_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
|
||||
u16 wIndex, char *buf, u16 wLength)
|
||||
{
|
||||
struct c67x00_hcd *c67x00 = hcd_to_c67x00_hcd(hcd);
|
||||
struct c67x00_sie *sie = c67x00->sie;
|
||||
u16 status, usb_status;
|
||||
int len = 0;
|
||||
unsigned int port = wIndex-1;
|
||||
u16 wPortChange, wPortStatus;
|
||||
|
||||
switch (typeReq) {
|
||||
|
||||
case GetHubStatus:
|
||||
*(__le32 *) buf = cpu_to_le32(0);
|
||||
len = 4; /* hub power */
|
||||
break;
|
||||
|
||||
case GetPortStatus:
|
||||
if (wIndex > C67X00_PORTS)
|
||||
return -EPIPE;
|
||||
|
||||
status = c67x00_ll_usb_get_status(sie);
|
||||
usb_status = c67x00_ll_get_usb_ctl(sie);
|
||||
|
||||
wPortChange = 0;
|
||||
if (status & PORT_CONNECT_CHANGE(port))
|
||||
wPortChange |= USB_PORT_STAT_C_CONNECTION;
|
||||
|
||||
wPortStatus = USB_PORT_STAT_POWER;
|
||||
if (!(status & PORT_SE0_STATUS(port)))
|
||||
wPortStatus |= USB_PORT_STAT_CONNECTION;
|
||||
if (usb_status & LOW_SPEED_PORT(port)) {
|
||||
wPortStatus |= USB_PORT_STAT_LOW_SPEED;
|
||||
c67x00->low_speed_ports |= (1 << port);
|
||||
} else
|
||||
c67x00->low_speed_ports &= ~(1 << port);
|
||||
|
||||
if (usb_status & SOF_EOP_EN(port))
|
||||
wPortStatus |= USB_PORT_STAT_ENABLE;
|
||||
|
||||
*(__le16 *) buf = cpu_to_le16(wPortStatus);
|
||||
*(__le16 *) (buf + 2) = cpu_to_le16(wPortChange);
|
||||
len = 4;
|
||||
break;
|
||||
|
||||
case SetHubFeature: /* We don't implement these */
|
||||
case ClearHubFeature:
|
||||
switch (wValue) {
|
||||
case C_HUB_OVER_CURRENT:
|
||||
case C_HUB_LOCAL_POWER:
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
default:
|
||||
return -EPIPE;
|
||||
}
|
||||
break;
|
||||
|
||||
case SetPortFeature:
|
||||
if (wIndex > C67X00_PORTS)
|
||||
return -EPIPE;
|
||||
|
||||
switch (wValue) {
|
||||
case USB_PORT_FEAT_SUSPEND:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"SetPortFeature %d (SUSPEND)\n", port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_RESET:
|
||||
c67x00_hub_reset_host_port(sie, port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_POWER:
|
||||
/* Power always enabled */
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
default:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"%s: SetPortFeature %d (0x%04x) Error!\n",
|
||||
__func__, port, wValue);
|
||||
return -EPIPE;
|
||||
}
|
||||
break;
|
||||
|
||||
case ClearPortFeature:
|
||||
if (wIndex > C67X00_PORTS)
|
||||
return -EPIPE;
|
||||
|
||||
switch (wValue) {
|
||||
case USB_PORT_FEAT_ENABLE:
|
||||
/* Reset the port so that the c67x00 also notices the
|
||||
* disconnect */
|
||||
c67x00_hub_reset_host_port(sie, port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_C_ENABLE:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"ClearPortFeature (%d): C_ENABLE\n", port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_SUSPEND:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"ClearPortFeature (%d): SUSPEND\n", port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_C_SUSPEND:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"ClearPortFeature (%d): C_SUSPEND\n", port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_POWER:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"ClearPortFeature (%d): POWER\n", port);
|
||||
return -EPIPE;
|
||||
|
||||
case USB_PORT_FEAT_C_CONNECTION:
|
||||
c67x00_ll_usb_clear_status(sie,
|
||||
PORT_CONNECT_CHANGE(port));
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_C_OVER_CURRENT:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"ClearPortFeature (%d): OVER_CURRENT\n", port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
case USB_PORT_FEAT_C_RESET:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"ClearPortFeature (%d): C_RESET\n", port);
|
||||
len = 0;
|
||||
break;
|
||||
|
||||
default:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00),
|
||||
"%s: ClearPortFeature %d (0x%04x) Error!\n",
|
||||
__func__, port, wValue);
|
||||
return -EPIPE;
|
||||
}
|
||||
break;
|
||||
|
||||
case GetHubDescriptor:
|
||||
len = min_t(unsigned int, sizeof(c67x00_hub_des), wLength);
|
||||
memcpy(buf, c67x00_hub_des, len);
|
||||
break;
|
||||
|
||||
default:
|
||||
dev_dbg(c67x00_hcd_dev(c67x00), "%s: unknown\n", __func__);
|
||||
return -EPIPE;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* Main part of host controller driver
|
||||
*/
|
||||
|
||||
/**
|
||||
* c67x00_hcd_irq
|
||||
*
|
||||
* This function is called from the interrupt handler in c67x00-drv.c
|
||||
*/
|
||||
static void c67x00_hcd_irq(struct c67x00_sie *sie, u16 int_status, u16 msg)
|
||||
{
|
||||
struct c67x00_hcd *c67x00 = sie->private_data;
|
||||
struct usb_hcd *hcd = c67x00_hcd_to_hcd(c67x00);
|
||||
|
||||
/* Handle sie message flags */
|
||||
if (msg) {
|
||||
if (msg & HUSB_TDListDone)
|
||||
c67x00_sched_kick(c67x00);
|
||||
else
|
||||
dev_warn(c67x00_hcd_dev(c67x00),
|
||||
"Unknown SIE msg flag(s): 0x%04x\n", msg);
|
||||
}
|
||||
|
||||
if (unlikely(hcd->state == HC_STATE_HALT))
|
||||
return;
|
||||
|
||||
if (!HCD_HW_ACCESSIBLE(hcd))
|
||||
return;
|
||||
|
||||
/* Handle Start of frame events */
|
||||
if (int_status & SOFEOP_FLG(sie->sie_num)) {
|
||||
c67x00_ll_usb_clear_status(sie, SOF_EOP_IRQ_FLG);
|
||||
c67x00_sched_kick(c67x00);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* c67x00_hcd_start: Host controller start hook
|
||||
*/
|
||||
static int c67x00_hcd_start(struct usb_hcd *hcd)
|
||||
{
|
||||
hcd->uses_new_polling = 1;
|
||||
hcd->state = HC_STATE_RUNNING;
|
||||
set_bit(HCD_FLAG_POLL_RH, &hcd->flags);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* c67x00_hcd_stop: Host controller stop hook
|
||||
*/
|
||||
static void c67x00_hcd_stop(struct usb_hcd *hcd)
|
||||
{
|
||||
/* Nothing to do */
|
||||
}
|
||||
|
||||
static int c67x00_hcd_get_frame(struct usb_hcd *hcd)
|
||||
{
|
||||
struct c67x00_hcd *c67x00 = hcd_to_c67x00_hcd(hcd);
|
||||
u16 temp_val;
|
||||
|
||||
dev_dbg(c67x00_hcd_dev(c67x00), "%s\n", __func__);
|
||||
temp_val = c67x00_ll_husb_get_frame(c67x00->sie);
|
||||
temp_val &= HOST_FRAME_MASK;
|
||||
return temp_val ? (temp_val - 1) : HOST_FRAME_MASK;
|
||||
}
|
||||
|
||||
static struct hc_driver c67x00_hc_driver = {
|
||||
.description = "c67x00-hcd",
|
||||
.product_desc = "Cypress C67X00 Host Controller",
|
||||
.hcd_priv_size = sizeof(struct c67x00_hcd),
|
||||
.flags = HCD_USB11 | HCD_MEMORY,
|
||||
|
||||
/*
|
||||
* basic lifecycle operations
|
||||
*/
|
||||
.start = c67x00_hcd_start,
|
||||
.stop = c67x00_hcd_stop,
|
||||
|
||||
/*
|
||||
* managing i/o requests and associated device resources
|
||||
*/
|
||||
.urb_enqueue = c67x00_urb_enqueue,
|
||||
.urb_dequeue = c67x00_urb_dequeue,
|
||||
.endpoint_disable = c67x00_endpoint_disable,
|
||||
|
||||
/*
|
||||
* scheduling support
|
||||
*/
|
||||
.get_frame_number = c67x00_hcd_get_frame,
|
||||
|
||||
/*
|
||||
* root hub support
|
||||
*/
|
||||
.hub_status_data = c67x00_hub_status_data,
|
||||
.hub_control = c67x00_hub_control,
|
||||
};
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* Setup/Teardown routines
|
||||
*/
|
||||
|
||||
int c67x00_hcd_probe(struct c67x00_sie *sie)
|
||||
{
|
||||
struct c67x00_hcd *c67x00;
|
||||
struct usb_hcd *hcd;
|
||||
unsigned long flags;
|
||||
int retval;
|
||||
|
||||
if (usb_disabled())
|
||||
return -ENODEV;
|
||||
|
||||
hcd = usb_create_hcd(&c67x00_hc_driver, sie_dev(sie), "c67x00_sie");
|
||||
if (!hcd) {
|
||||
retval = -ENOMEM;
|
||||
goto err0;
|
||||
}
|
||||
c67x00 = hcd_to_c67x00_hcd(hcd);
|
||||
|
||||
spin_lock_init(&c67x00->lock);
|
||||
c67x00->sie = sie;
|
||||
|
||||
INIT_LIST_HEAD(&c67x00->list[PIPE_ISOCHRONOUS]);
|
||||
INIT_LIST_HEAD(&c67x00->list[PIPE_INTERRUPT]);
|
||||
INIT_LIST_HEAD(&c67x00->list[PIPE_CONTROL]);
|
||||
INIT_LIST_HEAD(&c67x00->list[PIPE_BULK]);
|
||||
c67x00->urb_count = 0;
|
||||
INIT_LIST_HEAD(&c67x00->td_list);
|
||||
c67x00->td_base_addr = CY_HCD_BUF_ADDR + SIE_TD_OFFSET(sie->sie_num);
|
||||
c67x00->buf_base_addr = CY_HCD_BUF_ADDR + SIE_BUF_OFFSET(sie->sie_num);
|
||||
c67x00->max_frame_bw = MAX_FRAME_BW_STD;
|
||||
|
||||
c67x00_ll_husb_init_host_port(sie);
|
||||
|
||||
init_completion(&c67x00->endpoint_disable);
|
||||
retval = c67x00_sched_start_scheduler(c67x00);
|
||||
if (retval)
|
||||
goto err1;
|
||||
|
||||
retval = usb_add_hcd(hcd, 0, 0);
|
||||
if (retval) {
|
||||
dev_dbg(sie_dev(sie), "%s: usb_add_hcd returned %d\n",
|
||||
__func__, retval);
|
||||
goto err2;
|
||||
}
|
||||
|
||||
device_wakeup_enable(hcd->self.controller);
|
||||
|
||||
spin_lock_irqsave(&sie->lock, flags);
|
||||
sie->private_data = c67x00;
|
||||
sie->irq = c67x00_hcd_irq;
|
||||
spin_unlock_irqrestore(&sie->lock, flags);
|
||||
|
||||
return retval;
|
||||
|
||||
err2:
|
||||
c67x00_sched_stop_scheduler(c67x00);
|
||||
err1:
|
||||
usb_put_hcd(hcd);
|
||||
err0:
|
||||
return retval;
|
||||
}
|
||||
|
||||
/* may be called with controller, bus, and devices active */
|
||||
void c67x00_hcd_remove(struct c67x00_sie *sie)
|
||||
{
|
||||
struct c67x00_hcd *c67x00 = sie->private_data;
|
||||
struct usb_hcd *hcd = c67x00_hcd_to_hcd(c67x00);
|
||||
|
||||
c67x00_sched_stop_scheduler(c67x00);
|
||||
usb_remove_hcd(hcd);
|
||||
usb_put_hcd(hcd);
|
||||
}
|
||||
133
drivers/usb/c67x00/c67x00-hcd.h
Normal file
133
drivers/usb/c67x00/c67x00-hcd.h
Normal file
|
|
@ -0,0 +1,133 @@
|
|||
/*
|
||||
* c67x00-hcd.h: Cypress C67X00 USB HCD
|
||||
*
|
||||
* Copyright (C) 2006-2008 Barco N.V.
|
||||
* Derived from the Cypress cy7c67200/300 ezusb linux driver and
|
||||
* based on multiple host controller drivers inside the linux kernel.
|
||||
*
|
||||
* 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., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301 USA.
|
||||
*/
|
||||
|
||||
#ifndef _USB_C67X00_HCD_H
|
||||
#define _USB_C67X00_HCD_H
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/usb.h>
|
||||
#include <linux/usb/hcd.h>
|
||||
#include "c67x00.h"
|
||||
|
||||
/*
|
||||
* The following parameters depend on the CPU speed, bus speed, ...
|
||||
* These can be tuned for specific use cases, e.g. if isochronous transfers
|
||||
* are very important, bandwidth can be sacrificed to guarantee that the
|
||||
* 1ms deadline will be met.
|
||||
* If bulk transfers are important, the MAX_FRAME_BW can be increased,
|
||||
* but some (or many) isochronous deadlines might not be met.
|
||||
*
|
||||
* The values are specified in bittime.
|
||||
*/
|
||||
|
||||
/*
|
||||
* The current implementation switches between _STD (default) and _ISO (when
|
||||
* isochronous transfers are scheduled), in order to optimize the throughput
|
||||
* in normal circumstances, but also provide good isochronous behaviour.
|
||||
*
|
||||
* Bandwidth is described in bit time so with a 12MHz USB clock and 1ms
|
||||
* frames; there are 12000 bit times per frame.
|
||||
*/
|
||||
|
||||
#define TOTAL_FRAME_BW 12000
|
||||
#define DEFAULT_EOT 2250
|
||||
|
||||
#define MAX_FRAME_BW_STD (TOTAL_FRAME_BW - DEFAULT_EOT)
|
||||
#define MAX_FRAME_BW_ISO 2400
|
||||
|
||||
/*
|
||||
* Periodic transfers may only use 90% of the full frame, but as
|
||||
* we currently don't even use 90% of the full frame, we may
|
||||
* use the full usable time for periodic transfers.
|
||||
*/
|
||||
#define MAX_PERIODIC_BW(full_bw) full_bw
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
struct c67x00_hcd {
|
||||
spinlock_t lock;
|
||||
struct c67x00_sie *sie;
|
||||
unsigned int low_speed_ports; /* bitmask of low speed ports */
|
||||
unsigned int urb_count;
|
||||
unsigned int urb_iso_count;
|
||||
|
||||
struct list_head list[4]; /* iso, int, ctrl, bulk */
|
||||
#if PIPE_BULK != 3
|
||||
#error "Sanity check failed, this code presumes PIPE_... to range from 0 to 3"
|
||||
#endif
|
||||
|
||||
/* USB bandwidth allocated to td_list */
|
||||
int bandwidth_allocated;
|
||||
/* USB bandwidth allocated for isoc/int transfer */
|
||||
int periodic_bw_allocated;
|
||||
struct list_head td_list;
|
||||
int max_frame_bw;
|
||||
|
||||
u16 td_base_addr;
|
||||
u16 buf_base_addr;
|
||||
u16 next_td_addr;
|
||||
u16 next_buf_addr;
|
||||
|
||||
struct tasklet_struct tasklet;
|
||||
|
||||
struct completion endpoint_disable;
|
||||
|
||||
u16 current_frame;
|
||||
u16 last_frame;
|
||||
};
|
||||
|
||||
static inline struct c67x00_hcd *hcd_to_c67x00_hcd(struct usb_hcd *hcd)
|
||||
{
|
||||
return (struct c67x00_hcd *)(hcd->hcd_priv);
|
||||
}
|
||||
|
||||
static inline struct usb_hcd *c67x00_hcd_to_hcd(struct c67x00_hcd *c67x00)
|
||||
{
|
||||
return container_of((void *)c67x00, struct usb_hcd, hcd_priv);
|
||||
}
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* Functions used by c67x00-drv
|
||||
*/
|
||||
|
||||
int c67x00_hcd_probe(struct c67x00_sie *sie);
|
||||
void c67x00_hcd_remove(struct c67x00_sie *sie);
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* Transfer Descriptor scheduling functions
|
||||
*/
|
||||
int c67x00_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags);
|
||||
int c67x00_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status);
|
||||
void c67x00_endpoint_disable(struct usb_hcd *hcd,
|
||||
struct usb_host_endpoint *ep);
|
||||
|
||||
void c67x00_hcd_msg_received(struct c67x00_sie *sie, u16 msg);
|
||||
void c67x00_sched_kick(struct c67x00_hcd *c67x00);
|
||||
int c67x00_sched_start_scheduler(struct c67x00_hcd *c67x00);
|
||||
void c67x00_sched_stop_scheduler(struct c67x00_hcd *c67x00);
|
||||
|
||||
#define c67x00_hcd_dev(x) (c67x00_hcd_to_hcd(x)->self.controller)
|
||||
|
||||
#endif /* _USB_C67X00_HCD_H */
|
||||
491
drivers/usb/c67x00/c67x00-ll-hpi.c
Normal file
491
drivers/usb/c67x00/c67x00-ll-hpi.c
Normal file
|
|
@ -0,0 +1,491 @@
|
|||
/*
|
||||
* c67x00-ll-hpi.c: Cypress C67X00 USB Low level interface using HPI
|
||||
*
|
||||
* Copyright (C) 2006-2008 Barco N.V.
|
||||
* Derived from the Cypress cy7c67200/300 ezusb linux driver and
|
||||
* based on multiple host controller drivers inside the linux kernel.
|
||||
*
|
||||
* 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., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301 USA.
|
||||
*/
|
||||
|
||||
#include <asm/byteorder.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/jiffies.h>
|
||||
#include <linux/usb/c67x00.h>
|
||||
#include "c67x00.h"
|
||||
|
||||
#define COMM_REGS 14
|
||||
|
||||
struct c67x00_lcp_int_data {
|
||||
u16 regs[COMM_REGS];
|
||||
};
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
/* Interface definitions */
|
||||
|
||||
#define COMM_ACK 0x0FED
|
||||
#define COMM_NAK 0xDEAD
|
||||
|
||||
#define COMM_RESET 0xFA50
|
||||
#define COMM_EXEC_INT 0xCE01
|
||||
#define COMM_INT_NUM 0x01C2
|
||||
|
||||
/* Registers 0 to COMM_REGS-1 */
|
||||
#define COMM_R(x) (0x01C4 + 2 * (x))
|
||||
|
||||
#define HUSB_SIE_pCurrentTDPtr(x) ((x) ? 0x01B2 : 0x01B0)
|
||||
#define HUSB_SIE_pTDListDone_Sem(x) ((x) ? 0x01B8 : 0x01B6)
|
||||
#define HUSB_pEOT 0x01B4
|
||||
|
||||
/* Software interrupts */
|
||||
/* 114, 115: */
|
||||
#define HUSB_SIE_INIT_INT(x) ((x) ? 0x0073 : 0x0072)
|
||||
#define HUSB_RESET_INT 0x0074
|
||||
|
||||
#define SUSB_INIT_INT 0x0071
|
||||
#define SUSB_INIT_INT_LOC (SUSB_INIT_INT * 2)
|
||||
|
||||
/* -----------------------------------------------------------------------
|
||||
* HPI implementation
|
||||
*
|
||||
* The c67x00 chip also support control via SPI or HSS serial
|
||||
* interfaces. However, this driver assumes that register access can
|
||||
* be performed from IRQ context. While this is a safe assumption with
|
||||
* the HPI interface, it is not true for the serial interfaces.
|
||||
*/
|
||||
|
||||
/* HPI registers */
|
||||
#define HPI_DATA 0
|
||||
#define HPI_MAILBOX 1
|
||||
#define HPI_ADDR 2
|
||||
#define HPI_STATUS 3
|
||||
|
||||
/*
|
||||
* According to CY7C67300 specification (tables 140 and 141) HPI read and
|
||||
* write cycle duration Tcyc must be at least 6T long, where T is 1/48MHz,
|
||||
* which is 125ns.
|
||||
*/
|
||||
#define HPI_T_CYC_NS 125
|
||||
|
||||
static inline u16 hpi_read_reg(struct c67x00_device *dev, int reg)
|
||||
{
|
||||
ndelay(HPI_T_CYC_NS);
|
||||
return __raw_readw(dev->hpi.base + reg * dev->hpi.regstep);
|
||||
}
|
||||
|
||||
static inline void hpi_write_reg(struct c67x00_device *dev, int reg, u16 value)
|
||||
{
|
||||
ndelay(HPI_T_CYC_NS);
|
||||
__raw_writew(value, dev->hpi.base + reg * dev->hpi.regstep);
|
||||
}
|
||||
|
||||
static inline u16 hpi_read_word_nolock(struct c67x00_device *dev, u16 reg)
|
||||
{
|
||||
hpi_write_reg(dev, HPI_ADDR, reg);
|
||||
return hpi_read_reg(dev, HPI_DATA);
|
||||
}
|
||||
|
||||
static u16 hpi_read_word(struct c67x00_device *dev, u16 reg)
|
||||
{
|
||||
u16 value;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
value = hpi_read_word_nolock(dev, reg);
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
|
||||
return value;
|
||||
}
|
||||
|
||||
static void hpi_write_word_nolock(struct c67x00_device *dev, u16 reg, u16 value)
|
||||
{
|
||||
hpi_write_reg(dev, HPI_ADDR, reg);
|
||||
hpi_write_reg(dev, HPI_DATA, value);
|
||||
}
|
||||
|
||||
static void hpi_write_word(struct c67x00_device *dev, u16 reg, u16 value)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
hpi_write_word_nolock(dev, reg, value);
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
}
|
||||
|
||||
/*
|
||||
* Only data is little endian, addr has cpu endianess
|
||||
*/
|
||||
static void hpi_write_words_le16(struct c67x00_device *dev, u16 addr,
|
||||
__le16 *data, u16 count)
|
||||
{
|
||||
unsigned long flags;
|
||||
int i;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
|
||||
hpi_write_reg(dev, HPI_ADDR, addr);
|
||||
for (i = 0; i < count; i++)
|
||||
hpi_write_reg(dev, HPI_DATA, le16_to_cpu(*data++));
|
||||
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
}
|
||||
|
||||
/*
|
||||
* Only data is little endian, addr has cpu endianess
|
||||
*/
|
||||
static void hpi_read_words_le16(struct c67x00_device *dev, u16 addr,
|
||||
__le16 *data, u16 count)
|
||||
{
|
||||
unsigned long flags;
|
||||
int i;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
hpi_write_reg(dev, HPI_ADDR, addr);
|
||||
for (i = 0; i < count; i++)
|
||||
*data++ = cpu_to_le16(hpi_read_reg(dev, HPI_DATA));
|
||||
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
}
|
||||
|
||||
static void hpi_set_bits(struct c67x00_device *dev, u16 reg, u16 mask)
|
||||
{
|
||||
u16 value;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
value = hpi_read_word_nolock(dev, reg);
|
||||
hpi_write_word_nolock(dev, reg, value | mask);
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
}
|
||||
|
||||
static void hpi_clear_bits(struct c67x00_device *dev, u16 reg, u16 mask)
|
||||
{
|
||||
u16 value;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
value = hpi_read_word_nolock(dev, reg);
|
||||
hpi_write_word_nolock(dev, reg, value & ~mask);
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
}
|
||||
|
||||
static u16 hpi_recv_mbox(struct c67x00_device *dev)
|
||||
{
|
||||
u16 value;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
value = hpi_read_reg(dev, HPI_MAILBOX);
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
|
||||
return value;
|
||||
}
|
||||
|
||||
static u16 hpi_send_mbox(struct c67x00_device *dev, u16 value)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
hpi_write_reg(dev, HPI_MAILBOX, value);
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
|
||||
return value;
|
||||
}
|
||||
|
||||
u16 c67x00_ll_hpi_status(struct c67x00_device *dev)
|
||||
{
|
||||
u16 value;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&dev->hpi.lock, flags);
|
||||
value = hpi_read_reg(dev, HPI_STATUS);
|
||||
spin_unlock_irqrestore(&dev->hpi.lock, flags);
|
||||
|
||||
return value;
|
||||
}
|
||||
|
||||
void c67x00_ll_hpi_reg_init(struct c67x00_device *dev)
|
||||
{
|
||||
int i;
|
||||
|
||||
hpi_recv_mbox(dev);
|
||||
c67x00_ll_hpi_status(dev);
|
||||
hpi_write_word(dev, HPI_IRQ_ROUTING_REG, 0);
|
||||
|
||||
for (i = 0; i < C67X00_SIES; i++) {
|
||||
hpi_write_word(dev, SIEMSG_REG(i), 0);
|
||||
hpi_read_word(dev, SIEMSG_REG(i));
|
||||
}
|
||||
}
|
||||
|
||||
void c67x00_ll_hpi_enable_sofeop(struct c67x00_sie *sie)
|
||||
{
|
||||
hpi_set_bits(sie->dev, HPI_IRQ_ROUTING_REG,
|
||||
SOFEOP_TO_HPI_EN(sie->sie_num));
|
||||
}
|
||||
|
||||
void c67x00_ll_hpi_disable_sofeop(struct c67x00_sie *sie)
|
||||
{
|
||||
hpi_clear_bits(sie->dev, HPI_IRQ_ROUTING_REG,
|
||||
SOFEOP_TO_HPI_EN(sie->sie_num));
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
/* Transactions */
|
||||
|
||||
static inline int ll_recv_msg(struct c67x00_device *dev)
|
||||
{
|
||||
u16 res;
|
||||
|
||||
res = wait_for_completion_timeout(&dev->hpi.lcp.msg_received, 5 * HZ);
|
||||
WARN_ON(!res);
|
||||
|
||||
return (res == 0) ? -EIO : 0;
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
/* General functions */
|
||||
|
||||
u16 c67x00_ll_fetch_siemsg(struct c67x00_device *dev, int sie_num)
|
||||
{
|
||||
u16 val;
|
||||
|
||||
val = hpi_read_word(dev, SIEMSG_REG(sie_num));
|
||||
/* clear register to allow next message */
|
||||
hpi_write_word(dev, SIEMSG_REG(sie_num), 0);
|
||||
|
||||
return val;
|
||||
}
|
||||
|
||||
u16 c67x00_ll_get_usb_ctl(struct c67x00_sie *sie)
|
||||
{
|
||||
return hpi_read_word(sie->dev, USB_CTL_REG(sie->sie_num));
|
||||
}
|
||||
|
||||
/**
|
||||
* c67x00_ll_usb_clear_status - clear the USB status bits
|
||||
*/
|
||||
void c67x00_ll_usb_clear_status(struct c67x00_sie *sie, u16 bits)
|
||||
{
|
||||
hpi_write_word(sie->dev, USB_STAT_REG(sie->sie_num), bits);
|
||||
}
|
||||
|
||||
u16 c67x00_ll_usb_get_status(struct c67x00_sie *sie)
|
||||
{
|
||||
return hpi_read_word(sie->dev, USB_STAT_REG(sie->sie_num));
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
static int c67x00_comm_exec_int(struct c67x00_device *dev, u16 nr,
|
||||
struct c67x00_lcp_int_data *data)
|
||||
{
|
||||
int i, rc;
|
||||
|
||||
mutex_lock(&dev->hpi.lcp.mutex);
|
||||
hpi_write_word(dev, COMM_INT_NUM, nr);
|
||||
for (i = 0; i < COMM_REGS; i++)
|
||||
hpi_write_word(dev, COMM_R(i), data->regs[i]);
|
||||
hpi_send_mbox(dev, COMM_EXEC_INT);
|
||||
rc = ll_recv_msg(dev);
|
||||
mutex_unlock(&dev->hpi.lcp.mutex);
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
/* Host specific functions */
|
||||
|
||||
void c67x00_ll_set_husb_eot(struct c67x00_device *dev, u16 value)
|
||||
{
|
||||
mutex_lock(&dev->hpi.lcp.mutex);
|
||||
hpi_write_word(dev, HUSB_pEOT, value);
|
||||
mutex_unlock(&dev->hpi.lcp.mutex);
|
||||
}
|
||||
|
||||
static inline void c67x00_ll_husb_sie_init(struct c67x00_sie *sie)
|
||||
{
|
||||
struct c67x00_device *dev = sie->dev;
|
||||
struct c67x00_lcp_int_data data;
|
||||
int rc;
|
||||
|
||||
rc = c67x00_comm_exec_int(dev, HUSB_SIE_INIT_INT(sie->sie_num), &data);
|
||||
BUG_ON(rc); /* No return path for error code; crash spectacularly */
|
||||
}
|
||||
|
||||
void c67x00_ll_husb_reset(struct c67x00_sie *sie, int port)
|
||||
{
|
||||
struct c67x00_device *dev = sie->dev;
|
||||
struct c67x00_lcp_int_data data;
|
||||
int rc;
|
||||
|
||||
data.regs[0] = 50; /* Reset USB port for 50ms */
|
||||
data.regs[1] = port | (sie->sie_num << 1);
|
||||
rc = c67x00_comm_exec_int(dev, HUSB_RESET_INT, &data);
|
||||
BUG_ON(rc); /* No return path for error code; crash spectacularly */
|
||||
}
|
||||
|
||||
void c67x00_ll_husb_set_current_td(struct c67x00_sie *sie, u16 addr)
|
||||
{
|
||||
hpi_write_word(sie->dev, HUSB_SIE_pCurrentTDPtr(sie->sie_num), addr);
|
||||
}
|
||||
|
||||
u16 c67x00_ll_husb_get_current_td(struct c67x00_sie *sie)
|
||||
{
|
||||
return hpi_read_word(sie->dev, HUSB_SIE_pCurrentTDPtr(sie->sie_num));
|
||||
}
|
||||
|
||||
u16 c67x00_ll_husb_get_frame(struct c67x00_sie *sie)
|
||||
{
|
||||
return hpi_read_word(sie->dev, HOST_FRAME_REG(sie->sie_num));
|
||||
}
|
||||
|
||||
void c67x00_ll_husb_init_host_port(struct c67x00_sie *sie)
|
||||
{
|
||||
/* Set port into host mode */
|
||||
hpi_set_bits(sie->dev, USB_CTL_REG(sie->sie_num), HOST_MODE);
|
||||
c67x00_ll_husb_sie_init(sie);
|
||||
/* Clear interrupts */
|
||||
c67x00_ll_usb_clear_status(sie, HOST_STAT_MASK);
|
||||
/* Check */
|
||||
if (!(hpi_read_word(sie->dev, USB_CTL_REG(sie->sie_num)) & HOST_MODE))
|
||||
dev_warn(sie_dev(sie),
|
||||
"SIE %d not set to host mode\n", sie->sie_num);
|
||||
}
|
||||
|
||||
void c67x00_ll_husb_reset_port(struct c67x00_sie *sie, int port)
|
||||
{
|
||||
/* Clear connect change */
|
||||
c67x00_ll_usb_clear_status(sie, PORT_CONNECT_CHANGE(port));
|
||||
|
||||
/* Enable interrupts */
|
||||
hpi_set_bits(sie->dev, HPI_IRQ_ROUTING_REG,
|
||||
SOFEOP_TO_CPU_EN(sie->sie_num));
|
||||
hpi_set_bits(sie->dev, HOST_IRQ_EN_REG(sie->sie_num),
|
||||
SOF_EOP_IRQ_EN | DONE_IRQ_EN);
|
||||
|
||||
/* Enable pull down transistors */
|
||||
hpi_set_bits(sie->dev, USB_CTL_REG(sie->sie_num), PORT_RES_EN(port));
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
void c67x00_ll_irq(struct c67x00_device *dev, u16 int_status)
|
||||
{
|
||||
if ((int_status & MBX_OUT_FLG) == 0)
|
||||
return;
|
||||
|
||||
dev->hpi.lcp.last_msg = hpi_recv_mbox(dev);
|
||||
complete(&dev->hpi.lcp.msg_received);
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
int c67x00_ll_reset(struct c67x00_device *dev)
|
||||
{
|
||||
int rc;
|
||||
|
||||
mutex_lock(&dev->hpi.lcp.mutex);
|
||||
hpi_send_mbox(dev, COMM_RESET);
|
||||
rc = ll_recv_msg(dev);
|
||||
mutex_unlock(&dev->hpi.lcp.mutex);
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
/**
|
||||
* c67x00_ll_write_mem_le16 - write into c67x00 memory
|
||||
* Only data is little endian, addr has cpu endianess.
|
||||
*/
|
||||
void c67x00_ll_write_mem_le16(struct c67x00_device *dev, u16 addr,
|
||||
void *data, int len)
|
||||
{
|
||||
u8 *buf = data;
|
||||
|
||||
/* Sanity check */
|
||||
if (addr + len > 0xffff) {
|
||||
dev_err(&dev->pdev->dev,
|
||||
"Trying to write beyond writable region!\n");
|
||||
return;
|
||||
}
|
||||
|
||||
if (addr & 0x01) {
|
||||
/* unaligned access */
|
||||
u16 tmp;
|
||||
tmp = hpi_read_word(dev, addr - 1);
|
||||
tmp = (tmp & 0x00ff) | (*buf++ << 8);
|
||||
hpi_write_word(dev, addr - 1, tmp);
|
||||
addr++;
|
||||
len--;
|
||||
}
|
||||
|
||||
hpi_write_words_le16(dev, addr, (__le16 *)buf, len / 2);
|
||||
buf += len & ~0x01;
|
||||
addr += len & ~0x01;
|
||||
len &= 0x01;
|
||||
|
||||
if (len) {
|
||||
u16 tmp;
|
||||
tmp = hpi_read_word(dev, addr);
|
||||
tmp = (tmp & 0xff00) | *buf;
|
||||
hpi_write_word(dev, addr, tmp);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* c67x00_ll_read_mem_le16 - read from c67x00 memory
|
||||
* Only data is little endian, addr has cpu endianess.
|
||||
*/
|
||||
void c67x00_ll_read_mem_le16(struct c67x00_device *dev, u16 addr,
|
||||
void *data, int len)
|
||||
{
|
||||
u8 *buf = data;
|
||||
|
||||
if (addr & 0x01) {
|
||||
/* unaligned access */
|
||||
u16 tmp;
|
||||
tmp = hpi_read_word(dev, addr - 1);
|
||||
*buf++ = (tmp >> 8) & 0x00ff;
|
||||
addr++;
|
||||
len--;
|
||||
}
|
||||
|
||||
hpi_read_words_le16(dev, addr, (__le16 *)buf, len / 2);
|
||||
buf += len & ~0x01;
|
||||
addr += len & ~0x01;
|
||||
len &= 0x01;
|
||||
|
||||
if (len) {
|
||||
u16 tmp;
|
||||
tmp = hpi_read_word(dev, addr);
|
||||
*buf = tmp & 0x00ff;
|
||||
}
|
||||
}
|
||||
|
||||
/* -------------------------------------------------------------------------- */
|
||||
|
||||
void c67x00_ll_init(struct c67x00_device *dev)
|
||||
{
|
||||
mutex_init(&dev->hpi.lcp.mutex);
|
||||
init_completion(&dev->hpi.lcp.msg_received);
|
||||
}
|
||||
|
||||
void c67x00_ll_release(struct c67x00_device *dev)
|
||||
{
|
||||
}
|
||||
1162
drivers/usb/c67x00/c67x00-sched.c
Normal file
1162
drivers/usb/c67x00/c67x00-sched.c
Normal file
File diff suppressed because it is too large
Load diff
294
drivers/usb/c67x00/c67x00.h
Normal file
294
drivers/usb/c67x00/c67x00.h
Normal file
|
|
@ -0,0 +1,294 @@
|
|||
/*
|
||||
* c67x00.h: Cypress C67X00 USB register and field definitions
|
||||
*
|
||||
* Copyright (C) 2006-2008 Barco N.V.
|
||||
* Derived from the Cypress cy7c67200/300 ezusb linux driver and
|
||||
* based on multiple host controller drivers inside the linux kernel.
|
||||
*
|
||||
* 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., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301 USA.
|
||||
*/
|
||||
|
||||
#ifndef _USB_C67X00_H
|
||||
#define _USB_C67X00_H
|
||||
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/completion.h>
|
||||
#include <linux/mutex.h>
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* Cypress C67x00 register definitions
|
||||
*/
|
||||
|
||||
/* Hardware Revision Register */
|
||||
#define HW_REV_REG 0xC004
|
||||
|
||||
/* General USB registers */
|
||||
/* ===================== */
|
||||
|
||||
/* USB Control Register */
|
||||
#define USB_CTL_REG(x) ((x) ? 0xC0AA : 0xC08A)
|
||||
|
||||
#define LOW_SPEED_PORT(x) ((x) ? 0x0800 : 0x0400)
|
||||
#define HOST_MODE 0x0200
|
||||
#define PORT_RES_EN(x) ((x) ? 0x0100 : 0x0080)
|
||||
#define SOF_EOP_EN(x) ((x) ? 0x0002 : 0x0001)
|
||||
|
||||
/* USB status register - Notice it has different content in hcd/udc mode */
|
||||
#define USB_STAT_REG(x) ((x) ? 0xC0B0 : 0xC090)
|
||||
|
||||
#define EP0_IRQ_FLG 0x0001
|
||||
#define EP1_IRQ_FLG 0x0002
|
||||
#define EP2_IRQ_FLG 0x0004
|
||||
#define EP3_IRQ_FLG 0x0008
|
||||
#define EP4_IRQ_FLG 0x0010
|
||||
#define EP5_IRQ_FLG 0x0020
|
||||
#define EP6_IRQ_FLG 0x0040
|
||||
#define EP7_IRQ_FLG 0x0080
|
||||
#define RESET_IRQ_FLG 0x0100
|
||||
#define SOF_EOP_IRQ_FLG 0x0200
|
||||
#define ID_IRQ_FLG 0x4000
|
||||
#define VBUS_IRQ_FLG 0x8000
|
||||
|
||||
/* USB Host only registers */
|
||||
/* ======================= */
|
||||
|
||||
/* Host n Control Register */
|
||||
#define HOST_CTL_REG(x) ((x) ? 0xC0A0 : 0xC080)
|
||||
|
||||
#define PREAMBLE_EN 0x0080 /* Preamble enable */
|
||||
#define SEQ_SEL 0x0040 /* Data Toggle Sequence Bit Select */
|
||||
#define ISO_EN 0x0010 /* Isochronous enable */
|
||||
#define ARM_EN 0x0001 /* Arm operation */
|
||||
|
||||
/* Host n Interrupt Enable Register */
|
||||
#define HOST_IRQ_EN_REG(x) ((x) ? 0xC0AC : 0xC08C)
|
||||
|
||||
#define SOF_EOP_IRQ_EN 0x0200 /* SOF/EOP Interrupt Enable */
|
||||
#define SOF_EOP_TMOUT_IRQ_EN 0x0800 /* SOF/EOP Timeout Interrupt Enable */
|
||||
#define ID_IRQ_EN 0x4000 /* ID interrupt enable */
|
||||
#define VBUS_IRQ_EN 0x8000 /* VBUS interrupt enable */
|
||||
#define DONE_IRQ_EN 0x0001 /* Done Interrupt Enable */
|
||||
|
||||
/* USB status register */
|
||||
#define HOST_STAT_MASK 0x02FD
|
||||
#define PORT_CONNECT_CHANGE(x) ((x) ? 0x0020 : 0x0010)
|
||||
#define PORT_SE0_STATUS(x) ((x) ? 0x0008 : 0x0004)
|
||||
|
||||
/* Host Frame Register */
|
||||
#define HOST_FRAME_REG(x) ((x) ? 0xC0B6 : 0xC096)
|
||||
|
||||
#define HOST_FRAME_MASK 0x07FF
|
||||
|
||||
/* USB Peripheral only registers */
|
||||
/* ============================= */
|
||||
|
||||
/* Device n Port Sel reg */
|
||||
#define DEVICE_N_PORT_SEL(x) ((x) ? 0xC0A4 : 0xC084)
|
||||
|
||||
/* Device n Interrupt Enable Register */
|
||||
#define DEVICE_N_IRQ_EN_REG(x) ((x) ? 0xC0AC : 0xC08C)
|
||||
|
||||
#define DEVICE_N_ENDPOINT_N_CTL_REG(dev, ep) ((dev) \
|
||||
? (0x0280 + (ep << 4)) \
|
||||
: (0x0200 + (ep << 4)))
|
||||
#define DEVICE_N_ENDPOINT_N_STAT_REG(dev, ep) ((dev) \
|
||||
? (0x0286 + (ep << 4)) \
|
||||
: (0x0206 + (ep << 4)))
|
||||
|
||||
#define DEVICE_N_ADDRESS(dev) ((dev) ? (0xC0AE) : (0xC08E))
|
||||
|
||||
/* HPI registers */
|
||||
/* ============= */
|
||||
|
||||
/* HPI Status register */
|
||||
#define SOFEOP_FLG(x) (1 << ((x) ? 12 : 10))
|
||||
#define SIEMSG_FLG(x) (1 << (4 + (x)))
|
||||
#define RESET_FLG(x) ((x) ? 0x0200 : 0x0002)
|
||||
#define DONE_FLG(x) (1 << (2 + (x)))
|
||||
#define RESUME_FLG(x) (1 << (6 + (x)))
|
||||
#define MBX_OUT_FLG 0x0001 /* Message out available */
|
||||
#define MBX_IN_FLG 0x0100
|
||||
#define ID_FLG 0x4000
|
||||
#define VBUS_FLG 0x8000
|
||||
|
||||
/* Interrupt routing register */
|
||||
#define HPI_IRQ_ROUTING_REG 0x0142
|
||||
|
||||
#define HPI_SWAP_ENABLE(x) ((x) ? 0x0100 : 0x0001)
|
||||
#define RESET_TO_HPI_ENABLE(x) ((x) ? 0x0200 : 0x0002)
|
||||
#define DONE_TO_HPI_ENABLE(x) ((x) ? 0x0008 : 0x0004)
|
||||
#define RESUME_TO_HPI_ENABLE(x) ((x) ? 0x0080 : 0x0040)
|
||||
#define SOFEOP_TO_HPI_EN(x) ((x) ? 0x2000 : 0x0800)
|
||||
#define SOFEOP_TO_CPU_EN(x) ((x) ? 0x1000 : 0x0400)
|
||||
#define ID_TO_HPI_ENABLE 0x4000
|
||||
#define VBUS_TO_HPI_ENABLE 0x8000
|
||||
|
||||
/* SIE msg registers */
|
||||
#define SIEMSG_REG(x) ((x) ? 0x0148 : 0x0144)
|
||||
|
||||
#define HUSB_TDListDone 0x1000
|
||||
|
||||
#define SUSB_EP0_MSG 0x0001
|
||||
#define SUSB_EP1_MSG 0x0002
|
||||
#define SUSB_EP2_MSG 0x0004
|
||||
#define SUSB_EP3_MSG 0x0008
|
||||
#define SUSB_EP4_MSG 0x0010
|
||||
#define SUSB_EP5_MSG 0x0020
|
||||
#define SUSB_EP6_MSG 0x0040
|
||||
#define SUSB_EP7_MSG 0x0080
|
||||
#define SUSB_RST_MSG 0x0100
|
||||
#define SUSB_SOF_MSG 0x0200
|
||||
#define SUSB_CFG_MSG 0x0400
|
||||
#define SUSB_SUS_MSG 0x0800
|
||||
#define SUSB_ID_MSG 0x4000
|
||||
#define SUSB_VBUS_MSG 0x8000
|
||||
|
||||
/* BIOS interrupt routines */
|
||||
|
||||
#define SUSBx_RECEIVE_INT(x) ((x) ? 97 : 81)
|
||||
#define SUSBx_SEND_INT(x) ((x) ? 96 : 80)
|
||||
|
||||
#define SUSBx_DEV_DESC_VEC(x) ((x) ? 0x00D4 : 0x00B4)
|
||||
#define SUSBx_CONF_DESC_VEC(x) ((x) ? 0x00D6 : 0x00B6)
|
||||
#define SUSBx_STRING_DESC_VEC(x) ((x) ? 0x00D8 : 0x00B8)
|
||||
|
||||
#define CY_HCD_BUF_ADDR 0x500 /* Base address for host */
|
||||
#define SIE_TD_SIZE 0x200 /* size of the td list */
|
||||
#define SIE_TD_BUF_SIZE 0x400 /* size of the data buffer */
|
||||
|
||||
#define SIE_TD_OFFSET(host) ((host) ? (SIE_TD_SIZE+SIE_TD_BUF_SIZE) : 0)
|
||||
#define SIE_BUF_OFFSET(host) (SIE_TD_OFFSET(host) + SIE_TD_SIZE)
|
||||
|
||||
/* Base address of HCD + 2 x TD_SIZE + 2 x TD_BUF_SIZE */
|
||||
#define CY_UDC_REQ_HEADER_BASE 0x1100
|
||||
/* 8- byte request headers for IN/OUT transfers */
|
||||
#define CY_UDC_REQ_HEADER_SIZE 8
|
||||
|
||||
#define CY_UDC_REQ_HEADER_ADDR(ep_num) (CY_UDC_REQ_HEADER_BASE + \
|
||||
((ep_num) * CY_UDC_REQ_HEADER_SIZE))
|
||||
#define CY_UDC_DESC_BASE_ADDRESS (CY_UDC_REQ_HEADER_ADDR(8))
|
||||
|
||||
#define CY_UDC_BIOS_REPLACE_BASE 0x1800
|
||||
#define CY_UDC_REQ_BUFFER_BASE 0x2000
|
||||
#define CY_UDC_REQ_BUFFER_SIZE 0x0400
|
||||
#define CY_UDC_REQ_BUFFER_ADDR(ep_num) (CY_UDC_REQ_BUFFER_BASE + \
|
||||
((ep_num) * CY_UDC_REQ_BUFFER_SIZE))
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* Driver data structures
|
||||
*/
|
||||
|
||||
struct c67x00_device;
|
||||
|
||||
/**
|
||||
* struct c67x00_sie - Common data associated with a SIE
|
||||
* @lock: lock to protect this struct and the associated chip registers
|
||||
* @private_data: subdriver dependent data
|
||||
* @irq: subdriver dependent irq handler, set NULL when not used
|
||||
* @dev: link to common driver structure
|
||||
* @sie_num: SIE number on chip, starting from 0
|
||||
* @mode: SIE mode (host/peripheral/otg/not used)
|
||||
*/
|
||||
struct c67x00_sie {
|
||||
/* Entries to be used by the subdrivers */
|
||||
spinlock_t lock; /* protect this structure */
|
||||
void *private_data;
|
||||
void (*irq) (struct c67x00_sie *sie, u16 int_status, u16 msg);
|
||||
|
||||
/* Read only: */
|
||||
struct c67x00_device *dev;
|
||||
int sie_num;
|
||||
int mode;
|
||||
};
|
||||
|
||||
#define sie_dev(s) (&(s)->dev->pdev->dev)
|
||||
|
||||
/**
|
||||
* struct c67x00_lcp
|
||||
*/
|
||||
struct c67x00_lcp {
|
||||
/* Internal use only */
|
||||
struct mutex mutex;
|
||||
struct completion msg_received;
|
||||
u16 last_msg;
|
||||
};
|
||||
|
||||
/*
|
||||
* struct c67x00_hpi
|
||||
*/
|
||||
struct c67x00_hpi {
|
||||
void __iomem *base;
|
||||
int regstep;
|
||||
spinlock_t lock;
|
||||
struct c67x00_lcp lcp;
|
||||
};
|
||||
|
||||
#define C67X00_SIES 2
|
||||
#define C67X00_PORTS 2
|
||||
|
||||
/**
|
||||
* struct c67x00_device - Common data associated with a c67x00 instance
|
||||
* @hpi: hpi addresses
|
||||
* @sie: array of sie's on this chip
|
||||
* @pdev: platform device of instance
|
||||
* @pdata: configuration provided by the platform
|
||||
*/
|
||||
struct c67x00_device {
|
||||
struct c67x00_hpi hpi;
|
||||
struct c67x00_sie sie[C67X00_SIES];
|
||||
struct platform_device *pdev;
|
||||
struct c67x00_platform_data *pdata;
|
||||
};
|
||||
|
||||
/* ---------------------------------------------------------------------
|
||||
* Low level interface functions
|
||||
*/
|
||||
|
||||
/* Host Port Interface (HPI) functions */
|
||||
u16 c67x00_ll_hpi_status(struct c67x00_device *dev);
|
||||
void c67x00_ll_hpi_reg_init(struct c67x00_device *dev);
|
||||
void c67x00_ll_hpi_enable_sofeop(struct c67x00_sie *sie);
|
||||
void c67x00_ll_hpi_disable_sofeop(struct c67x00_sie *sie);
|
||||
|
||||
/* General functions */
|
||||
u16 c67x00_ll_fetch_siemsg(struct c67x00_device *dev, int sie_num);
|
||||
u16 c67x00_ll_get_usb_ctl(struct c67x00_sie *sie);
|
||||
void c67x00_ll_usb_clear_status(struct c67x00_sie *sie, u16 bits);
|
||||
u16 c67x00_ll_usb_get_status(struct c67x00_sie *sie);
|
||||
void c67x00_ll_write_mem_le16(struct c67x00_device *dev, u16 addr,
|
||||
void *data, int len);
|
||||
void c67x00_ll_read_mem_le16(struct c67x00_device *dev, u16 addr,
|
||||
void *data, int len);
|
||||
|
||||
/* Host specific functions */
|
||||
void c67x00_ll_set_husb_eot(struct c67x00_device *dev, u16 value);
|
||||
void c67x00_ll_husb_reset(struct c67x00_sie *sie, int port);
|
||||
void c67x00_ll_husb_set_current_td(struct c67x00_sie *sie, u16 addr);
|
||||
u16 c67x00_ll_husb_get_current_td(struct c67x00_sie *sie);
|
||||
u16 c67x00_ll_husb_get_frame(struct c67x00_sie *sie);
|
||||
void c67x00_ll_husb_init_host_port(struct c67x00_sie *sie);
|
||||
void c67x00_ll_husb_reset_port(struct c67x00_sie *sie, int port);
|
||||
|
||||
/* Called by c67x00_irq to handle lcp interrupts */
|
||||
void c67x00_ll_irq(struct c67x00_device *dev, u16 int_status);
|
||||
|
||||
/* Setup and teardown */
|
||||
void c67x00_ll_init(struct c67x00_device *dev);
|
||||
void c67x00_ll_release(struct c67x00_device *dev);
|
||||
int c67x00_ll_reset(struct c67x00_device *dev);
|
||||
|
||||
#endif /* _USB_C67X00_H */
|
||||
Loading…
Add table
Add a link
Reference in a new issue