Skip to content

L
linux
Commit 1da9e1c0 authored by Rui Miguel Silva's avatar Rui Miguel Silva Committed by Greg Kroah-Hartman
Browse files
Options

usb: isp1760: move to regmap for register access 

Rework access to registers and memory to use regmap framework.
No change in current feature or way of work is intended with this
change.

This will allow to reuse this driver with other IP of this family,
for example isp1763, with little changes and effort.
Signed-off-by: default avatarRui Miguel Silva <rui.silva@linaro.org>
Link: https://lore.kernel.org/r/20210513084717.2487366-3-rui.silva@linaro.orgSigned-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent abfabc8a
Show whitespace changes
Inline Side-by-side
Showing with 789 additions and 531 deletions
drivers/usb/isp1760/Kconfig
View file @ 1da9e1c0
...@@ -3,6 +3,7 @@ ...@@ -3,6 +3,7 @@
config USB_ISP1760 config USB_ISP1760
tristate "NXP ISP 1760/1761 support" tristate "NXP ISP 1760/1761 support"
depends on USB || USB_GADGET depends on USB || USB_GADGET
select REGMAP_MMIO
help help
Say Y or M here if your system as an ISP1760 USB host controller Say Y or M here if your system as an ISP1760 USB host controller
or an ISP1761 USB dual-role controller. or an ISP1761 USB dual-role controller.
......
drivers/usb/isp1760/isp1760-core.c
View file @ 1da9e1c0
...@@ -15,6 +15,7 @@ ...@@ -15,6 +15,7 @@
#include <linux/io.h> #include <linux/io.h>
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/regmap.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/usb.h> #include <linux/usb.h>
...@@ -25,8 +26,8 @@ ...@@ -25,8 +26,8 @@
static void isp1760_init_core(struct isp1760_device *isp) static void isp1760_init_core(struct isp1760_device *isp)
{ {
u32 otgctrl; struct isp1760_hcd *hcd = &isp->hcd;
u32 hwmode; struct isp1760_udc *udc = &isp->udc;
/* Low-level chip reset */ /* Low-level chip reset */
if (isp->rst_gpio) { if (isp->rst_gpio) {
...@@ -39,24 +40,22 @@ static void isp1760_init_core(struct isp1760_device *isp) ...@@ -39,24 +40,22 @@ static void isp1760_init_core(struct isp1760_device *isp)
* Reset the host controller, including the CPU interface * Reset the host controller, including the CPU interface
* configuration. * configuration.
*/ */
isp1760_write32(isp->regs, HC_RESET_REG, SW_RESET_RESET_ALL); isp1760_field_set(hcd->fields, SW_RESET_RESET_ALL);
msleep(100); msleep(100);
/* Setup HW Mode Control: This assumes a level active-low interrupt */ /* Setup HW Mode Control: This assumes a level active-low interrupt */
hwmode = HW_DATA_BUS_32BIT;
if (isp->devflags & ISP1760_FLAG_BUS_WIDTH_16) if (isp->devflags & ISP1760_FLAG_BUS_WIDTH_16)
hwmode &= ~HW_DATA_BUS_32BIT; isp1760_field_clear(hcd->fields, HW_DATA_BUS_WIDTH);
if (isp->devflags & ISP1760_FLAG_ANALOG_OC) if (isp->devflags & ISP1760_FLAG_ANALOG_OC)
hwmode |= HW_ANA_DIGI_OC; isp1760_field_set(hcd->fields, HW_ANA_DIGI_OC);
if (isp->devflags & ISP1760_FLAG_DACK_POL_HIGH) if (isp->devflags & ISP1760_FLAG_DACK_POL_HIGH)
hwmode |= HW_DACK_POL_HIGH; isp1760_field_set(hcd->fields, HW_DACK_POL_HIGH);
if (isp->devflags & ISP1760_FLAG_DREQ_POL_HIGH) if (isp->devflags & ISP1760_FLAG_DREQ_POL_HIGH)
hwmode |= HW_DREQ_POL_HIGH; isp1760_field_set(hcd->fields, HW_DREQ_POL_HIGH);
if (isp->devflags & ISP1760_FLAG_INTR_POL_HIGH) if (isp->devflags & ISP1760_FLAG_INTR_POL_HIGH)
hwmode |= HW_INTR_HIGH_ACT; isp1760_field_set(hcd->fields, HW_INTR_HIGH_ACT);
if (isp->devflags & ISP1760_FLAG_INTR_EDGE_TRIG) if (isp->devflags & ISP1760_FLAG_INTR_EDGE_TRIG)
hwmode |= HW_INTR_EDGE_TRIG; isp1760_field_set(hcd->fields, HW_INTR_EDGE_TRIG);
/* /*
* The ISP1761 has a dedicated DC IRQ line but supports sharing the HC * The ISP1761 has a dedicated DC IRQ line but supports sharing the HC
...@@ -65,18 +64,10 @@ static void isp1760_init_core(struct isp1760_device *isp) ...@@ -65,18 +64,10 @@ static void isp1760_init_core(struct isp1760_device *isp)
* spurious interrupts during HCD registration. * spurious interrupts during HCD registration.
*/ */
if (isp->devflags & ISP1760_FLAG_ISP1761) { if (isp->devflags & ISP1760_FLAG_ISP1761) {
isp1760_write32(isp->regs, DC_MODE, 0); isp1760_reg_write(udc->regs, ISP176x_DC_MODE, 0);
hwmode |= HW_COMN_IRQ; isp1760_field_set(hcd->fields, HW_COMN_IRQ);
} }
/*
* We have to set this first in case we're in 16-bit mode.
* Write it twice to ensure correct upper bits if switching
* to 16-bit mode.
*/
isp1760_write32(isp->regs, HC_HW_MODE_CTRL, hwmode);
isp1760_write32(isp->regs, HC_HW_MODE_CTRL, hwmode);
/* /*
* PORT 1 Control register of the ISP1760 is the OTG control register * PORT 1 Control register of the ISP1760 is the OTG control register
* on ISP1761. * on ISP1761.
...@@ -85,14 +76,15 @@ static void isp1760_init_core(struct isp1760_device *isp) ...@@ -85,14 +76,15 @@ static void isp1760_init_core(struct isp1760_device *isp)
* when OTG is requested. * when OTG is requested.
*/ */
if ((isp->devflags & ISP1760_FLAG_ISP1761) && if ((isp->devflags & ISP1760_FLAG_ISP1761) &&
(isp->devflags & ISP1760_FLAG_OTG_EN)) (isp->devflags & ISP1760_FLAG_OTG_EN)) {
otgctrl = ((HW_DM_PULLDOWN | HW_DP_PULLDOWN) << 16) isp1760_field_set(hcd->fields, HW_DM_PULLDOWN);
| HW_OTG_DISABLE; isp1760_field_set(hcd->fields, HW_DP_PULLDOWN);
else isp1760_field_set(hcd->fields, HW_OTG_DISABLE);
otgctrl = (HW_SW_SEL_HC_DC << 16) } else {
| (HW_VBUS_DRV | HW_SEL_CP_EXT); isp1760_field_set(hcd->fields, HW_SW_SEL_HC_DC);
isp1760_field_set(hcd->fields, HW_VBUS_DRV);
isp1760_write32(isp->regs, HC_PORT1_CTRL, otgctrl); isp1760_field_set(hcd->fields, HW_SEL_CP_EXT);
}
dev_info(isp->dev, "bus width: %u, oc: %s\n", dev_info(isp->dev, "bus width: %u, oc: %s\n",
isp->devflags & ISP1760_FLAG_BUS_WIDTH_16 ? 16 : 32, isp->devflags & ISP1760_FLAG_BUS_WIDTH_16 ? 16 : 32,
...@@ -101,16 +93,158 @@ static void isp1760_init_core(struct isp1760_device *isp) ...@@ -101,16 +93,158 @@ static void isp1760_init_core(struct isp1760_device *isp)
void isp1760_set_pullup(struct isp1760_device *isp, bool enable) void isp1760_set_pullup(struct isp1760_device *isp, bool enable)
{ {
isp1760_write32(isp->regs, HW_OTG_CTRL_SET, struct isp1760_udc *udc = &isp->udc;
enable ? HW_DP_PULLUP : HW_DP_PULLUP << 16);
if (enable)
isp1760_field_set(udc->fields, HW_DP_PULLUP);
else
isp1760_field_set(udc->fields, HW_DP_PULLUP_CLEAR);
} }
static const struct regmap_range isp176x_hc_volatile_ranges[] = {
regmap_reg_range(ISP176x_HC_USBCMD, ISP176x_HC_ATL_PTD_LASTPTD),
regmap_reg_range(ISP176x_HC_BUFFER_STATUS, ISP176x_HC_MEMORY),
regmap_reg_range(ISP176x_HC_INTERRUPT, ISP176x_HC_ATL_IRQ_MASK_AND),
};
static const struct regmap_access_table isp176x_hc_volatile_table = {
.yes_ranges = isp176x_hc_volatile_ranges,
.n_yes_ranges = ARRAY_SIZE(isp176x_hc_volatile_ranges),
};
static struct regmap_config isp1760_hc_regmap_conf = {
.name = "isp1760-hc",
.reg_bits = 16,
.reg_stride = 4,
.val_bits = 32,
.fast_io = true,
.max_register = ISP176x_HC_MEMORY,
.volatile_table = &isp176x_hc_volatile_table,
};
static const struct reg_field isp1760_hc_reg_fields[] = {
[HCS_PPC] = REG_FIELD(ISP176x_HC_HCSPARAMS, 4, 4),
[HCS_N_PORTS] = REG_FIELD(ISP176x_HC_HCSPARAMS, 0, 3),
[HCC_ISOC_CACHE] = REG_FIELD(ISP176x_HC_HCCPARAMS, 7, 7),
[HCC_ISOC_THRES] = REG_FIELD(ISP176x_HC_HCCPARAMS, 4, 6),
[CMD_LRESET] = REG_FIELD(ISP176x_HC_USBCMD, 7, 7),
[CMD_RESET] = REG_FIELD(ISP176x_HC_USBCMD, 1, 1),
[CMD_RUN] = REG_FIELD(ISP176x_HC_USBCMD, 0, 0),
[STS_PCD] = REG_FIELD(ISP176x_HC_USBSTS, 2, 2),
[HC_FRINDEX] = REG_FIELD(ISP176x_HC_FRINDEX, 0, 13),
[FLAG_CF] = REG_FIELD(ISP176x_HC_CONFIGFLAG, 0, 0),
[PORT_OWNER] = REG_FIELD(ISP176x_HC_PORTSC1, 13, 13),
[PORT_POWER] = REG_FIELD(ISP176x_HC_PORTSC1, 12, 12),
[PORT_LSTATUS] = REG_FIELD(ISP176x_HC_PORTSC1, 10, 11),
[PORT_RESET] = REG_FIELD(ISP176x_HC_PORTSC1, 8, 8),
[PORT_SUSPEND] = REG_FIELD(ISP176x_HC_PORTSC1, 7, 7),
[PORT_RESUME] = REG_FIELD(ISP176x_HC_PORTSC1, 6, 6),
[PORT_PE] = REG_FIELD(ISP176x_HC_PORTSC1, 2, 2),
[PORT_CSC] = REG_FIELD(ISP176x_HC_PORTSC1, 1, 1),
[PORT_CONNECT] = REG_FIELD(ISP176x_HC_PORTSC1, 0, 0),
[ALL_ATX_RESET] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 31, 31),
[HW_ANA_DIGI_OC] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 15, 15),
[HW_COMN_IRQ] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 10, 10),
[HW_DATA_BUS_WIDTH] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 8, 8),
[HW_DACK_POL_HIGH] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 6, 6),
[HW_DREQ_POL_HIGH] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 5, 5),
[HW_INTR_HIGH_ACT] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 2, 2),
[HW_INTR_EDGE_TRIG] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 1, 1),
[HW_GLOBAL_INTR_EN] = REG_FIELD(ISP176x_HC_HW_MODE_CTRL, 0, 0),
[SW_RESET_RESET_ALL] = REG_FIELD(ISP176x_HC_RESET, 0, 0),
[INT_BUF_FILL] = REG_FIELD(ISP176x_HC_BUFFER_STATUS, 1, 1),
[ATL_BUF_FILL] = REG_FIELD(ISP176x_HC_BUFFER_STATUS, 0, 0),
[MEM_BANK_SEL] = REG_FIELD(ISP176x_HC_MEMORY, 16, 17),
[MEM_START_ADDR] = REG_FIELD(ISP176x_HC_MEMORY, 0, 15),
[HC_INT_ENABLE] = REG_FIELD(ISP176x_HC_INTERRUPT_ENABLE, 7, 8),
};
static const struct regmap_range isp176x_dc_volatile_ranges[] = {
regmap_reg_range(ISP176x_DC_EPMAXPKTSZ, ISP176x_DC_EPTYPE),
regmap_reg_range(ISP176x_DC_BUFLEN, ISP176x_DC_EPINDEX),
regmap_reg_range(ISP1761_DC_OTG_CTRL_SET, ISP1761_DC_OTG_CTRL_CLEAR),
};
static const struct regmap_access_table isp176x_dc_volatile_table = {
.yes_ranges = isp176x_dc_volatile_ranges,
.n_yes_ranges = ARRAY_SIZE(isp176x_dc_volatile_ranges),
};
static struct regmap_config isp1761_dc_regmap_conf = {
.name = "isp1761-dc",
.reg_bits = 16,
.reg_stride = 4,
.val_bits = 32,
.fast_io = true,
.max_register = ISP1761_DC_OTG_CTRL_CLEAR,
.volatile_table = &isp176x_dc_volatile_table,
};
static const struct reg_field isp1761_dc_reg_fields[] = {
[DC_DEVEN] = REG_FIELD(ISP176x_DC_ADDRESS, 7, 7),
[DC_DEVADDR] = REG_FIELD(ISP176x_DC_ADDRESS, 0, 6),
[DC_VBUSSTAT] = REG_FIELD(ISP176x_DC_MODE, 8, 8),
[DC_SFRESET] = REG_FIELD(ISP176x_DC_MODE, 4, 4),
[DC_GLINTENA] = REG_FIELD(ISP176x_DC_MODE, 3, 3),
[DC_CDBGMOD_ACK] = REG_FIELD(ISP176x_DC_INTCONF, 6, 6),
[DC_DDBGMODIN_ACK] = REG_FIELD(ISP176x_DC_INTCONF, 4, 4),
[DC_DDBGMODOUT_ACK] = REG_FIELD(ISP176x_DC_INTCONF, 2, 2),
[DC_INTPOL] = REG_FIELD(ISP176x_DC_INTCONF, 0, 0),
[DC_IEPRXTX_7] = REG_FIELD(ISP176x_DC_INTENABLE, 25, 25),
[DC_IEPRXTX_6] = REG_FIELD(ISP176x_DC_INTENABLE, 23, 23),
[DC_IEPRXTX_5] = REG_FIELD(ISP176x_DC_INTENABLE, 21, 21),
[DC_IEPRXTX_4] = REG_FIELD(ISP176x_DC_INTENABLE, 19, 19),
[DC_IEPRXTX_3] = REG_FIELD(ISP176x_DC_INTENABLE, 17, 17),
[DC_IEPRXTX_2] = REG_FIELD(ISP176x_DC_INTENABLE, 15, 15),
[DC_IEPRXTX_1] = REG_FIELD(ISP176x_DC_INTENABLE, 13, 13),
[DC_IEPRXTX_0] = REG_FIELD(ISP176x_DC_INTENABLE, 11, 11),
[DC_IEP0SETUP] = REG_FIELD(ISP176x_DC_INTENABLE, 8, 8),
[DC_IEVBUS] = REG_FIELD(ISP176x_DC_INTENABLE, 7, 7),
[DC_IEHS_STA] = REG_FIELD(ISP176x_DC_INTENABLE, 5, 5),
[DC_IERESM] = REG_FIELD(ISP176x_DC_INTENABLE, 4, 4),
[DC_IESUSP] = REG_FIELD(ISP176x_DC_INTENABLE, 3, 3),
[DC_IEBRST] = REG_FIELD(ISP176x_DC_INTENABLE, 0, 0),
[DC_EP0SETUP] = REG_FIELD(ISP176x_DC_EPINDEX, 5, 5),
[DC_ENDPIDX] = REG_FIELD(ISP176x_DC_EPINDEX, 1, 4),
[DC_EPDIR] = REG_FIELD(ISP176x_DC_EPINDEX, 0, 0),
[DC_CLBUF] = REG_FIELD(ISP176x_DC_CTRLFUNC, 4, 4),
[DC_VENDP] = REG_FIELD(ISP176x_DC_CTRLFUNC, 3, 3),
[DC_DSEN] = REG_FIELD(ISP176x_DC_CTRLFUNC, 2, 2),
[DC_STATUS] = REG_FIELD(ISP176x_DC_CTRLFUNC, 1, 1),
[DC_STALL] = REG_FIELD(ISP176x_DC_CTRLFUNC, 0, 0),
[DC_BUFLEN] = REG_FIELD(ISP176x_DC_BUFLEN, 0, 15),
[DC_FFOSZ] = REG_FIELD(ISP176x_DC_EPMAXPKTSZ, 0, 10),
[DC_EPENABLE] = REG_FIELD(ISP176x_DC_EPTYPE, 3, 3),
[DC_ENDPTYP] = REG_FIELD(ISP176x_DC_EPTYPE, 0, 1),
[DC_UFRAMENUM] = REG_FIELD(ISP176x_DC_FRAMENUM, 11, 13),
[DC_FRAMENUM] = REG_FIELD(ISP176x_DC_FRAMENUM, 0, 10),
[HW_OTG_DISABLE] = REG_FIELD(ISP1761_DC_OTG_CTRL_SET, 10, 10),
[HW_SW_SEL_HC_DC] = REG_FIELD(ISP1761_DC_OTG_CTRL_SET, 7, 7),
[HW_VBUS_DRV] = REG_FIELD(ISP1761_DC_OTG_CTRL_SET, 4, 4),
[HW_SEL_CP_EXT] = REG_FIELD(ISP1761_DC_OTG_CTRL_SET, 3, 3),
[HW_DM_PULLDOWN] = REG_FIELD(ISP1761_DC_OTG_CTRL_SET, 2, 2),
[HW_DP_PULLDOWN] = REG_FIELD(ISP1761_DC_OTG_CTRL_SET, 1, 1),
[HW_DP_PULLUP] = REG_FIELD(ISP1761_DC_OTG_CTRL_SET, 0, 0),
[HW_OTG_DISABLE_CLEAR] = REG_FIELD(ISP1761_DC_OTG_CTRL_CLEAR, 10, 10),
[HW_SW_SEL_HC_DC_CLEAR] = REG_FIELD(ISP1761_DC_OTG_CTRL_CLEAR, 7, 7),
[HW_VBUS_DRV_CLEAR] = REG_FIELD(ISP1761_DC_OTG_CTRL_CLEAR, 4, 4),
[HW_SEL_CP_EXT_CLEAR] = REG_FIELD(ISP1761_DC_OTG_CTRL_CLEAR, 3, 3),
[HW_DM_PULLDOWN_CLEAR] = REG_FIELD(ISP1761_DC_OTG_CTRL_CLEAR, 2, 2),
[HW_DP_PULLDOWN_CLEAR] = REG_FIELD(ISP1761_DC_OTG_CTRL_CLEAR, 1, 1),
[HW_DP_PULLUP_CLEAR] = REG_FIELD(ISP1761_DC_OTG_CTRL_CLEAR, 0, 0),
};
int isp1760_register(struct resource *mem, int irq, unsigned long irqflags, int isp1760_register(struct resource *mem, int irq, unsigned long irqflags,
struct device *dev, unsigned int devflags) struct device *dev, unsigned int devflags)
{ {
struct isp1760_device *isp; struct isp1760_device *isp;
struct isp1760_hcd *hcd;
struct isp1760_udc *udc;
bool udc_disabled = !(devflags & ISP1760_FLAG_ISP1761); bool udc_disabled = !(devflags & ISP1760_FLAG_ISP1761);
struct regmap_field *f;
void __iomem *base;
int ret; int ret;
int i;
/* /*
* If neither the HCD not the UDC is enabled return an error, as no * If neither the HCD not the UDC is enabled return an error, as no
...@@ -126,19 +260,52 @@ int isp1760_register(struct resource *mem, int irq, unsigned long irqflags, ...@@ -126,19 +260,52 @@ int isp1760_register(struct resource *mem, int irq, unsigned long irqflags,
isp->dev = dev; isp->dev = dev;
isp->devflags = devflags; isp->devflags = devflags;
hcd = &isp->hcd;
udc = &isp->udc;
if (devflags & ISP1760_FLAG_BUS_WIDTH_16) {
isp1760_hc_regmap_conf.val_bits = 16;
isp1761_dc_regmap_conf.val_bits = 16;
}
isp->rst_gpio = devm_gpiod_get_optional(dev, NULL, GPIOD_OUT_HIGH); isp->rst_gpio = devm_gpiod_get_optional(dev, NULL, GPIOD_OUT_HIGH);
if (IS_ERR(isp->rst_gpio)) if (IS_ERR(isp->rst_gpio))
return PTR_ERR(isp->rst_gpio); return PTR_ERR(isp->rst_gpio);
isp->regs = devm_ioremap_resource(dev, mem); hcd->base = devm_ioremap_resource(dev, mem);
if (IS_ERR(isp->regs)) if (IS_ERR(hcd->base))
return PTR_ERR(isp->regs); return PTR_ERR(hcd->base);
hcd->regs = devm_regmap_init_mmio(dev, base, &isp1760_hc_regmap_conf);
if (IS_ERR(hcd->regs))
return PTR_ERR(hcd->regs);
for (i = 0; i < HC_FIELD_MAX; i++) {
f = devm_regmap_field_alloc(dev, hcd->regs,
isp1760_hc_reg_fields[i]);
if (IS_ERR(f))
return PTR_ERR(f);
hcd->fields[i] = f;
}
udc->regs = devm_regmap_init_mmio(dev, base, &isp1761_dc_regmap_conf);
if (IS_ERR(udc->regs))
return PTR_ERR(udc->regs);
for (i = 0; i < DC_FIELD_MAX; i++) {
f = devm_regmap_field_alloc(dev, udc->regs,
isp1761_dc_reg_fields[i]);
if (IS_ERR(f))
return PTR_ERR(f);
udc->fields[i] = f;
}
isp1760_init_core(isp); isp1760_init_core(isp);
if (IS_ENABLED(CONFIG_USB_ISP1760_HCD) && !usb_disabled()) { if (IS_ENABLED(CONFIG_USB_ISP1760_HCD) && !usb_disabled()) {
ret = isp1760_hcd_register(&isp->hcd, isp->regs, mem, irq, ret = isp1760_hcd_register(hcd, mem, irq,
irqflags | IRQF_SHARED, dev); irqflags | IRQF_SHARED, dev);
if (ret < 0) if (ret < 0)
return ret; return ret;
...@@ -147,7 +314,7 @@ int isp1760_register(struct resource *mem, int irq, unsigned long irqflags, ...@@ -147,7 +314,7 @@ int isp1760_register(struct resource *mem, int irq, unsigned long irqflags,
if (IS_ENABLED(CONFIG_USB_ISP1761_UDC) && !udc_disabled) { if (IS_ENABLED(CONFIG_USB_ISP1761_UDC) && !udc_disabled) {
ret = isp1760_udc_register(isp, irq, irqflags); ret = isp1760_udc_register(isp, irq, irqflags);
if (ret < 0) { if (ret < 0) {
isp1760_hcd_unregister(&isp->hcd); isp1760_hcd_unregister(hcd);
return ret; return ret;
} }
} }
......
drivers/usb/isp1760/isp1760-core.h
View file @ 1da9e1c0
...@@ -14,6 +14,7 @@ ...@@ -14,6 +14,7 @@
#define _ISP1760_CORE_H_ #define _ISP1760_CORE_H_
#include <linux/ioport.h> #include <linux/ioport.h>
#include <linux/regmap.h>
#include "isp1760-hcd.h" #include "isp1760-hcd.h"
#include "isp1760-udc.h" #include "isp1760-udc.h"
...@@ -38,7 +39,6 @@ struct gpio_desc; ...@@ -38,7 +39,6 @@ struct gpio_desc;
struct isp1760_device { struct isp1760_device {
struct device *dev; struct device *dev;
void __iomem *regs;
unsigned int devflags; unsigned int devflags;
struct gpio_desc *rst_gpio; struct gpio_desc *rst_gpio;
...@@ -52,14 +52,42 @@ void isp1760_unregister(struct device *dev); ...@@ -52,14 +52,42 @@ void isp1760_unregister(struct device *dev);
void isp1760_set_pullup(struct isp1760_device *isp, bool enable); void isp1760_set_pullup(struct isp1760_device *isp, bool enable);
static inline u32 isp1760_read32(void __iomem *base, u32 reg) static inline u32 isp1760_field_read(struct regmap_field **fields, u32 field)
{ {
return readl(base + reg); unsigned int val;
regmap_field_read(fields[field], &val);
return val;
}
static inline void isp1760_field_write(struct regmap_field **fields, u32 field,
u32 val)
{
regmap_field_write(fields[field], val);
}
static inline void isp1760_field_set(struct regmap_field **fields, u32 field)
{
isp1760_field_write(fields, field, 0xFFFFFFFF);
} }
static inline void isp1760_write32(void __iomem *base, u32 reg, u32 val) static inline void isp1760_field_clear(struct regmap_field **fields, u32 field)
{ {
writel(val, base + reg); isp1760_field_write(fields, field, 0);
} }
static inline u32 isp1760_reg_read(struct regmap *regs, u32 reg)
{
unsigned int val;
regmap_read(regs, reg, &val);
return val;
}
static inline void isp1760_reg_write(struct regmap *regs, u32 reg, u32 val)
{
regmap_write(regs, reg, val);
}
#endif #endif
drivers/usb/isp1760/isp1760-hcd.c
View file @ 1da9e1c0
...@@ -66,6 +66,11 @@ struct ptd { ...@@ -66,6 +66,11 @@ struct ptd {
#define ATL_PTD_OFFSET 0x0c00 #define ATL_PTD_OFFSET 0x0c00
#define PAYLOAD_OFFSET 0x1000 #define PAYLOAD_OFFSET 0x1000
#define ISP_BANK_0 0x00
#define ISP_BANK_1 0x01
#define ISP_BANK_2 0x02
#define ISP_BANK_3 0x03
#define TO_DW(x) ((__force __dw)x) #define TO_DW(x) ((__force __dw)x)
#define TO_U32(x) ((__force u32)x) #define TO_U32(x) ((__force u32)x)
...@@ -161,16 +166,59 @@ struct urb_listitem { ...@@ -161,16 +166,59 @@ struct urb_listitem {
}; };
/* /*
* Access functions for isp176x registers (addresses 0..0x03FF). * Access functions for isp176x registers regmap fields
*/ */
static u32 reg_read32(void __iomem *base, u32 reg) static u32 isp1760_hcd_read(struct usb_hcd *hcd, u32 field)
{
struct isp1760_hcd *priv = hcd_to_priv(hcd);
return isp1760_field_read(priv->fields, field);
}
static void isp1760_hcd_write(struct usb_hcd *hcd, u32 field, u32 val)
{
struct isp1760_hcd *priv = hcd_to_priv(hcd);
isp1760_field_write(priv->fields, field, val);
}
static void isp1760_hcd_set(struct usb_hcd *hcd, u32 field)
{
isp1760_hcd_write(hcd, field, 0xFFFFFFFF);
}
static void isp1760_hcd_clear(struct usb_hcd *hcd, u32 field)
{
isp1760_hcd_write(hcd, field, 0);
}
static int isp1760_hcd_set_poll_timeout(struct usb_hcd *hcd, u32 field,
u32 timeout_us)
{
struct isp1760_hcd *priv = hcd_to_priv(hcd);
unsigned int val;
isp1760_hcd_set(hcd, field);
return regmap_field_read_poll_timeout(priv->fields[field], val, 1, 1,
timeout_us);
}
static int isp1760_hcd_clear_poll_timeout(struct usb_hcd *hcd, u32 field,
u32 timeout_us)
{ {
return isp1760_read32(base, reg); struct isp1760_hcd *priv = hcd_to_priv(hcd);
unsigned int val;
isp1760_hcd_clear(hcd, field);
return regmap_field_read_poll_timeout(priv->fields[field], val, 0, 1,
timeout_us);
} }
static void reg_write32(void __iomem *base, u32 reg, u32 val) static bool isp1760_hcd_is_set(struct usb_hcd *hcd, u32 field)
{ {
isp1760_write32(base, reg, val); return !!isp1760_hcd_read(hcd, field);
} }
/* /*
...@@ -233,12 +281,15 @@ static void bank_reads8(void __iomem *src_base, u32 src_offset, u32 bank_addr, ...@@ -233,12 +281,15 @@ static void bank_reads8(void __iomem *src_base, u32 src_offset, u32 bank_addr,
} }
} }
static void mem_reads8(void __iomem *src_base, u32 src_offset, void *dst, static void mem_reads8(struct usb_hcd *hcd, void __iomem *src_base,
u32 bytes) u32 src_offset, void *dst, u32 bytes)
{ {
reg_write32(src_base, HC_MEMORY_REG, src_offset + ISP_BANK(0)); isp1760_hcd_write(hcd, MEM_BANK_SEL, ISP_BANK_0);
isp1760_hcd_write(hcd, MEM_START_ADDR, src_offset);
ndelay(90); ndelay(90);
bank_reads8(src_base, src_offset, ISP_BANK(0), dst, bytes);
bank_reads8(src_base, src_offset, ISP_BANK_0, dst, bytes);
} }
static void mem_writes8(void __iomem *dst_base, u32 dst_offset, static void mem_writes8(void __iomem *dst_base, u32 dst_offset,
...@@ -280,14 +331,15 @@ static void mem_writes8(void __iomem *dst_base, u32 dst_offset, ...@@ -280,14 +331,15 @@ static void mem_writes8(void __iomem *dst_base, u32 dst_offset,
* Read and write ptds. 'ptd_offset' should be one of ISO_PTD_OFFSET, * Read and write ptds. 'ptd_offset' should be one of ISO_PTD_OFFSET,
* INT_PTD_OFFSET, and ATL_PTD_OFFSET. 'slot' should be less than 32. * INT_PTD_OFFSET, and ATL_PTD_OFFSET. 'slot' should be less than 32.
*/ */
static void ptd_read(void __iomem *base, u32 ptd_offset, u32 slot, static void ptd_read(struct usb_hcd *hcd, void __iomem *base,
struct ptd *ptd) u32 ptd_offset, u32 slot, struct ptd *ptd)
{ {
reg_write32(base, HC_MEMORY_REG, isp1760_hcd_write(hcd, MEM_BANK_SEL, ISP_BANK_0);
ISP_BANK(0) + ptd_offset + slot*sizeof(*ptd)); isp1760_hcd_write(hcd, MEM_START_ADDR,
ptd_offset + slot * sizeof(*ptd));
ndelay(90); ndelay(90);
bank_reads8(base, ptd_offset + slot*sizeof(*ptd), ISP_BANK(0), bank_reads8(base, ptd_offset + slot * sizeof(*ptd), ISP_BANK_0,
(void *) ptd, sizeof(*ptd)); (void *)ptd, sizeof(*ptd));
} }
static void ptd_write(void __iomem *base, u32 ptd_offset, u32 slot, static void ptd_write(void __iomem *base, u32 ptd_offset, u32 slot,
...@@ -379,34 +431,15 @@ static void free_mem(struct usb_hcd *hcd, struct isp1760_qtd *qtd) ...@@ -379,34 +431,15 @@ static void free_mem(struct usb_hcd *hcd, struct isp1760_qtd *qtd)
qtd->payload_addr = 0; qtd->payload_addr = 0;
} }
static int handshake(struct usb_hcd *hcd, u32 reg,
u32 mask, u32 done, int usec)
{
u32 result;
int ret;
ret = readl_poll_timeout_atomic(hcd->regs + reg, result,
((result & mask) == done ||
result == U32_MAX), 1, usec);
if (result == U32_MAX)
return -ENODEV;
return ret;
}
/* reset a non-running (STS_HALT == 1) controller */ /* reset a non-running (STS_HALT == 1) controller */
static int ehci_reset(struct usb_hcd *hcd) static int ehci_reset(struct usb_hcd *hcd)
{ {
struct isp1760_hcd *priv = hcd_to_priv(hcd); struct isp1760_hcd *priv = hcd_to_priv(hcd);
u32 command = reg_read32(hcd->regs, HC_USBCMD);
command |= CMD_RESET;
reg_write32(hcd->regs, HC_USBCMD, command);
hcd->state = HC_STATE_HALT; hcd->state = HC_STATE_HALT;
priv->next_statechange = jiffies; priv->next_statechange = jiffies;
return handshake(hcd, HC_USBCMD, CMD_RESET, 0, 250 * 1000); return isp1760_hcd_set_poll_timeout(hcd, CMD_RESET, 250 * 1000);
} }
static struct isp1760_qh *qh_alloc(gfp_t flags) static struct isp1760_qh *qh_alloc(gfp_t flags)
...@@ -435,7 +468,9 @@ static void qh_free(struct isp1760_qh *qh) ...@@ -435,7 +468,9 @@ static void qh_free(struct isp1760_qh *qh)
static int priv_init(struct usb_hcd *hcd) static int priv_init(struct usb_hcd *hcd)
{ {
struct isp1760_hcd *priv = hcd_to_priv(hcd); struct isp1760_hcd *priv = hcd_to_priv(hcd);
u32 hcc_params; u32 isoc_cache;
u32 isoc_thres;
int i; int i;
spin_lock_init(&priv->lock); spin_lock_init(&priv->lock);
...@@ -450,12 +485,14 @@ static int priv_init(struct usb_hcd *hcd) ...@@ -450,12 +485,14 @@ static int priv_init(struct usb_hcd *hcd)
priv->periodic_size = DEFAULT_I_TDPS; priv->periodic_size = DEFAULT_I_TDPS;
/* controllers may cache some of the periodic schedule ... */ /* controllers may cache some of the periodic schedule ... */
hcc_params = reg_read32(hcd->regs, HC_HCCPARAMS); isoc_cache = isp1760_hcd_read(hcd, HCC_ISOC_CACHE);
isoc_thres = isp1760_hcd_read(hcd, HCC_ISOC_THRES);
/* full frame cache */ /* full frame cache */
if (HCC_ISOC_CACHE(hcc_params)) if (isoc_cache)
priv->i_thresh = 8; priv->i_thresh = 8;
else /* N microframes cached */ else /* N microframes cached */
priv->i_thresh = 2 + HCC_ISOC_THRES(hcc_params); priv->i_thresh = 2 + isoc_thres;
return 0; return 0;
} }
...@@ -464,12 +501,13 @@ static int isp1760_hc_setup(struct usb_hcd *hcd) ...@@ -464,12 +501,13 @@ static int isp1760_hc_setup(struct usb_hcd *hcd)
{ {
struct isp1760_hcd *priv = hcd_to_priv(hcd); struct isp1760_hcd *priv = hcd_to_priv(hcd);
int result; int result;
u32 scratch, hwmode; u32 scratch;
isp1760_reg_write(priv->regs, ISP176x_HC_SCRATCH, 0xdeadbabe);
reg_write32(hcd->regs, HC_SCRATCH_REG, 0xdeadbabe);
/* Change bus pattern */ /* Change bus pattern */
scratch = reg_read32(hcd->regs, HC_CHIP_ID_REG); scratch = isp1760_reg_read(priv->regs, ISP176x_HC_CHIP_ID);
scratch = reg_read32(hcd->regs, HC_SCRATCH_REG); scratch = isp1760_reg_read(priv->regs, ISP176x_HC_SCRATCH);
if (scratch != 0xdeadbabe) { if (scratch != 0xdeadbabe) {
dev_err(hcd->self.controller, "Scratch test failed.\n"); dev_err(hcd->self.controller, "Scratch test failed.\n");
return -ENODEV; return -ENODEV;
...@@ -483,10 +521,13 @@ static int isp1760_hc_setup(struct usb_hcd *hcd) ...@@ -483,10 +521,13 @@ static int isp1760_hc_setup(struct usb_hcd *hcd)
* the host controller through the EHCI USB Command register. The device * the host controller through the EHCI USB Command register. The device
* has been reset in core code anyway, so this shouldn't matter. * has been reset in core code anyway, so this shouldn't matter.
*/ */
reg_write32(hcd->regs, HC_BUFFER_STATUS_REG, 0); isp1760_reg_write(priv->regs, ISP176x_HC_BUFFER_STATUS, 0);
reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, NO_TRANSFER_ACTIVE); isp1760_reg_write(priv->regs, ISP176x_HC_ATL_PTD_SKIPMAP,
reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, NO_TRANSFER_ACTIVE); NO_TRANSFER_ACTIVE);
reg_write32(hcd->regs, HC_ISO_PTD_SKIPMAP_REG, NO_TRANSFER_ACTIVE); isp1760_reg_write(priv->regs, ISP176x_HC_INT_PTD_SKIPMAP,
NO_TRANSFER_ACTIVE);
isp1760_reg_write(priv->regs, ISP176x_HC_ISO_PTD_SKIPMAP,
NO_TRANSFER_ACTIVE);
result = ehci_reset(hcd); result = ehci_reset(hcd);
if (result) if (result)
...@@ -495,14 +536,11 @@ static int isp1760_hc_setup(struct usb_hcd *hcd) ...@@ -495,14 +536,11 @@ static int isp1760_hc_setup(struct usb_hcd *hcd)
/* Step 11 passed */ /* Step 11 passed */
/* ATL reset */ /* ATL reset */
hwmode = reg_read32(hcd->regs, HC_HW_MODE_CTRL) & ~ALL_ATX_RESET; isp1760_hcd_set(hcd, ALL_ATX_RESET);
reg_write32(hcd->regs, HC_HW_MODE_CTRL, hwmode | ALL_ATX_RESET);
mdelay(10); mdelay(10);
reg_write32(hcd->regs, HC_HW_MODE_CTRL, hwmode); isp1760_hcd_clear(hcd, ALL_ATX_RESET);
reg_write32(hcd->regs, HC_INTERRUPT_ENABLE, INTERRUPT_ENABLE_MASK);
priv->hcs_params = reg_read32(hcd->regs, HC_HCSPARAMS); isp1760_hcd_set(hcd, HC_INT_ENABLE);
return priv_init(hcd); return priv_init(hcd);
} }
...@@ -732,12 +770,12 @@ static void start_bus_transfer(struct usb_hcd *hcd, u32 ptd_offset, int slot, ...@@ -732,12 +770,12 @@ static void start_bus_transfer(struct usb_hcd *hcd, u32 ptd_offset, int slot,
/* Make sure done map has not triggered from some unlinked transfer */ /* Make sure done map has not triggered from some unlinked transfer */
if (ptd_offset == ATL_PTD_OFFSET) { if (ptd_offset == ATL_PTD_OFFSET) {
priv->atl_done_map |= reg_read32(hcd->regs, priv->atl_done_map |= isp1760_reg_read(priv->regs,
HC_ATL_PTD_DONEMAP_REG); ISP176x_HC_ATL_PTD_DONEMAP);
priv->atl_done_map &= ~(1 << slot); priv->atl_done_map &= ~(1 << slot);
} else { } else {
priv->int_done_map |= reg_read32(hcd->regs, priv->int_done_map |= isp1760_reg_read(priv->regs,
HC_INT_PTD_DONEMAP_REG); ISP176x_HC_INT_PTD_DONEMAP);
priv->int_done_map &= ~(1 << slot); priv->int_done_map &= ~(1 << slot);
} }
...@@ -746,16 +784,20 @@ static void start_bus_transfer(struct usb_hcd *hcd, u32 ptd_offset, int slot, ...@@ -746,16 +784,20 @@ static void start_bus_transfer(struct usb_hcd *hcd, u32 ptd_offset, int slot,
slots[slot].timestamp = jiffies; slots[slot].timestamp = jiffies;
slots[slot].qtd = qtd; slots[slot].qtd = qtd;
slots[slot].qh = qh; slots[slot].qh = qh;
ptd_write(hcd->regs, ptd_offset, slot, ptd); ptd_write(priv->base, ptd_offset, slot, ptd);
if (ptd_offset == ATL_PTD_OFFSET) { if (ptd_offset == ATL_PTD_OFFSET) {
skip_map = reg_read32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG); skip_map = isp1760_reg_read(priv->regs,
ISP176x_HC_ATL_PTD_SKIPMAP);
skip_map &= ~(1 << qh->slot); skip_map &= ~(1 << qh->slot);
reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, skip_map); isp1760_reg_write(priv->regs, ISP176x_HC_ATL_PTD_SKIPMAP,
skip_map);
} else { } else {
skip_map = reg_read32(hcd->regs, HC_INT_PTD_SKIPMAP_REG); skip_map = isp1760_reg_read(priv->regs,
ISP176x_HC_INT_PTD_SKIPMAP);
skip_map &= ~(1 << qh->slot); skip_map &= ~(1 << qh->slot);
reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, skip_map); isp1760_reg_write(priv->regs, ISP176x_HC_INT_PTD_SKIPMAP,
skip_map);
} }
} }
...@@ -768,9 +810,10 @@ static int is_short_bulk(struct isp1760_qtd *qtd) ...@@ -768,9 +810,10 @@ static int is_short_bulk(struct isp1760_qtd *qtd)
static void collect_qtds(struct usb_hcd *hcd, struct isp1760_qh *qh, static void collect_qtds(struct usb_hcd *hcd, struct isp1760_qh *qh,
struct list_head *urb_list) struct list_head *urb_list)
{ {
int last_qtd; struct isp1760_hcd *priv = hcd_to_priv(hcd);
struct isp1760_qtd *qtd, *qtd_next; struct isp1760_qtd *qtd, *qtd_next;
struct urb_listitem *urb_listitem; struct urb_listitem *urb_listitem;
int last_qtd;
list_for_each_entry_safe(qtd, qtd_next, &qh->qtd_list, qtd_list) { list_for_each_entry_safe(qtd, qtd_next, &qh->qtd_list, qtd_list) {
if (qtd->status < QTD_XFER_COMPLETE) if (qtd->status < QTD_XFER_COMPLETE)
...@@ -785,7 +828,8 @@ static void collect_qtds(struct usb_hcd *hcd, struct isp1760_qh *qh, ...@@ -785,7 +828,8 @@ static void collect_qtds(struct usb_hcd *hcd, struct isp1760_qh *qh,
if (qtd->actual_length) { if (qtd->actual_length) {
switch (qtd->packet_type) { switch (qtd->packet_type) {
case IN_PID: case IN_PID:
mem_reads8(hcd->regs, qtd->payload_addr, mem_reads8(hcd, priv->base,
qtd->payload_addr,
qtd->data_buffer, qtd->data_buffer,
qtd->actual_length); qtd->actual_length);
fallthrough; fallthrough;
...@@ -875,7 +919,7 @@ static void enqueue_qtds(struct usb_hcd *hcd, struct isp1760_qh *qh) ...@@ -875,7 +919,7 @@ static void enqueue_qtds(struct usb_hcd *hcd, struct isp1760_qh *qh)
if ((qtd->length) && if ((qtd->length) &&
((qtd->packet_type == SETUP_PID) || ((qtd->packet_type == SETUP_PID) ||
(qtd->packet_type == OUT_PID))) { (qtd->packet_type == OUT_PID))) {
mem_writes8(hcd->regs, qtd->payload_addr, mem_writes8(priv->base, qtd->payload_addr,
qtd->data_buffer, qtd->length); qtd->data_buffer, qtd->length);
} }
...@@ -1076,9 +1120,9 @@ static void handle_done_ptds(struct usb_hcd *hcd) ...@@ -1076,9 +1120,9 @@ static void handle_done_ptds(struct usb_hcd *hcd)
int modified; int modified;
int skip_map; int skip_map;
skip_map = reg_read32(hcd->regs, HC_INT_PTD_SKIPMAP_REG); skip_map = isp1760_reg_read(priv->regs, ISP176x_HC_INT_PTD_SKIPMAP);
priv->int_done_map &= ~skip_map; priv->int_done_map &= ~skip_map;
skip_map = reg_read32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG); skip_map = isp1760_reg_read(priv->regs, ISP176x_HC_ATL_PTD_SKIPMAP);
priv->atl_done_map &= ~skip_map; priv->atl_done_map &= ~skip_map;
modified = priv->int_done_map || priv->atl_done_map; modified = priv->int_done_map || priv->atl_done_map;
...@@ -1096,7 +1140,7 @@ static void handle_done_ptds(struct usb_hcd *hcd) ...@@ -1096,7 +1140,7 @@ static void handle_done_ptds(struct usb_hcd *hcd)
continue; continue;
} }
ptd_offset = INT_PTD_OFFSET; ptd_offset = INT_PTD_OFFSET;
ptd_read(hcd->regs, INT_PTD_OFFSET, slot, &ptd); ptd_read(hcd, priv->base, INT_PTD_OFFSET, slot, &ptd);
state = check_int_transfer(hcd, &ptd, state = check_int_transfer(hcd, &ptd,
slots[slot].qtd->urb); slots[slot].qtd->urb);
} else { } else {
...@@ -1111,7 +1155,7 @@ static void handle_done_ptds(struct usb_hcd *hcd) ...@@ -1111,7 +1155,7 @@ static void handle_done_ptds(struct usb_hcd *hcd)
continue; continue;
} }
ptd_offset = ATL_PTD_OFFSET; ptd_offset = ATL_PTD_OFFSET;
ptd_read(hcd->regs, ATL_PTD_OFFSET, slot, &ptd); ptd_read(hcd, priv->base, ATL_PTD_OFFSET, slot, &ptd);
state = check_atl_transfer(hcd, &ptd, state = check_atl_transfer(hcd, &ptd,
slots[slot].qtd->urb); slots[slot].qtd->urb);
} }
...@@ -1212,13 +1256,15 @@ static irqreturn_t isp1760_irq(struct usb_hcd *hcd) ...@@ -1212,13 +1256,15 @@ static irqreturn_t isp1760_irq(struct usb_hcd *hcd)
if (!(hcd->state & HC_STATE_RUNNING)) if (!(hcd->state & HC_STATE_RUNNING))
goto leave; goto leave;
imask = reg_read32(hcd->regs, HC_INTERRUPT_REG); imask = isp1760_reg_read(priv->regs, ISP176x_HC_INTERRUPT);
if (unlikely(!imask)) if (unlikely(!imask))
goto leave; goto leave;
reg_write32(hcd->regs, HC_INTERRUPT_REG, imask); /* Clear */ isp1760_reg_write(priv->regs, ISP176x_HC_INTERRUPT, imask); /* Clear */
priv->int_done_map |= reg_read32(hcd->regs, HC_INT_PTD_DONEMAP_REG); priv->int_done_map |= isp1760_reg_read(priv->regs,
priv->atl_done_map |= reg_read32(hcd->regs, HC_ATL_PTD_DONEMAP_REG); ISP176x_HC_INT_PTD_DONEMAP);
priv->atl_done_map |= isp1760_reg_read(priv->regs,
ISP176x_HC_ATL_PTD_DONEMAP);
handle_done_ptds(hcd); handle_done_ptds(hcd);
...@@ -1273,7 +1319,7 @@ static void errata2_function(struct timer_list *unused) ...@@ -1273,7 +1319,7 @@ static void errata2_function(struct timer_list *unused)
if (priv->atl_slots[slot].qh && time_after(jiffies, if (priv->atl_slots[slot].qh && time_after(jiffies,
priv->atl_slots[slot].timestamp + priv->atl_slots[slot].timestamp +
msecs_to_jiffies(SLOT_TIMEOUT))) { msecs_to_jiffies(SLOT_TIMEOUT))) {
ptd_read(hcd->regs, ATL_PTD_OFFSET, slot, &ptd); ptd_read(hcd, priv->base, ATL_PTD_OFFSET, slot, &ptd);
if (!FROM_DW0_VALID(ptd.dw0) && if (!FROM_DW0_VALID(ptd.dw0) &&
!FROM_DW3_ACTIVE(ptd.dw3)) !FROM_DW3_ACTIVE(ptd.dw3))
priv->atl_done_map |= 1 << slot; priv->atl_done_map |= 1 << slot;
...@@ -1290,9 +1336,8 @@ static void errata2_function(struct timer_list *unused) ...@@ -1290,9 +1336,8 @@ static void errata2_function(struct timer_list *unused)
static int isp1760_run(struct usb_hcd *hcd) static int isp1760_run(struct usb_hcd *hcd)
{ {
struct isp1760_hcd *priv = hcd_to_priv(hcd);
int retval; int retval;
u32 temp;
u32 command;
u32 chipid; u32 chipid;
hcd->uses_new_polling = 1; hcd->uses_new_polling = 1;
...@@ -1300,23 +1345,20 @@ static int isp1760_run(struct usb_hcd *hcd) ...@@ -1300,23 +1345,20 @@ static int isp1760_run(struct usb_hcd *hcd)
hcd->state = HC_STATE_RUNNING; hcd->state = HC_STATE_RUNNING;
/* Set PTD interrupt AND & OR maps */ /* Set PTD interrupt AND & OR maps */
reg_write32(hcd->regs, HC_ATL_IRQ_MASK_AND_REG, 0); isp1760_reg_write(priv->regs, ISP176x_HC_ATL_IRQ_MASK_AND, 0);
reg_write32(hcd->regs, HC_ATL_IRQ_MASK_OR_REG, 0xffffffff); isp1760_reg_write(priv->regs, ISP176x_HC_ATL_IRQ_MASK_OR, 0xffffffff);
reg_write32(hcd->regs, HC_INT_IRQ_MASK_AND_REG, 0); isp1760_reg_write(priv->regs, ISP176x_HC_INT_IRQ_MASK_AND, 0);
reg_write32(hcd->regs, HC_INT_IRQ_MASK_OR_REG, 0xffffffff); isp1760_reg_write(priv->regs, ISP176x_HC_INT_IRQ_MASK_OR, 0xffffffff);
reg_write32(hcd->regs, HC_ISO_IRQ_MASK_AND_REG, 0); isp1760_reg_write(priv->regs, ISP176x_HC_ISO_IRQ_MASK_AND, 0);
reg_write32(hcd->regs, HC_ISO_IRQ_MASK_OR_REG, 0xffffffff); isp1760_reg_write(priv->regs, ISP176x_HC_ISO_IRQ_MASK_OR, 0xffffffff);
/* step 23 passed */ /* step 23 passed */
temp = reg_read32(hcd->regs, HC_HW_MODE_CTRL); isp1760_hcd_set(hcd, HW_GLOBAL_INTR_EN);
reg_write32(hcd->regs, HC_HW_MODE_CTRL, temp | HW_GLOBAL_INTR_EN);
command = reg_read32(hcd->regs, HC_USBCMD); isp1760_hcd_clear(hcd, CMD_LRESET);
command &= ~(CMD_LRESET|CMD_RESET); isp1760_hcd_clear(hcd, CMD_RESET);
command |= CMD_RUN;
reg_write32(hcd->regs, HC_USBCMD, command);
retval = handshake(hcd, HC_USBCMD, CMD_RUN, CMD_RUN, 250 * 1000); retval = isp1760_hcd_set_poll_timeout(hcd, CMD_RUN, 250 * 1000);
if (retval) if (retval)
return retval; return retval;
...@@ -1326,9 +1368,8 @@ static int isp1760_run(struct usb_hcd *hcd) ...@@ -1326,9 +1368,8 @@ static int isp1760_run(struct usb_hcd *hcd)
* the semaphore while doing so. * the semaphore while doing so.
*/ */
down_write(&ehci_cf_port_reset_rwsem); down_write(&ehci_cf_port_reset_rwsem);
reg_write32(hcd->regs, HC_CONFIGFLAG, FLAG_CF);
retval = handshake(hcd, HC_CONFIGFLAG, FLAG_CF, FLAG_CF, 250 * 1000); retval = isp1760_hcd_set_poll_timeout(hcd, FLAG_CF, 250 * 1000);
up_write(&ehci_cf_port_reset_rwsem); up_write(&ehci_cf_port_reset_rwsem);
if (retval) if (retval)
return retval; return retval;
...@@ -1338,21 +1379,22 @@ static int isp1760_run(struct usb_hcd *hcd) ...@@ -1338,21 +1379,22 @@ static int isp1760_run(struct usb_hcd *hcd)
errata2_timer.expires = jiffies + msecs_to_jiffies(SLOT_CHECK_PERIOD); errata2_timer.expires = jiffies + msecs_to_jiffies(SLOT_CHECK_PERIOD);
add_timer(&errata2_timer); add_timer(&errata2_timer);
chipid = reg_read32(hcd->regs, HC_CHIP_ID_REG); chipid = isp1760_reg_read(priv->regs, ISP176x_HC_CHIP_ID);
dev_info(hcd->self.controller, "USB ISP %04x HW rev. %d started\n", dev_info(hcd->self.controller, "USB ISP %04x HW rev. %d started\n",
chipid & 0xffff, chipid >> 16); chipid & 0xffff, chipid >> 16);
/* PTD Register Init Part 2, Step 28 */ /* PTD Register Init Part 2, Step 28 */
/* Setup registers controlling PTD checking */ /* Setup registers controlling PTD checking */
reg_write32(hcd->regs, HC_ATL_PTD_LASTPTD_REG, 0x80000000); isp1760_reg_write(priv->regs, ISP176x_HC_ATL_PTD_LASTPTD, 0x80000000);
reg_write32(hcd->regs, HC_INT_PTD_LASTPTD_REG, 0x80000000); isp1760_reg_write(priv->regs, ISP176x_HC_INT_PTD_LASTPTD, 0x80000000);
reg_write32(hcd->regs, HC_ISO_PTD_LASTPTD_REG, 0x00000001); isp1760_reg_write(priv->regs, ISP176x_HC_ISO_PTD_LASTPTD, 0x00000001);
reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, 0xffffffff); isp1760_reg_write(priv->regs, ISP176x_HC_ATL_PTD_SKIPMAP, 0xffffffff);
reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, 0xffffffff); isp1760_reg_write(priv->regs, ISP176x_HC_INT_PTD_SKIPMAP, 0xffffffff);
reg_write32(hcd->regs, HC_ISO_PTD_SKIPMAP_REG, 0xffffffff); isp1760_reg_write(priv->regs, ISP176x_HC_ISO_PTD_SKIPMAP, 0xffffffff);
reg_write32(hcd->regs, HC_BUFFER_STATUS_REG,
ATL_BUF_FILL | INT_BUF_FILL); isp1760_hcd_set(hcd, ATL_BUF_FILL);
isp1760_hcd_set(hcd, INT_BUF_FILL);
/* GRR this is run-once init(), being done every time the HC starts. /* GRR this is run-once init(), being done every time the HC starts.
* So long as they're part of class devices, we can't do it init() * So long as they're part of class devices, we can't do it init()
...@@ -1586,15 +1628,19 @@ static void kill_transfer(struct usb_hcd *hcd, struct urb *urb, ...@@ -1586,15 +1628,19 @@ static void kill_transfer(struct usb_hcd *hcd, struct urb *urb,
/* We need to forcefully reclaim the slot since some transfers never /* We need to forcefully reclaim the slot since some transfers never
return, e.g. interrupt transfers and NAKed bulk transfers. */ return, e.g. interrupt transfers and NAKed bulk transfers. */
if (usb_pipecontrol(urb->pipe) || usb_pipebulk(urb->pipe)) { if (usb_pipecontrol(urb->pipe) || usb_pipebulk(urb->pipe)) {
skip_map = reg_read32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG); skip_map = isp1760_reg_read(priv->regs,
ISP176x_HC_ATL_PTD_SKIPMAP);
skip_map |= (1 << qh->slot); skip_map |= (1 << qh->slot);
reg_write32(hcd->regs, HC_ATL_PTD_SKIPMAP_REG, skip_map); isp1760_reg_write(priv->regs, ISP176x_HC_ATL_PTD_SKIPMAP,
skip_map);
priv->atl_slots[qh->slot].qh = NULL; priv->atl_slots[qh->slot].qh = NULL;
priv->atl_slots[qh->slot].qtd = NULL; priv->atl_slots[qh->slot].qtd = NULL;
} else { } else {
skip_map = reg_read32(hcd->regs, HC_INT_PTD_SKIPMAP_REG); skip_map = isp1760_reg_read(priv->regs,
ISP176x_HC_INT_PTD_SKIPMAP);
skip_map |= (1 << qh->slot); skip_map |= (1 << qh->slot);
reg_write32(hcd->regs, HC_INT_PTD_SKIPMAP_REG, skip_map); isp1760_reg_write(priv->regs, ISP176x_HC_INT_PTD_SKIPMAP,
skip_map);
priv->int_slots[qh->slot].qh = NULL; priv->int_slots[qh->slot].qh = NULL;
priv->int_slots[qh->slot].qtd = NULL; priv->int_slots[qh->slot].qtd = NULL;
} }
...@@ -1707,8 +1753,7 @@ static void isp1760_endpoint_disable(struct usb_hcd *hcd, ...@@ -1707,8 +1753,7 @@ static void isp1760_endpoint_disable(struct usb_hcd *hcd,
static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf) static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf)
{ {
struct isp1760_hcd *priv = hcd_to_priv(hcd); struct isp1760_hcd *priv = hcd_to_priv(hcd);
u32 temp, status = 0; u32 status = 0;
u32 mask;
int retval = 1; int retval = 1;
unsigned long flags; unsigned long flags;
...@@ -1718,18 +1763,14 @@ static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf) ...@@ -1718,18 +1763,14 @@ static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf)
/* init status to no-changes */ /* init status to no-changes */
buf[0] = 0; buf[0] = 0;
mask = PORT_CSC;
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
temp = reg_read32(hcd->regs, HC_PORTSC1);
if (temp & PORT_OWNER) { if (isp1760_hcd_is_set(hcd, PORT_OWNER) &&
if (temp & PORT_CSC) { isp1760_hcd_is_set(hcd, PORT_CSC)) {
temp &= ~PORT_CSC; isp1760_hcd_clear(hcd, PORT_CSC);
reg_write32(hcd->regs, HC_PORTSC1, temp);
goto done; goto done;
} }
}
/* /*
* Return status information even for ports with OWNER set. * Return status information even for ports with OWNER set.
...@@ -1737,11 +1778,9 @@ static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf) ...@@ -1737,11 +1778,9 @@ static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf)
* high-speed device is switched over to the companion * high-speed device is switched over to the companion
* controller by the user. * controller by the user.
*/ */
if (isp1760_hcd_is_set(hcd, PORT_CSC) ||
if ((temp & mask) != 0 (isp1760_hcd_is_set(hcd, PORT_RESUME) &&
|| ((temp & PORT_RESUME) != 0 time_after_eq(jiffies, priv->reset_done))) {
&& time_after_eq(jiffies,
priv->reset_done))) {
buf [0] |= 1 << (0 + 1); buf [0] |= 1 << (0 + 1);
status = STS_PCD; status = STS_PCD;
} }
...@@ -1754,9 +1793,11 @@ static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf) ...@@ -1754,9 +1793,11 @@ static int isp1760_hub_status_data(struct usb_hcd *hcd, char *buf)
static void isp1760_hub_descriptor(struct isp1760_hcd *priv, static void isp1760_hub_descriptor(struct isp1760_hcd *priv,
struct usb_hub_descriptor *desc) struct usb_hub_descriptor *desc)
{ {
int ports = HCS_N_PORTS(priv->hcs_params); int ports;
u16 temp; u16 temp;
ports = isp1760_hcd_read(priv->hcd, HCS_N_PORTS);
desc->bDescriptorType = USB_DT_HUB; desc->bDescriptorType = USB_DT_HUB;
/* priv 1.0, 2.3.9 says 20ms max */ /* priv 1.0, 2.3.9 says 20ms max */
desc->bPwrOn2PwrGood = 10; desc->bPwrOn2PwrGood = 10;
...@@ -1772,7 +1813,7 @@ static void isp1760_hub_descriptor(struct isp1760_hcd *priv, ...@@ -1772,7 +1813,7 @@ static void isp1760_hub_descriptor(struct isp1760_hcd *priv,
/* per-port overcurrent reporting */ /* per-port overcurrent reporting */
temp = HUB_CHAR_INDV_PORT_OCPM; temp = HUB_CHAR_INDV_PORT_OCPM;
if (HCS_PPC(priv->hcs_params)) if (isp1760_hcd_is_set(priv->hcd, HCS_PPC))
/* per-port power control */ /* per-port power control */
temp |= HUB_CHAR_INDV_PORT_LPSM; temp |= HUB_CHAR_INDV_PORT_LPSM;
else else
...@@ -1783,38 +1824,37 @@ static void isp1760_hub_descriptor(struct isp1760_hcd *priv, ...@@ -1783,38 +1824,37 @@ static void isp1760_hub_descriptor(struct isp1760_hcd *priv,
#define PORT_WAKE_BITS (PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E) #define PORT_WAKE_BITS (PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)
static int check_reset_complete(struct usb_hcd *hcd, int index, static void check_reset_complete(struct usb_hcd *hcd, int index)
int port_status)
{ {
if (!(port_status & PORT_CONNECT)) if (!(isp1760_hcd_is_set(hcd, PORT_CONNECT)))
return port_status; return;
/* if reset finished and it's still not enabled -- handoff */ /* if reset finished and it's still not enabled -- handoff */
if (!(port_status & PORT_PE)) { if (!isp1760_hcd_is_set(hcd, PORT_PE)) {
dev_info(hcd->self.controller, dev_info(hcd->self.controller,
"port %d full speed --> companion\n", "port %d full speed --> companion\n", index + 1);
index + 1);
port_status |= PORT_OWNER; isp1760_hcd_set(hcd, PORT_OWNER);
port_status &= ~PORT_RWC_BITS;
reg_write32(hcd->regs, HC_PORTSC1, port_status);
} else isp1760_hcd_clear(hcd, PORT_CSC);
} else {
dev_info(hcd->self.controller, "port %d high speed\n", dev_info(hcd->self.controller, "port %d high speed\n",
index + 1); index + 1);
}
return port_status; return;
} }
static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
u16 wValue, u16 wIndex, char *buf, u16 wLength) u16 wValue, u16 wIndex, char *buf, u16 wLength)
{ {
struct isp1760_hcd *priv = hcd_to_priv(hcd); struct isp1760_hcd *priv = hcd_to_priv(hcd);
int ports = HCS_N_PORTS(priv->hcs_params); u32 status;
u32 temp, status;
unsigned long flags; unsigned long flags;
int retval = 0; int retval = 0;
int ports;
ports = isp1760_hcd_read(hcd, HCS_N_PORTS);
/* /*
* FIXME: support SetPortFeatures USB_PORT_FEAT_INDICATOR. * FIXME: support SetPortFeatures USB_PORT_FEAT_INDICATOR.
...@@ -1839,7 +1879,6 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1839,7 +1879,6 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
if (!wIndex || wIndex > ports) if (!wIndex || wIndex > ports)
goto error; goto error;
wIndex--; wIndex--;
temp = reg_read32(hcd->regs, HC_PORTSC1);
/* /*
* Even if OWNER is set, so the port is owned by the * Even if OWNER is set, so the port is owned by the
...@@ -1850,22 +1889,22 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1850,22 +1889,22 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
switch (wValue) { switch (wValue) {
case USB_PORT_FEAT_ENABLE: case USB_PORT_FEAT_ENABLE:
reg_write32(hcd->regs, HC_PORTSC1, temp & ~PORT_PE); isp1760_hcd_clear(hcd, PORT_PE);
break; break;
case USB_PORT_FEAT_C_ENABLE: case USB_PORT_FEAT_C_ENABLE:
/* XXX error? */ /* XXX error? */
break; break;
case USB_PORT_FEAT_SUSPEND: case USB_PORT_FEAT_SUSPEND:
if (temp & PORT_RESET) if (isp1760_hcd_is_set(hcd, PORT_RESET))
goto error; goto error;
if (temp & PORT_SUSPEND) { if (isp1760_hcd_is_set(hcd, PORT_SUSPEND)) {
if ((temp & PORT_PE) == 0) if (!isp1760_hcd_is_set(hcd, PORT_PE))
goto error; goto error;
/* resume signaling for 20 msec */ /* resume signaling for 20 msec */
temp &= ~(PORT_RWC_BITS); isp1760_hcd_clear(hcd, PORT_CSC);
reg_write32(hcd->regs, HC_PORTSC1, isp1760_hcd_set(hcd, PORT_RESUME);
temp | PORT_RESUME);
priv->reset_done = jiffies + priv->reset_done = jiffies +
msecs_to_jiffies(USB_RESUME_TIMEOUT); msecs_to_jiffies(USB_RESUME_TIMEOUT);
} }
...@@ -1874,12 +1913,11 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1874,12 +1913,11 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
/* we auto-clear this feature */ /* we auto-clear this feature */
break; break;
case USB_PORT_FEAT_POWER: case USB_PORT_FEAT_POWER:
if (HCS_PPC(priv->hcs_params)) if (isp1760_hcd_is_set(hcd, HCS_PPC))
reg_write32(hcd->regs, HC_PORTSC1, isp1760_hcd_clear(hcd, PORT_POWER);
temp & ~PORT_POWER);
break; break;
case USB_PORT_FEAT_C_CONNECTION: case USB_PORT_FEAT_C_CONNECTION:
reg_write32(hcd->regs, HC_PORTSC1, temp | PORT_CSC); isp1760_hcd_set(hcd, PORT_CSC);
break; break;
case USB_PORT_FEAT_C_OVER_CURRENT: case USB_PORT_FEAT_C_OVER_CURRENT:
/* XXX error ?*/ /* XXX error ?*/
...@@ -1890,7 +1928,7 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1890,7 +1928,7 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
default: default:
goto error; goto error;
} }
reg_read32(hcd->regs, HC_USBCMD); isp1760_reg_read(priv->regs, ISP176x_HC_USBCMD);
break; break;
case GetHubDescriptor: case GetHubDescriptor:
isp1760_hub_descriptor(priv, (struct usb_hub_descriptor *) isp1760_hub_descriptor(priv, (struct usb_hub_descriptor *)
...@@ -1905,15 +1943,14 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1905,15 +1943,14 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
goto error; goto error;
wIndex--; wIndex--;
status = 0; status = 0;
temp = reg_read32(hcd->regs, HC_PORTSC1);
/* wPortChange bits */ /* wPortChange bits */
if (temp & PORT_CSC) if (isp1760_hcd_is_set(hcd, PORT_CSC))
status |= USB_PORT_STAT_C_CONNECTION << 16; status |= USB_PORT_STAT_C_CONNECTION << 16;
/* whoever resumes must GetPortStatus to complete it!! */ /* whoever resumes must GetPortStatus to complete it!! */
if (temp & PORT_RESUME) { if (isp1760_hcd_is_set(hcd, PORT_RESUME)) {
dev_err(hcd->self.controller, "Port resume should be skipped.\n"); dev_err(hcd->self.controller, "Port resume should be skipped.\n");
/* Remote Wakeup received? */ /* Remote Wakeup received? */
...@@ -1932,35 +1969,31 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1932,35 +1969,31 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
priv->reset_done = 0; priv->reset_done = 0;
/* stop resume signaling */ /* stop resume signaling */
temp = reg_read32(hcd->regs, HC_PORTSC1); isp1760_hcd_clear(hcd, PORT_CSC);
reg_write32(hcd->regs, HC_PORTSC1,
temp & ~(PORT_RWC_BITS | PORT_RESUME)); retval = isp1760_hcd_clear_poll_timeout(hcd,
retval = handshake(hcd, HC_PORTSC1, PORT_RESUME, 2000);
PORT_RESUME, 0, 2000 /* 2msec */);
if (retval != 0) { if (retval != 0) {
dev_err(hcd->self.controller, dev_err(hcd->self.controller,
"port %d resume error %d\n", "port %d resume error %d\n",
wIndex + 1, retval); wIndex + 1, retval);
goto error; goto error;
} }
temp &= ~(PORT_SUSPEND|PORT_RESUME|(3<<10));
} }
} }
/* whoever resets must GetPortStatus to complete it!! */ /* whoever resets must GetPortStatus to complete it!! */
if ((temp & PORT_RESET) if (isp1760_hcd_is_set(hcd, PORT_RESET) &&
&& time_after_eq(jiffies, time_after_eq(jiffies, priv->reset_done)) {
priv->reset_done)) {
status |= USB_PORT_STAT_C_RESET << 16; status |= USB_PORT_STAT_C_RESET << 16;
priv->reset_done = 0; priv->reset_done = 0;
/* force reset to complete */ /* force reset to complete */
reg_write32(hcd->regs, HC_PORTSC1, temp & ~PORT_RESET);
/* REVISIT: some hardware needs 550+ usec to clear /* REVISIT: some hardware needs 550+ usec to clear
* this bit; seems too long to spin routinely... * this bit; seems too long to spin routinely...
*/ */
retval = handshake(hcd, HC_PORTSC1, retval = isp1760_hcd_clear_poll_timeout(hcd, PORT_RESET,
PORT_RESET, 0, 750); 750);
if (retval != 0) { if (retval != 0) {
dev_err(hcd->self.controller, "port %d reset error %d\n", dev_err(hcd->self.controller, "port %d reset error %d\n",
wIndex + 1, retval); wIndex + 1, retval);
...@@ -1968,8 +2001,7 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1968,8 +2001,7 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
} }
/* see what we found out */ /* see what we found out */
temp = check_reset_complete(hcd, wIndex, check_reset_complete(hcd, wIndex);
reg_read32(hcd->regs, HC_PORTSC1));
} }
/* /*
* Even if OWNER is set, there's no harm letting hub_wq * Even if OWNER is set, there's no harm letting hub_wq
...@@ -1977,21 +2009,22 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -1977,21 +2009,22 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
* for PORT_POWER anyway). * for PORT_POWER anyway).
*/ */
if (temp & PORT_OWNER) if (isp1760_hcd_is_set(hcd, PORT_OWNER))
dev_err(hcd->self.controller, "PORT_OWNER is set\n"); dev_err(hcd->self.controller, "PORT_OWNER is set\n");
if (temp & PORT_CONNECT) { if (isp1760_hcd_is_set(hcd, PORT_CONNECT)) {
status |= USB_PORT_STAT_CONNECTION; status |= USB_PORT_STAT_CONNECTION;
/* status may be from integrated TT */ /* status may be from integrated TT */
status |= USB_PORT_STAT_HIGH_SPEED; status |= USB_PORT_STAT_HIGH_SPEED;
} }
if (temp & PORT_PE) if (isp1760_hcd_is_set(hcd, PORT_PE))
status |= USB_PORT_STAT_ENABLE; status |= USB_PORT_STAT_ENABLE;
if (temp & (PORT_SUSPEND|PORT_RESUME)) if (isp1760_hcd_is_set(hcd, PORT_SUSPEND) &&
isp1760_hcd_is_set(hcd, PORT_RESUME))
status |= USB_PORT_STAT_SUSPEND; status |= USB_PORT_STAT_SUSPEND;
if (temp & PORT_RESET) if (isp1760_hcd_is_set(hcd, PORT_RESET))
status |= USB_PORT_STAT_RESET; status |= USB_PORT_STAT_RESET;
if (temp & PORT_POWER) if (isp1760_hcd_is_set(hcd, PORT_POWER))
status |= USB_PORT_STAT_POWER; status |= USB_PORT_STAT_POWER;
put_unaligned(cpu_to_le32(status), (__le32 *) buf); put_unaligned(cpu_to_le32(status), (__le32 *) buf);
...@@ -2011,41 +2044,39 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -2011,41 +2044,39 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
if (!wIndex || wIndex > ports) if (!wIndex || wIndex > ports)
goto error; goto error;
wIndex--; wIndex--;
temp = reg_read32(hcd->regs, HC_PORTSC1); if (isp1760_hcd_is_set(hcd, PORT_OWNER))
if (temp & PORT_OWNER)
break; break;
/* temp &= ~PORT_RWC_BITS; */
switch (wValue) { switch (wValue) {
case USB_PORT_FEAT_ENABLE: case USB_PORT_FEAT_ENABLE:
reg_write32(hcd->regs, HC_PORTSC1, temp | PORT_PE); isp1760_hcd_set(hcd, PORT_PE);
break; break;
case USB_PORT_FEAT_SUSPEND: case USB_PORT_FEAT_SUSPEND:
if ((temp & PORT_PE) == 0 if (!isp1760_hcd_is_set(hcd, PORT_PE) ||
|| (temp & PORT_RESET) != 0) isp1760_hcd_is_set(hcd, PORT_RESET))
goto error; goto error;
reg_write32(hcd->regs, HC_PORTSC1, temp | PORT_SUSPEND); isp1760_hcd_set(hcd, PORT_SUSPEND);
break; break;
case USB_PORT_FEAT_POWER: case USB_PORT_FEAT_POWER:
if (HCS_PPC(priv->hcs_params)) if (isp1760_hcd_is_set(hcd, HCS_PPC))
reg_write32(hcd->regs, HC_PORTSC1, isp1760_hcd_set(hcd, PORT_POWER);
temp | PORT_POWER);
break; break;
case USB_PORT_FEAT_RESET: case USB_PORT_FEAT_RESET:
if (temp & PORT_RESUME) if (isp1760_hcd_is_set(hcd, PORT_RESUME))
goto error; goto error;
/* line status bits may report this as low speed, /* line status bits may report this as low speed,
* which can be fine if this root hub has a * which can be fine if this root hub has a
* transaction translator built in. * transaction translator built in.
*/ */
if ((temp & (PORT_PE|PORT_CONNECT)) == PORT_CONNECT if ((isp1760_hcd_is_set(hcd, PORT_CONNECT) &&
&& PORT_USB11(temp)) { !isp1760_hcd_is_set(hcd, PORT_PE)) &&
temp |= PORT_OWNER; (isp1760_hcd_read(hcd, PORT_LSTATUS) == 1)) {
isp1760_hcd_set(hcd, PORT_OWNER);
} else { } else {
temp |= PORT_RESET; isp1760_hcd_set(hcd, PORT_RESET);
temp &= ~PORT_PE; isp1760_hcd_clear(hcd, PORT_PE);
/* /*
* caller must wait, then call GetPortStatus * caller must wait, then call GetPortStatus
...@@ -2054,12 +2085,11 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq, ...@@ -2054,12 +2085,11 @@ static int isp1760_hub_control(struct usb_hcd *hcd, u16 typeReq,
priv->reset_done = jiffies + priv->reset_done = jiffies +
msecs_to_jiffies(50); msecs_to_jiffies(50);
} }
reg_write32(hcd->regs, HC_PORTSC1, temp);
break; break;
default: default:
goto error; goto error;
} }
reg_read32(hcd->regs, HC_USBCMD); isp1760_reg_read(priv->regs, ISP176x_HC_USBCMD);
break; break;
default: default:
...@@ -2076,14 +2106,13 @@ static int isp1760_get_frame(struct usb_hcd *hcd) ...@@ -2076,14 +2106,13 @@ static int isp1760_get_frame(struct usb_hcd *hcd)
struct isp1760_hcd *priv = hcd_to_priv(hcd); struct isp1760_hcd *priv = hcd_to_priv(hcd);
u32 fr; u32 fr;
fr = reg_read32(hcd->regs, HC_FRINDEX); fr = isp1760_hcd_read(hcd, HC_FRINDEX);
return (fr >> 3) % priv->periodic_size; return (fr >> 3) % priv->periodic_size;
} }
static void isp1760_stop(struct usb_hcd *hcd) static void isp1760_stop(struct usb_hcd *hcd)
{ {
struct isp1760_hcd *priv = hcd_to_priv(hcd); struct isp1760_hcd *priv = hcd_to_priv(hcd);
u32 temp;
del_timer(&errata2_timer); del_timer(&errata2_timer);
...@@ -2094,24 +2123,19 @@ static void isp1760_stop(struct usb_hcd *hcd) ...@@ -2094,24 +2123,19 @@ static void isp1760_stop(struct usb_hcd *hcd)
spin_lock_irq(&priv->lock); spin_lock_irq(&priv->lock);
ehci_reset(hcd); ehci_reset(hcd);
/* Disable IRQ */ /* Disable IRQ */
temp = reg_read32(hcd->regs, HC_HW_MODE_CTRL); isp1760_hcd_clear(hcd, HW_GLOBAL_INTR_EN);
reg_write32(hcd->regs, HC_HW_MODE_CTRL, temp &= ~HW_GLOBAL_INTR_EN);
spin_unlock_irq(&priv->lock); spin_unlock_irq(&priv->lock);
reg_write32(hcd->regs, HC_CONFIGFLAG, 0); isp1760_hcd_clear(hcd, FLAG_CF);
} }
static void isp1760_shutdown(struct usb_hcd *hcd) static void isp1760_shutdown(struct usb_hcd *hcd)
{ {
u32 command, temp;
isp1760_stop(hcd); isp1760_stop(hcd);
temp = reg_read32(hcd->regs, HC_HW_MODE_CTRL);
reg_write32(hcd->regs, HC_HW_MODE_CTRL, temp &= ~HW_GLOBAL_INTR_EN);
command = reg_read32(hcd->regs, HC_USBCMD); isp1760_hcd_clear(hcd, HW_GLOBAL_INTR_EN);
command &= ~CMD_RUN;
reg_write32(hcd->regs, HC_USBCMD, command); isp1760_hcd_clear(hcd, CMD_RUN);
} }
static void isp1760_clear_tt_buffer_complete(struct usb_hcd *hcd, static void isp1760_clear_tt_buffer_complete(struct usb_hcd *hcd,
...@@ -2184,8 +2208,8 @@ void isp1760_deinit_kmem_cache(void) ...@@ -2184,8 +2208,8 @@ void isp1760_deinit_kmem_cache(void)
kmem_cache_destroy(urb_listitem_cachep); kmem_cache_destroy(urb_listitem_cachep);
} }
int isp1760_hcd_register(struct isp1760_hcd *priv, void __iomem *regs, int isp1760_hcd_register(struct isp1760_hcd *priv, struct resource *mem,
struct resource *mem, int irq, unsigned long irqflags, int irq, unsigned long irqflags,
struct device *dev) struct device *dev)
{ {
struct usb_hcd *hcd; struct usb_hcd *hcd;
...@@ -2202,7 +2226,6 @@ int isp1760_hcd_register(struct isp1760_hcd *priv, void __iomem *regs, ...@@ -2202,7 +2226,6 @@ int isp1760_hcd_register(struct isp1760_hcd *priv, void __iomem *regs,
init_memory(priv); init_memory(priv);
hcd->irq = irq; hcd->irq = irq;
hcd->regs = regs;
hcd->rsrc_start = mem->start; hcd->rsrc_start = mem->start;
hcd->rsrc_len = resource_size(mem); hcd->rsrc_len = resource_size(mem);
......
drivers/usb/isp1760/isp1760-hcd.h
View file @ 1da9e1c0
...@@ -3,6 +3,9 @@ ...@@ -3,6 +3,9 @@
#define _ISP1760_HCD_H_ #define _ISP1760_HCD_H_
#include <linux/spinlock.h> #include <linux/spinlock.h>
#include <linux/regmap.h>
#include "isp1760-regs.h"
struct isp1760_qh; struct isp1760_qh;
struct isp1760_qtd; struct isp1760_qtd;
...@@ -48,10 +51,13 @@ enum isp1760_queue_head_types { ...@@ -48,10 +51,13 @@ enum isp1760_queue_head_types {
}; };
struct isp1760_hcd { struct isp1760_hcd {
#ifdef CONFIG_USB_ISP1760_HCD
struct usb_hcd *hcd; struct usb_hcd *hcd;
u32 hcs_params; void __iomem *base;
struct regmap *regs;
struct regmap_field *fields[HC_FIELD_MAX];
spinlock_t lock; spinlock_t lock;
struct isp1760_slotinfo atl_slots[32]; struct isp1760_slotinfo atl_slots[32];
int atl_done_map; int atl_done_map;
...@@ -66,20 +72,18 @@ struct isp1760_hcd { ...@@ -66,20 +72,18 @@ struct isp1760_hcd {
unsigned i_thresh; unsigned i_thresh;
unsigned long reset_done; unsigned long reset_done;
unsigned long next_statechange; unsigned long next_statechange;
#endif
}; };
#ifdef CONFIG_USB_ISP1760_HCD #ifdef CONFIG_USB_ISP1760_HCD
int isp1760_hcd_register(struct isp1760_hcd *priv, void __iomem *regs, int isp1760_hcd_register(struct isp1760_hcd *priv, struct resource *mem,
struct resource *mem, int irq, unsigned long irqflags, int irq, unsigned long irqflags, struct device *dev);
struct device *dev);
void isp1760_hcd_unregister(struct isp1760_hcd *priv); void isp1760_hcd_unregister(struct isp1760_hcd *priv);
int isp1760_init_kmem_once(void); int isp1760_init_kmem_once(void);
void isp1760_deinit_kmem_cache(void); void isp1760_deinit_kmem_cache(void);
#else #else
static inline int isp1760_hcd_register(struct isp1760_hcd *priv, static inline int isp1760_hcd_register(struct isp1760_hcd *priv,
void __iomem *regs, struct resource *mem, struct resource *mem,
int irq, unsigned long irqflags, int irq, unsigned long irqflags,
struct device *dev) struct device *dev)
{ {
......
drivers/usb/isp1760/isp1760-if.c
View file @ 1da9e1c0
...@@ -75,9 +75,9 @@ static int isp1761_pci_init(struct pci_dev *dev) ...@@ -75,9 +75,9 @@ static int isp1761_pci_init(struct pci_dev *dev)
/*by default host is in 16bit mode, so /*by default host is in 16bit mode, so
* io operations at this stage must be 16 bit * io operations at this stage must be 16 bit
* */ * */
writel(0xface, iobase + HC_SCRATCH_REG); writel(0xface, iobase + ISP176x_HC_SCRATCH);
udelay(100); udelay(100);
reg_data = readl(iobase + HC_SCRATCH_REG) & 0x0000ffff; reg_data = readl(iobase + ISP176x_HC_SCRATCH) & 0x0000ffff;
retry_count--; retry_count--;
} }
......
drivers/usb/isp1760/isp1760-regs.h
View file @ 1da9e1c0
...@@ -10,218 +10,182 @@ ...@@ -10,218 +10,182 @@
* Laurent Pinchart <laurent.pinchart@ideasonboard.com> * Laurent Pinchart <laurent.pinchart@ideasonboard.com>
*/ */
#ifndef _ISP1760_REGS_H_ #ifndef _ISP176x_REGS_H_
#define _ISP1760_REGS_H_ #define _ISP176x_REGS_H_
/* ----------------------------------------------------------------------------- /* -----------------------------------------------------------------------------
* Host Controller * Host Controller
*/ */
/* EHCI capability registers */ /* EHCI capability registers */
#define HC_CAPLENGTH 0x000 #define ISP176x_HC_CAPLENGTH 0x000
#define HC_LENGTH(p) (((p) >> 00) & 0x00ff) /* bits 7:0 */ #define ISP176x_HC_VERSION 0x002
#define HC_VERSION(p) (((p) >> 16) & 0xffff) /* bits 31:16 */ #define ISP176x_HC_HCSPARAMS 0x004
#define ISP176x_HC_HCCPARAMS 0x008
#define HC_HCSPARAMS 0x004
#define HCS_INDICATOR(p) ((p) & (1 << 16)) /* true: has port indicators */
#define HCS_PPC(p) ((p) & (1 << 4)) /* true: port power control */
#define HCS_N_PORTS(p) (((p) >> 0) & 0xf) /* bits 3:0, ports on HC */
#define HC_HCCPARAMS 0x008
#define HCC_ISOC_CACHE(p) ((p) & (1 << 7)) /* true: can cache isoc frame */
#define HCC_ISOC_THRES(p) (((p) >> 4) & 0x7) /* bits 6:4, uframes cached */
/* EHCI operational registers */ /* EHCI operational registers */
#define HC_USBCMD 0x020 #define ISP176x_HC_USBCMD 0x020
#define CMD_LRESET (1 << 7) /* partial reset (no ports, etc) */ #define ISP176x_HC_USBSTS 0x024
#define CMD_RESET (1 << 1) /* reset HC not bus */ #define ISP176x_HC_FRINDEX 0x02c
#define CMD_RUN (1 << 0) /* start/stop HC */
#define ISP176x_HC_CONFIGFLAG 0x060
#define HC_USBSTS 0x024 #define ISP176x_HC_PORTSC1 0x064
#define STS_PCD (1 << 2) /* port change detect */
#define ISP176x_HC_ISO_PTD_DONEMAP 0x130
#define HC_FRINDEX 0x02c #define ISP176x_HC_ISO_PTD_SKIPMAP 0x134
#define ISP176x_HC_ISO_PTD_LASTPTD 0x138
#define HC_CONFIGFLAG 0x060 #define ISP176x_HC_INT_PTD_DONEMAP 0x140
#define FLAG_CF (1 << 0) /* true: we'll support "high speed" */ #define ISP176x_HC_INT_PTD_SKIPMAP 0x144
#define ISP176x_HC_INT_PTD_LASTPTD 0x148
#define HC_PORTSC1 0x064 #define ISP176x_HC_ATL_PTD_DONEMAP 0x150
#define PORT_OWNER (1 << 13) /* true: companion hc owns this port */ #define ISP176x_HC_ATL_PTD_SKIPMAP 0x154
#define PORT_POWER (1 << 12) /* true: has power (see PPC) */ #define ISP176x_HC_ATL_PTD_LASTPTD 0x158
#define PORT_USB11(x) (((x) & (3 << 10)) == (1 << 10)) /* USB 1.1 device */
#define PORT_RESET (1 << 8) /* reset port */
#define PORT_SUSPEND (1 << 7) /* suspend port */
#define PORT_RESUME (1 << 6) /* resume it */
#define PORT_PE (1 << 2) /* port enable */
#define PORT_CSC (1 << 1) /* connect status change */
#define PORT_CONNECT (1 << 0) /* device connected */
#define PORT_RWC_BITS (PORT_CSC)
#define HC_ISO_PTD_DONEMAP_REG 0x130
#define HC_ISO_PTD_SKIPMAP_REG 0x134
#define HC_ISO_PTD_LASTPTD_REG 0x138
#define HC_INT_PTD_DONEMAP_REG 0x140
#define HC_INT_PTD_SKIPMAP_REG 0x144
#define HC_INT_PTD_LASTPTD_REG 0x148
#define HC_ATL_PTD_DONEMAP_REG 0x150
#define HC_ATL_PTD_SKIPMAP_REG 0x154
#define HC_ATL_PTD_LASTPTD_REG 0x158
/* Configuration Register */ /* Configuration Register */
#define HC_HW_MODE_CTRL 0x300 #define ISP176x_HC_HW_MODE_CTRL 0x300
#define ALL_ATX_RESET (1 << 31) #define ISP176x_HC_CHIP_ID 0x304
#define HW_ANA_DIGI_OC (1 << 15) #define ISP176x_HC_SCRATCH 0x308
#define HW_DEV_DMA (1 << 11) #define ISP176x_HC_RESET 0x30c
#define HW_COMN_IRQ (1 << 10) #define ISP176x_HC_BUFFER_STATUS 0x334
#define HW_COMN_DMA (1 << 9) #define ISP176x_HC_MEMORY 0x33c
#define HW_DATA_BUS_32BIT (1 << 8)
#define HW_DACK_POL_HIGH (1 << 6)
#define HW_DREQ_POL_HIGH (1 << 5)
#define HW_INTR_HIGH_ACT (1 << 2)
#define HW_INTR_EDGE_TRIG (1 << 1)
#define HW_GLOBAL_INTR_EN (1 << 0)
#define HC_CHIP_ID_REG 0x304
#define HC_SCRATCH_REG 0x308
#define HC_RESET_REG 0x30c
#define SW_RESET_RESET_HC (1 << 1)
#define SW_RESET_RESET_ALL (1 << 0)
#define HC_BUFFER_STATUS_REG 0x334
#define ISO_BUF_FILL (1 << 2)
#define INT_BUF_FILL (1 << 1)
#define ATL_BUF_FILL (1 << 0)
#define HC_MEMORY_REG 0x33c
#define ISP_BANK(x) ((x) << 16)
#define HC_PORT1_CTRL 0x374
#define PORT1_POWER (3 << 3)
#define PORT1_INIT1 (1 << 7)
#define PORT1_INIT2 (1 << 23)
#define HW_OTG_CTRL_SET 0x374
#define HW_OTG_CTRL_CLR 0x376
#define HW_OTG_DISABLE (1 << 10)
#define HW_OTG_SE0_EN (1 << 9)
#define HW_BDIS_ACON_EN (1 << 8)
#define HW_SW_SEL_HC_DC (1 << 7)
#define HW_VBUS_CHRG (1 << 6)
#define HW_VBUS_DISCHRG (1 << 5)
#define HW_VBUS_DRV (1 << 4)
#define HW_SEL_CP_EXT (1 << 3)
#define HW_DM_PULLDOWN (1 << 2)
#define HW_DP_PULLDOWN (1 << 1)
#define HW_DP_PULLUP (1 << 0)
/* Interrupt Register */ /* Interrupt Register */
#define HC_INTERRUPT_REG 0x310 #define ISP176x_HC_INTERRUPT 0x310
#define ISP176x_HC_INTERRUPT_ENABLE 0x314
#define HC_INTERRUPT_ENABLE 0x314 #define ISP176x_HC_ISO_IRQ_MASK_OR 0x318
#define HC_ISO_INT (1 << 9) #define ISP176x_HC_INT_IRQ_MASK_OR 0x31c
#define HC_ATL_INT (1 << 8) #define ISP176x_HC_ATL_IRQ_MASK_OR 0x320
#define HC_INTL_INT (1 << 7) #define ISP176x_HC_ISO_IRQ_MASK_AND 0x324
#define HC_EOT_INT (1 << 3) #define ISP176x_HC_INT_IRQ_MASK_AND 0x328
#define HC_SOT_INT (1 << 1) #define ISP176x_HC_ATL_IRQ_MASK_AND 0x32c
#define INTERRUPT_ENABLE_MASK (HC_INTL_INT | HC_ATL_INT)
enum isp176x_host_controller_fields {
#define HC_ISO_IRQ_MASK_OR_REG 0x318 /* HC_HCSPARAMS */
#define HC_INT_IRQ_MASK_OR_REG 0x31c HCS_PPC, HCS_N_PORTS,
#define HC_ATL_IRQ_MASK_OR_REG 0x320 /* HC_HCCPARAMS */
#define HC_ISO_IRQ_MASK_AND_REG 0x324 HCC_ISOC_CACHE, HCC_ISOC_THRES,
#define HC_INT_IRQ_MASK_AND_REG 0x328 /* HC_USBCMD */
#define HC_ATL_IRQ_MASK_AND_REG 0x32c CMD_LRESET, CMD_RESET, CMD_RUN,
/* HC_USBSTS */
STS_PCD,
/* HC_FRINDEX */
HC_FRINDEX,
/* HC_CONFIGFLAG */
FLAG_CF,
/* HC_PORTSC1 */
PORT_OWNER, PORT_POWER, PORT_LSTATUS, PORT_RESET, PORT_SUSPEND,
PORT_RESUME, PORT_PE, PORT_CSC, PORT_CONNECT,
/* HC_HW_MODE_CTRL */
ALL_ATX_RESET, HW_ANA_DIGI_OC, HW_DEV_DMA, HW_COMN_IRQ, HW_COMN_DMA,
HW_DATA_BUS_WIDTH, HW_DACK_POL_HIGH, HW_DREQ_POL_HIGH, HW_INTR_HIGH_ACT,
HW_INTR_EDGE_TRIG, HW_GLOBAL_INTR_EN,
/* HC_RESET */
SW_RESET_RESET_HC, SW_RESET_RESET_ALL,
/* HC_BUFFER_STATUS */
INT_BUF_FILL, ATL_BUF_FILL,
/* HC_MEMORY */
MEM_BANK_SEL, MEM_START_ADDR,
/* HC_INTERRUPT_ENABLE */
HC_INT_ENABLE,
/* Last element */
HC_FIELD_MAX,
};
/* ----------------------------------------------------------------------------- /* -----------------------------------------------------------------------------
* Peripheral Controller * Peripheral Controller
*/ */
/* Initialization Registers */
#define DC_ADDRESS 0x0200
#define DC_DEVEN (1 << 7)
#define DC_MODE 0x020c
#define DC_DMACLKON (1 << 9)
#define DC_VBUSSTAT (1 << 8)
#define DC_CLKAON (1 << 7)
#define DC_SNDRSU (1 << 6)
#define DC_GOSUSP (1 << 5)
#define DC_SFRESET (1 << 4)
#define DC_GLINTENA (1 << 3)
#define DC_WKUPCS (1 << 2)
#define DC_INTCONF 0x0210
#define DC_CDBGMOD_ACK_NAK (0 << 6)
#define DC_CDBGMOD_ACK (1 << 6)
#define DC_CDBGMOD_ACK_1NAK (2 << 6)
#define DC_DDBGMODIN_ACK_NAK (0 << 4)
#define DC_DDBGMODIN_ACK (1 << 4)
#define DC_DDBGMODIN_ACK_1NAK (2 << 4)
#define DC_DDBGMODOUT_ACK_NYET_NAK (0 << 2)
#define DC_DDBGMODOUT_ACK_NYET (1 << 2)
#define DC_DDBGMODOUT_ACK_NYET_1NAK (2 << 2)
#define DC_INTLVL (1 << 1)
#define DC_INTPOL (1 << 0)
#define DC_DEBUG 0x0212
#define DC_INTENABLE 0x0214
#define DC_IEPTX(n) (1 << (11 + 2 * (n))) #define DC_IEPTX(n) (1 << (11 + 2 * (n)))
#define DC_IEPRX(n) (1 << (10 + 2 * (n))) #define DC_IEPRX(n) (1 << (10 + 2 * (n)))
#define DC_IEPRXTX(n) (3 << (10 + 2 * (n))) #define DC_IEPRXTX(n) (3 << (10 + 2 * (n)))
#define DC_IEP0SETUP (1 << 8)
#define DC_IEVBUS (1 << 7) #define ISP176x_DC_CDBGMOD_ACK BIT(6)
#define DC_IEDMA (1 << 6) #define ISP176x_DC_DDBGMODIN_ACK BIT(4)
#define DC_IEHS_STA (1 << 5) #define ISP176x_DC_DDBGMODOUT_ACK BIT(2)
#define DC_IERESM (1 << 4)
#define DC_IESUSP (1 << 3) #define ISP176x_DC_IEP0SETUP BIT(8)
#define DC_IEPSOF (1 << 2) #define ISP176x_DC_IEVBUS BIT(7)
#define DC_IESOF (1 << 1) #define ISP176x_DC_IEHS_STA BIT(5)
#define DC_IEBRST (1 << 0) #define ISP176x_DC_IERESM BIT(4)
#define ISP176x_DC_IESUSP BIT(3)
#define ISP176x_DC_IEBRST BIT(0)
#define ISP176x_DC_ENDPTYP_ISOC 0x01
#define ISP176x_DC_ENDPTYP_BULK 0x02
#define ISP176x_DC_ENDPTYP_INTERRUPT 0x03
/* Initialization Registers */
#define ISP176x_DC_ADDRESS 0x0200
#define ISP176x_DC_MODE 0x020c
#define ISP176x_DC_INTCONF 0x0210
#define ISP176x_DC_DEBUG 0x0212
#define ISP176x_DC_INTENABLE 0x0214
/* Data Flow Registers */ /* Data Flow Registers */
#define DC_EPINDEX 0x022c #define ISP176x_DC_EPMAXPKTSZ 0x0204
#define DC_EP0SETUP (1 << 5) #define ISP176x_DC_EPTYPE 0x0208
#define DC_ENDPIDX(n) ((n) << 1)
#define DC_EPDIR (1 << 0) #define ISP176x_DC_BUFLEN 0x021c
#define ISP176x_DC_BUFSTAT 0x021e
#define DC_CTRLFUNC 0x0228 #define ISP176x_DC_DATAPORT 0x0220
#define DC_CLBUF (1 << 4)
#define DC_VENDP (1 << 3) #define ISP176x_DC_CTRLFUNC 0x0228
#define DC_DSEN (1 << 2) #define ISP176x_DC_EPINDEX 0x022c
#define DC_STATUS (1 << 1)
#define DC_STALL (1 << 0) #define ISP1761_DC_OTG_CTRL_SET 0x374
#define ISP1761_DC_OTG_CTRL_CLEAR 0x376
#define DC_DATAPORT 0x0220
#define DC_BUFLEN 0x021c
#define DC_DATACOUNT_MASK 0xffff
#define DC_BUFSTAT 0x021e
#define DC_EPMAXPKTSZ 0x0204
#define DC_EPTYPE 0x0208
#define DC_NOEMPKT (1 << 4)
#define DC_EPENABLE (1 << 3)
#define DC_DBLBUF (1 << 2)
#define DC_ENDPTYP_ISOC (1 << 0)
#define DC_ENDPTYP_BULK (2 << 0)
#define DC_ENDPTYP_INTERRUPT (3 << 0)
/* DMA Registers */ /* DMA Registers */
#define DC_DMACMD 0x0230 #define ISP176x_DC_DMACMD 0x0230
#define DC_DMATXCOUNT 0x0234 #define ISP176x_DC_DMATXCOUNT 0x0234
#define DC_DMACONF 0x0238 #define ISP176x_DC_DMACONF 0x0238
#define DC_DMAHW 0x023c #define ISP176x_DC_DMAHW 0x023c
#define DC_DMAINTREASON 0x0250 #define ISP176x_DC_DMAINTREASON 0x0250
#define DC_DMAINTEN 0x0254 #define ISP176x_DC_DMAINTEN 0x0254
#define DC_DMAEP 0x0258 #define ISP176x_DC_DMAEP 0x0258
#define DC_DMABURSTCOUNT 0x0264 #define ISP176x_DC_DMABURSTCOUNT 0x0264
/* General Registers */ /* General Registers */
#define DC_INTERRUPT 0x0218 #define ISP176x_DC_INTERRUPT 0x0218
#define DC_CHIPID 0x0270 #define ISP176x_DC_CHIPID 0x0270
#define DC_FRAMENUM 0x0274 #define ISP176x_DC_FRAMENUM 0x0274
#define DC_SCRATCH 0x0278 #define ISP176x_DC_SCRATCH 0x0278
#define DC_UNLOCKDEV 0x027c #define ISP176x_DC_UNLOCKDEV 0x027c
#define DC_INTPULSEWIDTH 0x0280 #define ISP176x_DC_INTPULSEWIDTH 0x0280
#define DC_TESTMODE 0x0284 #define ISP176x_DC_TESTMODE 0x0284
enum isp176x_device_controller_fields {
/* DC_ADDRESS */
DC_DEVEN, DC_DEVADDR,
/* DC_MODE */
DC_VBUSSTAT, DC_SFRESET, DC_GLINTENA,
/* DC_INTCONF */
DC_CDBGMOD_ACK, DC_DDBGMODIN_ACK, DC_DDBGMODOUT_ACK, DC_INTPOL,
/* DC_INTENABLE */
DC_IEPRXTX_7, DC_IEPRXTX_6, DC_IEPRXTX_5, DC_IEPRXTX_4, DC_IEPRXTX_3,
DC_IEPRXTX_2, DC_IEPRXTX_1, DC_IEPRXTX_0,
DC_IEP0SETUP, DC_IEVBUS, DC_IEHS_STA, DC_IERESM, DC_IESUSP, DC_IEBRST,
/* DC_EPINDEX */
DC_EP0SETUP, DC_ENDPIDX, DC_EPDIR,
/* DC_CTRLFUNC */
DC_CLBUF, DC_VENDP, DC_DSEN, DC_STATUS, DC_STALL,
/* DC_BUFLEN */
DC_BUFLEN,
/* DC_EPMAXPKTSZ */
DC_FFOSZ,
/* DC_EPTYPE */
DC_EPENABLE, DC_ENDPTYP,
/* DC_FRAMENUM */
DC_FRAMENUM, DC_UFRAMENUM,
/* HW_OTG_CTRL_SET */
HW_OTG_DISABLE, HW_SW_SEL_HC_DC, HW_VBUS_DRV, HW_SEL_CP_EXT,
HW_DM_PULLDOWN, HW_DP_PULLDOWN, HW_DP_PULLUP,
/* HW_OTG_CTRL_CLR */
HW_OTG_DISABLE_CLEAR, HW_SW_SEL_HC_DC_CLEAR, HW_VBUS_DRV_CLEAR,
HW_SEL_CP_EXT_CLEAR, HW_DM_PULLDOWN_CLEAR, HW_DP_PULLDOWN_CLEAR,
HW_DP_PULLUP_CLEAR,
/* Last element */
DC_FIELD_MAX,
};
#endif #endif
drivers/usb/isp1760/isp1760-udc.c
View file @ 1da9e1c0
...@@ -45,16 +45,62 @@ static inline struct isp1760_request *req_to_udc_req(struct usb_request *req) ...@@ -45,16 +45,62 @@ static inline struct isp1760_request *req_to_udc_req(struct usb_request *req)
return container_of(req, struct isp1760_request, req); return container_of(req, struct isp1760_request, req);
} }
static inline u32 isp1760_udc_read(struct isp1760_udc *udc, u16 reg) static u32 isp1760_udc_read(struct isp1760_udc *udc, u16 field)
{ {
return isp1760_read32(udc->regs, reg); return isp1760_field_read(udc->fields, field);
} }
static inline void isp1760_udc_write(struct isp1760_udc *udc, u16 reg, u32 val) static void isp1760_udc_write(struct isp1760_udc *udc, u16 field, u32 val)
{ {
isp1760_write32(udc->regs, reg, val); isp1760_field_write(udc->fields, field, val);
} }
static u32 isp1760_udc_read_raw(struct isp1760_udc *udc, u16 reg)
{
__le32 val;
regmap_raw_read(udc->regs, reg, &val, 4);
return le32_to_cpu(val);
}
static u16 isp1760_udc_read_raw16(struct isp1760_udc *udc, u16 reg)
{
__le16 val;
regmap_raw_read(udc->regs, reg, &val, 2);
return le16_to_cpu(val);
}
static void isp1760_udc_write_raw(struct isp1760_udc *udc, u16 reg, u32 val)
{
__le32 val_le = cpu_to_le32(val);
regmap_raw_write(udc->regs, reg, &val_le, 4);
}
static void isp1760_udc_write_raw16(struct isp1760_udc *udc, u16 reg, u16 val)
{
__le16 val_le = cpu_to_le16(val);
regmap_raw_write(udc->regs, reg, &val_le, 2);
}
static void isp1760_udc_set(struct isp1760_udc *udc, u32 field)
{
isp1760_udc_write(udc, field, 0xFFFFFFFF);
}
static void isp1760_udc_clear(struct isp1760_udc *udc, u32 field)
{
isp1760_udc_write(udc, field, 0);
}
static bool isp1760_udc_is_set(struct isp1760_udc *udc, u32 field)
{
return !!isp1760_udc_read(udc, field);
}
/* ----------------------------------------------------------------------------- /* -----------------------------------------------------------------------------
* Endpoint Management * Endpoint Management
*/ */
...@@ -75,11 +121,15 @@ static struct isp1760_ep *isp1760_udc_find_ep(struct isp1760_udc *udc, ...@@ -75,11 +121,15 @@ static struct isp1760_ep *isp1760_udc_find_ep(struct isp1760_udc *udc,
return NULL; return NULL;
} }
static void __isp1760_udc_select_ep(struct isp1760_ep *ep, int dir) static void __isp1760_udc_select_ep(struct isp1760_udc *udc,
struct isp1760_ep *ep, int dir)
{ {
isp1760_udc_write(ep->udc, DC_EPINDEX, isp1760_udc_write(udc, DC_ENDPIDX, ep->addr & USB_ENDPOINT_NUMBER_MASK);
DC_ENDPIDX(ep->addr & USB_ENDPOINT_NUMBER_MASK) |
(dir == USB_DIR_IN ? DC_EPDIR : 0)); if (dir == USB_DIR_IN)
isp1760_udc_set(udc, DC_EPDIR);
else
isp1760_udc_clear(udc, DC_EPDIR);
} }
/** /**
...@@ -93,9 +143,10 @@ static void __isp1760_udc_select_ep(struct isp1760_ep *ep, int dir) ...@@ -93,9 +143,10 @@ static void __isp1760_udc_select_ep(struct isp1760_ep *ep, int dir)
* *
* Called with the UDC spinlock held. * Called with the UDC spinlock held.
*/ */
static void isp1760_udc_select_ep(struct isp1760_ep *ep) static void isp1760_udc_select_ep(struct isp1760_udc *udc,
struct isp1760_ep *ep)
{ {
__isp1760_udc_select_ep(ep, ep->addr & USB_ENDPOINT_DIR_MASK); __isp1760_udc_select_ep(udc, ep, ep->addr & USB_ENDPOINT_DIR_MASK);
} }
/* Called with the UDC spinlock held. */ /* Called with the UDC spinlock held. */
...@@ -108,9 +159,13 @@ static void isp1760_udc_ctrl_send_status(struct isp1760_ep *ep, int dir) ...@@ -108,9 +159,13 @@ static void isp1760_udc_ctrl_send_status(struct isp1760_ep *ep, int dir)
* the direction opposite to the data stage data packets, we thus need * the direction opposite to the data stage data packets, we thus need
* to select the OUT/IN endpoint for IN/OUT transfers. * to select the OUT/IN endpoint for IN/OUT transfers.
*/ */
isp1760_udc_write(udc, DC_EPINDEX, DC_ENDPIDX(0) | if (dir == USB_DIR_IN)
(dir == USB_DIR_IN ? 0 : DC_EPDIR)); isp1760_udc_clear(udc, DC_EPDIR);
isp1760_udc_write(udc, DC_CTRLFUNC, DC_STATUS); else
isp1760_udc_set(udc, DC_EPDIR);
isp1760_udc_write(udc, DC_ENDPIDX, 1);
isp1760_udc_set(udc, DC_STATUS);
/* /*
* The hardware will terminate the request automatically and go back to * The hardware will terminate the request automatically and go back to
...@@ -157,10 +212,10 @@ static void isp1760_udc_ctrl_send_stall(struct isp1760_ep *ep) ...@@ -157,10 +212,10 @@ static void isp1760_udc_ctrl_send_stall(struct isp1760_ep *ep)
spin_lock_irqsave(&udc->lock, flags); spin_lock_irqsave(&udc->lock, flags);
/* Stall both the IN and OUT endpoints. */ /* Stall both the IN and OUT endpoints. */
__isp1760_udc_select_ep(ep, USB_DIR_OUT); __isp1760_udc_select_ep(udc, ep, USB_DIR_OUT);
isp1760_udc_write(udc, DC_CTRLFUNC, DC_STALL); isp1760_udc_set(udc, DC_STALL);
__isp1760_udc_select_ep(ep, USB_DIR_IN); __isp1760_udc_select_ep(udc, ep, USB_DIR_IN);
isp1760_udc_write(udc, DC_CTRLFUNC, DC_STALL); isp1760_udc_set(udc, DC_STALL);
/* A protocol stall completes the control transaction. */ /* A protocol stall completes the control transaction. */
udc->ep0_state = ISP1760_CTRL_SETUP; udc->ep0_state = ISP1760_CTRL_SETUP;
...@@ -181,8 +236,8 @@ static bool isp1760_udc_receive(struct isp1760_ep *ep, ...@@ -181,8 +236,8 @@ static bool isp1760_udc_receive(struct isp1760_ep *ep,
u32 *buf; u32 *buf;
int i; int i;
isp1760_udc_select_ep(ep); isp1760_udc_select_ep(udc, ep);
len = isp1760_udc_read(udc, DC_BUFLEN) & DC_DATACOUNT_MASK; len = isp1760_udc_read(udc, DC_BUFLEN);
dev_dbg(udc->isp->dev, "%s: received %u bytes (%u/%u done)\n", dev_dbg(udc->isp->dev, "%s: received %u bytes (%u/%u done)\n",
__func__, len, req->req.actual, req->req.length); __func__, len, req->req.actual, req->req.length);
...@@ -198,7 +253,7 @@ static bool isp1760_udc_receive(struct isp1760_ep *ep, ...@@ -198,7 +253,7 @@ static bool isp1760_udc_receive(struct isp1760_ep *ep,
* datasheet doesn't clearly document how this should be * datasheet doesn't clearly document how this should be
* handled. * handled.
*/ */
isp1760_udc_write(udc, DC_CTRLFUNC, DC_CLBUF); isp1760_udc_set(udc, DC_CLBUF);
return false; return false;
} }
...@@ -209,9 +264,9 @@ static bool isp1760_udc_receive(struct isp1760_ep *ep, ...@@ -209,9 +264,9 @@ static bool isp1760_udc_receive(struct isp1760_ep *ep,
* the next packet might be removed from the FIFO. * the next packet might be removed from the FIFO.
*/ */
for (i = len; i > 2; i -= 4, ++buf) for (i = len; i > 2; i -= 4, ++buf)
*buf = le32_to_cpu(isp1760_udc_read(udc, DC_DATAPORT)); *buf = isp1760_udc_read_raw(udc, ISP176x_DC_DATAPORT);
if (i > 0) if (i > 0)
*(u16 *)buf = le16_to_cpu(readw(udc->regs + DC_DATAPORT)); *(u16 *)buf = isp1760_udc_read_raw16(udc, ISP176x_DC_DATAPORT);
req->req.actual += len; req->req.actual += len;
...@@ -253,7 +308,7 @@ static void isp1760_udc_transmit(struct isp1760_ep *ep, ...@@ -253,7 +308,7 @@ static void isp1760_udc_transmit(struct isp1760_ep *ep,
__func__, req->packet_size, req->req.actual, __func__, req->packet_size, req->req.actual,
req->req.length); req->req.length);
__isp1760_udc_select_ep(ep, USB_DIR_IN); __isp1760_udc_select_ep(udc, ep, USB_DIR_IN);
if (req->packet_size) if (req->packet_size)
isp1760_udc_write(udc, DC_BUFLEN, req->packet_size); isp1760_udc_write(udc, DC_BUFLEN, req->packet_size);
...@@ -265,14 +320,14 @@ static void isp1760_udc_transmit(struct isp1760_ep *ep, ...@@ -265,14 +320,14 @@ static void isp1760_udc_transmit(struct isp1760_ep *ep,
* the FIFO for this kind of conditions, but doesn't seem to work. * the FIFO for this kind of conditions, but doesn't seem to work.
*/ */
for (i = req->packet_size; i > 2; i -= 4, ++buf) for (i = req->packet_size; i > 2; i -= 4, ++buf)
isp1760_udc_write(udc, DC_DATAPORT, cpu_to_le32(*buf)); isp1760_udc_write_raw(udc, ISP176x_DC_DATAPORT, *buf);
if (i > 0) if (i > 0)
writew(cpu_to_le16(*(u16 *)buf), udc->regs + DC_DATAPORT); isp1760_udc_write_raw16(udc, ISP176x_DC_DATAPORT, *(u16 *)buf);
if (ep->addr == 0) if (ep->addr == 0)
isp1760_udc_write(udc, DC_CTRLFUNC, DC_DSEN); isp1760_udc_set(udc, DC_DSEN);
if (!req->packet_size) if (!req->packet_size)
isp1760_udc_write(udc, DC_CTRLFUNC, DC_VENDP); isp1760_udc_set(udc, DC_VENDP);
} }
static void isp1760_ep_rx_ready(struct isp1760_ep *ep) static void isp1760_ep_rx_ready(struct isp1760_ep *ep)
...@@ -408,19 +463,24 @@ static int __isp1760_udc_set_halt(struct isp1760_ep *ep, bool halt) ...@@ -408,19 +463,24 @@ static int __isp1760_udc_set_halt(struct isp1760_ep *ep, bool halt)
return -EINVAL; return -EINVAL;
} }
isp1760_udc_select_ep(ep); isp1760_udc_select_ep(udc, ep);
isp1760_udc_write(udc, DC_CTRLFUNC, halt ? DC_STALL : 0);
if (halt)
isp1760_udc_set(udc, DC_STALL);
else
isp1760_udc_clear(udc, DC_STALL);
if (ep->addr == 0) { if (ep->addr == 0) {
/* When halting the control endpoint, stall both IN and OUT. */ /* When halting the control endpoint, stall both IN and OUT. */
__isp1760_udc_select_ep(ep, USB_DIR_IN); __isp1760_udc_select_ep(udc, ep, USB_DIR_IN);
isp1760_udc_write(udc, DC_CTRLFUNC, halt ? DC_STALL : 0); if (halt)
isp1760_udc_set(udc, DC_STALL);
else
isp1760_udc_clear(udc, DC_STALL);
} else if (!halt) { } else if (!halt) {
/* Reset the data PID by cycling the endpoint enable bit. */ /* Reset the data PID by cycling the endpoint enable bit. */
u16 eptype = isp1760_udc_read(udc, DC_EPTYPE); isp1760_udc_clear(udc, DC_EPENABLE);
isp1760_udc_set(udc, DC_EPENABLE);
isp1760_udc_write(udc, DC_EPTYPE, eptype & ~DC_EPENABLE);
isp1760_udc_write(udc, DC_EPTYPE, eptype);
/* /*
* Disabling the endpoint emptied the transmit FIFO, fill it * Disabling the endpoint emptied the transmit FIFO, fill it
...@@ -479,12 +539,14 @@ static int isp1760_udc_get_status(struct isp1760_udc *udc, ...@@ -479,12 +539,14 @@ static int isp1760_udc_get_status(struct isp1760_udc *udc,
return -EINVAL; return -EINVAL;
} }
isp1760_udc_write(udc, DC_EPINDEX, DC_ENDPIDX(0) | DC_EPDIR); isp1760_udc_set(udc, DC_EPDIR);
isp1760_udc_write(udc, DC_ENDPIDX, 1);
isp1760_udc_write(udc, DC_BUFLEN, 2); isp1760_udc_write(udc, DC_BUFLEN, 2);
writew(cpu_to_le16(status), udc->regs + DC_DATAPORT); isp1760_udc_write_raw16(udc, ISP176x_DC_DATAPORT, status);
isp1760_udc_write(udc, DC_CTRLFUNC, DC_DSEN); isp1760_udc_set(udc, DC_DSEN);
dev_dbg(udc->isp->dev, "%s: status 0x%04x\n", __func__, status); dev_dbg(udc->isp->dev, "%s: status 0x%04x\n", __func__, status);
...@@ -508,7 +570,8 @@ static int isp1760_udc_set_address(struct isp1760_udc *udc, u16 addr) ...@@ -508,7 +570,8 @@ static int isp1760_udc_set_address(struct isp1760_udc *udc, u16 addr)
usb_gadget_set_state(&udc->gadget, addr ? USB_STATE_ADDRESS : usb_gadget_set_state(&udc->gadget, addr ? USB_STATE_ADDRESS :
USB_STATE_DEFAULT); USB_STATE_DEFAULT);
isp1760_udc_write(udc, DC_ADDRESS, DC_DEVEN | addr); isp1760_udc_write(udc, DC_DEVADDR, addr);
isp1760_udc_set(udc, DC_DEVEN);
spin_lock(&udc->lock); spin_lock(&udc->lock);
isp1760_udc_ctrl_send_status(&udc->ep[0], USB_DIR_OUT); isp1760_udc_ctrl_send_status(&udc->ep[0], USB_DIR_OUT);
...@@ -650,9 +713,9 @@ static void isp1760_ep0_setup(struct isp1760_udc *udc) ...@@ -650,9 +713,9 @@ static void isp1760_ep0_setup(struct isp1760_udc *udc)
spin_lock(&udc->lock); spin_lock(&udc->lock);
isp1760_udc_write(udc, DC_EPINDEX, DC_EP0SETUP); isp1760_udc_set(udc, DC_EP0SETUP);
count = isp1760_udc_read(udc, DC_BUFLEN) & DC_DATACOUNT_MASK; count = isp1760_udc_read(udc, DC_BUFLEN);
if (count != sizeof(req)) { if (count != sizeof(req)) {
spin_unlock(&udc->lock); spin_unlock(&udc->lock);
...@@ -663,8 +726,8 @@ static void isp1760_ep0_setup(struct isp1760_udc *udc) ...@@ -663,8 +726,8 @@ static void isp1760_ep0_setup(struct isp1760_udc *udc)
return; return;
} }
req.data[0] = isp1760_udc_read(udc, DC_DATAPORT); req.data[0] = isp1760_udc_read_raw(udc, ISP176x_DC_DATAPORT);
req.data[1] = isp1760_udc_read(udc, DC_DATAPORT); req.data[1] = isp1760_udc_read_raw(udc, ISP176x_DC_DATAPORT);
if (udc->ep0_state != ISP1760_CTRL_SETUP) { if (udc->ep0_state != ISP1760_CTRL_SETUP) {
spin_unlock(&udc->lock); spin_unlock(&udc->lock);
...@@ -732,13 +795,13 @@ static int isp1760_ep_enable(struct usb_ep *ep, ...@@ -732,13 +795,13 @@ static int isp1760_ep_enable(struct usb_ep *ep,
switch (usb_endpoint_type(desc)) { switch (usb_endpoint_type(desc)) {
case USB_ENDPOINT_XFER_ISOC: case USB_ENDPOINT_XFER_ISOC:
type = DC_ENDPTYP_ISOC; type = ISP176x_DC_ENDPTYP_ISOC;
break; break;
case USB_ENDPOINT_XFER_BULK: case USB_ENDPOINT_XFER_BULK:
type = DC_ENDPTYP_BULK; type = ISP176x_DC_ENDPTYP_BULK;
break; break;
case USB_ENDPOINT_XFER_INT: case USB_ENDPOINT_XFER_INT:
type = DC_ENDPTYP_INTERRUPT; type = ISP176x_DC_ENDPTYP_INTERRUPT;
break; break;
case USB_ENDPOINT_XFER_CONTROL: case USB_ENDPOINT_XFER_CONTROL:
default: default:
...@@ -755,10 +818,13 @@ static int isp1760_ep_enable(struct usb_ep *ep, ...@@ -755,10 +818,13 @@ static int isp1760_ep_enable(struct usb_ep *ep,
uep->halted = false; uep->halted = false;
uep->wedged = false; uep->wedged = false;
isp1760_udc_select_ep(uep); isp1760_udc_select_ep(udc, uep);
isp1760_udc_write(udc, DC_EPMAXPKTSZ, uep->maxpacket);
isp1760_udc_write(udc, DC_FFOSZ, uep->maxpacket);
isp1760_udc_write(udc, DC_BUFLEN, uep->maxpacket); isp1760_udc_write(udc, DC_BUFLEN, uep->maxpacket);
isp1760_udc_write(udc, DC_EPTYPE, DC_EPENABLE | type);
isp1760_udc_write(udc, DC_ENDPTYP, type);
isp1760_udc_set(udc, DC_EPENABLE);
spin_unlock_irqrestore(&udc->lock, flags); spin_unlock_irqrestore(&udc->lock, flags);
...@@ -786,8 +852,9 @@ static int isp1760_ep_disable(struct usb_ep *ep) ...@@ -786,8 +852,9 @@ static int isp1760_ep_disable(struct usb_ep *ep)
uep->desc = NULL; uep->desc = NULL;
uep->maxpacket = 0; uep->maxpacket = 0;
isp1760_udc_select_ep(uep); isp1760_udc_select_ep(udc, uep);
isp1760_udc_write(udc, DC_EPTYPE, 0); isp1760_udc_clear(udc, DC_EPENABLE);
isp1760_udc_clear(udc, DC_ENDPTYP);
/* TODO Synchronize with the IRQ handler */ /* TODO Synchronize with the IRQ handler */
...@@ -864,8 +931,8 @@ static int isp1760_ep_queue(struct usb_ep *ep, struct usb_request *_req, ...@@ -864,8 +931,8 @@ static int isp1760_ep_queue(struct usb_ep *ep, struct usb_request *_req,
case ISP1760_CTRL_DATA_OUT: case ISP1760_CTRL_DATA_OUT:
list_add_tail(&req->queue, &uep->queue); list_add_tail(&req->queue, &uep->queue);
__isp1760_udc_select_ep(uep, USB_DIR_OUT); __isp1760_udc_select_ep(udc, uep, USB_DIR_OUT);
isp1760_udc_write(udc, DC_CTRLFUNC, DC_DSEN); isp1760_udc_set(udc, DC_DSEN);
break; break;
case ISP1760_CTRL_STATUS: case ISP1760_CTRL_STATUS:
...@@ -1025,14 +1092,14 @@ static void isp1760_ep_fifo_flush(struct usb_ep *ep) ...@@ -1025,14 +1092,14 @@ static void isp1760_ep_fifo_flush(struct usb_ep *ep)
spin_lock_irqsave(&udc->lock, flags); spin_lock_irqsave(&udc->lock, flags);
isp1760_udc_select_ep(uep); isp1760_udc_select_ep(udc, uep);
/* /*
* Set the CLBUF bit twice to flush both buffers in case double * Set the CLBUF bit twice to flush both buffers in case double
* buffering is enabled. * buffering is enabled.
*/ */
isp1760_udc_write(udc, DC_CTRLFUNC, DC_CLBUF); isp1760_udc_set(udc, DC_CLBUF);
isp1760_udc_write(udc, DC_CTRLFUNC, DC_CLBUF); isp1760_udc_set(udc, DC_CLBUF);
spin_unlock_irqrestore(&udc->lock, flags); spin_unlock_irqrestore(&udc->lock, flags);
} }
...@@ -1091,19 +1158,22 @@ static void isp1760_udc_init_hw(struct isp1760_udc *udc) ...@@ -1091,19 +1158,22 @@ static void isp1760_udc_init_hw(struct isp1760_udc *udc)
* ACK tokens only (and NYET for the out pipe). The default * ACK tokens only (and NYET for the out pipe). The default
* configuration also generates an interrupt on the first NACK token. * configuration also generates an interrupt on the first NACK token.
*/ */
isp1760_udc_write(udc, DC_INTCONF, DC_CDBGMOD_ACK | DC_DDBGMODIN_ACK | isp1760_reg_write(udc->regs, ISP176x_DC_INTCONF,
DC_DDBGMODOUT_ACK_NYET); ISP176x_DC_CDBGMOD_ACK | ISP176x_DC_DDBGMODIN_ACK |
ISP176x_DC_DDBGMODOUT_ACK);
isp1760_udc_write(udc, DC_INTENABLE, DC_IEPRXTX(7) | DC_IEPRXTX(6) |
DC_IEPRXTX(5) | DC_IEPRXTX(4) | DC_IEPRXTX(3) | isp1760_reg_write(udc->regs, ISP176x_DC_INTENABLE, DC_IEPRXTX(7) |
DC_IEPRXTX(2) | DC_IEPRXTX(1) | DC_IEPRXTX(0) | DC_IEPRXTX(6) | DC_IEPRXTX(5) | DC_IEPRXTX(4) |
DC_IEP0SETUP | DC_IEVBUS | DC_IERESM | DC_IESUSP | DC_IEPRXTX(3) | DC_IEPRXTX(2) | DC_IEPRXTX(1) |
DC_IEHS_STA | DC_IEBRST); DC_IEPRXTX(0) | ISP176x_DC_IEP0SETUP |
ISP176x_DC_IEVBUS | ISP176x_DC_IERESM |
ISP176x_DC_IESUSP | ISP176x_DC_IEHS_STA |
ISP176x_DC_IEBRST);
if (udc->connected) if (udc->connected)
isp1760_set_pullup(udc->isp, true); isp1760_set_pullup(udc->isp, true);
isp1760_udc_write(udc, DC_ADDRESS, DC_DEVEN); isp1760_udc_set(udc, DC_DEVEN);
} }
static void isp1760_udc_reset(struct isp1760_udc *udc) static void isp1760_udc_reset(struct isp1760_udc *udc)
...@@ -1152,7 +1222,7 @@ static int isp1760_udc_get_frame(struct usb_gadget *gadget) ...@@ -1152,7 +1222,7 @@ static int isp1760_udc_get_frame(struct usb_gadget *gadget)
{ {
struct isp1760_udc *udc = gadget_to_udc(gadget); struct isp1760_udc *udc = gadget_to_udc(gadget);
return isp1760_udc_read(udc, DC_FRAMENUM) & ((1 << 11) - 1); return isp1760_udc_read(udc, DC_FRAMENUM);
} }
static int isp1760_udc_wakeup(struct usb_gadget *gadget) static int isp1760_udc_wakeup(struct usb_gadget *gadget)
...@@ -1219,7 +1289,7 @@ static int isp1760_udc_start(struct usb_gadget *gadget, ...@@ -1219,7 +1289,7 @@ static int isp1760_udc_start(struct usb_gadget *gadget,
usb_gadget_set_state(&udc->gadget, USB_STATE_ATTACHED); usb_gadget_set_state(&udc->gadget, USB_STATE_ATTACHED);
/* DMA isn't supported yet, don't enable the DMA clock. */ /* DMA isn't supported yet, don't enable the DMA clock. */
isp1760_udc_write(udc, DC_MODE, DC_GLINTENA); isp1760_udc_set(udc, DC_GLINTENA);
isp1760_udc_init_hw(udc); isp1760_udc_init_hw(udc);
...@@ -1238,7 +1308,7 @@ static int isp1760_udc_stop(struct usb_gadget *gadget) ...@@ -1238,7 +1308,7 @@ static int isp1760_udc_stop(struct usb_gadget *gadget)
del_timer_sync(&udc->vbus_timer); del_timer_sync(&udc->vbus_timer);
isp1760_udc_write(udc, DC_MODE, 0); isp1760_reg_write(udc->regs, ISP176x_DC_MODE, 0);
spin_lock_irqsave(&udc->lock, flags); spin_lock_irqsave(&udc->lock, flags);
udc->driver = NULL; udc->driver = NULL;
...@@ -1266,9 +1336,9 @@ static irqreturn_t isp1760_udc_irq(int irq, void *dev) ...@@ -1266,9 +1336,9 @@ static irqreturn_t isp1760_udc_irq(int irq, void *dev)
unsigned int i; unsigned int i;
u32 status; u32 status;
status = isp1760_udc_read(udc, DC_INTERRUPT) status = isp1760_reg_read(udc->regs, ISP176x_DC_INTERRUPT)
& isp1760_udc_read(udc, DC_INTENABLE); & isp1760_reg_read(udc->regs, ISP176x_DC_INTENABLE);
isp1760_udc_write(udc, DC_INTERRUPT, status); isp1760_reg_write(udc->regs, ISP176x_DC_INTERRUPT, status);
if (status & DC_IEVBUS) { if (status & DC_IEVBUS) {
dev_dbg(udc->isp->dev, "%s(VBUS)\n", __func__); dev_dbg(udc->isp->dev, "%s(VBUS)\n", __func__);
...@@ -1313,7 +1383,7 @@ static irqreturn_t isp1760_udc_irq(int irq, void *dev) ...@@ -1313,7 +1383,7 @@ static irqreturn_t isp1760_udc_irq(int irq, void *dev)
dev_dbg(udc->isp->dev, "%s(SUSP)\n", __func__); dev_dbg(udc->isp->dev, "%s(SUSP)\n", __func__);
spin_lock(&udc->lock); spin_lock(&udc->lock);
if (!(isp1760_udc_read(udc, DC_MODE) & DC_VBUSSTAT)) if (!isp1760_udc_is_set(udc, DC_VBUSSTAT))
isp1760_udc_disconnect(udc); isp1760_udc_disconnect(udc);
else else
isp1760_udc_suspend(udc); isp1760_udc_suspend(udc);
...@@ -1335,7 +1405,7 @@ static void isp1760_udc_vbus_poll(struct timer_list *t) ...@@ -1335,7 +1405,7 @@ static void isp1760_udc_vbus_poll(struct timer_list *t)
spin_lock_irqsave(&udc->lock, flags); spin_lock_irqsave(&udc->lock, flags);
if (!(isp1760_udc_read(udc, DC_MODE) & DC_VBUSSTAT)) if (!(isp1760_udc_is_set(udc, DC_VBUSSTAT)))
isp1760_udc_disconnect(udc); isp1760_udc_disconnect(udc);
else if (udc->gadget.state >= USB_STATE_POWERED) else if (udc->gadget.state >= USB_STATE_POWERED)
mod_timer(&udc->vbus_timer, mod_timer(&udc->vbus_timer,
...@@ -1412,9 +1482,9 @@ static int isp1760_udc_init(struct isp1760_udc *udc) ...@@ -1412,9 +1482,9 @@ static int isp1760_udc_init(struct isp1760_udc *udc)
* register, and reading the scratch register value back. The chip ID * register, and reading the scratch register value back. The chip ID
* and scratch register contents must match the expected values. * and scratch register contents must match the expected values.
*/ */
isp1760_udc_write(udc, DC_SCRATCH, 0xbabe); isp1760_reg_write(udc->regs, ISP176x_DC_SCRATCH, 0xbabe);
chipid = isp1760_udc_read(udc, DC_CHIPID); chipid = isp1760_reg_read(udc->regs, ISP176x_DC_CHIPID);
scratch = isp1760_udc_read(udc, DC_SCRATCH); scratch = isp1760_reg_read(udc->regs, ISP176x_DC_SCRATCH);
if (scratch != 0xbabe) { if (scratch != 0xbabe) {
dev_err(udc->isp->dev, dev_err(udc->isp->dev,
...@@ -1429,9 +1499,9 @@ static int isp1760_udc_init(struct isp1760_udc *udc) ...@@ -1429,9 +1499,9 @@ static int isp1760_udc_init(struct isp1760_udc *udc)
} }
/* Reset the device controller. */ /* Reset the device controller. */
isp1760_udc_write(udc, DC_MODE, DC_SFRESET); isp1760_udc_set(udc, DC_SFRESET);
usleep_range(10000, 11000); usleep_range(10000, 11000);
isp1760_udc_write(udc, DC_MODE, 0); isp1760_reg_write(udc->regs, ISP176x_DC_MODE, 0);
usleep_range(10000, 11000); usleep_range(10000, 11000);
return 0; return 0;
...@@ -1445,7 +1515,6 @@ int isp1760_udc_register(struct isp1760_device *isp, int irq, ...@@ -1445,7 +1515,6 @@ int isp1760_udc_register(struct isp1760_device *isp, int irq,
udc->irq = -1; udc->irq = -1;
udc->isp = isp; udc->isp = isp;
udc->regs = isp->regs;
spin_lock_init(&udc->lock); spin_lock_init(&udc->lock);
timer_setup(&udc->vbus_timer, isp1760_udc_vbus_poll, 0); timer_setup(&udc->vbus_timer, isp1760_udc_vbus_poll, 0);
......
drivers/usb/isp1760/isp1760-udc.h
View file @ 1da9e1c0
...@@ -17,6 +17,8 @@ ...@@ -17,6 +17,8 @@
#include <linux/timer.h> #include <linux/timer.h>
#include <linux/usb/gadget.h> #include <linux/usb/gadget.h>
#include "isp1760-regs.h"
struct isp1760_device; struct isp1760_device;
struct isp1760_udc; struct isp1760_udc;
...@@ -48,7 +50,7 @@ struct isp1760_ep { ...@@ -48,7 +50,7 @@ struct isp1760_ep {
* struct isp1760_udc - UDC state information * struct isp1760_udc - UDC state information
* irq: IRQ number * irq: IRQ number
* irqname: IRQ name (as passed to request_irq) * irqname: IRQ name (as passed to request_irq)
* regs: Base address of the UDC registers * regs: regmap for UDC registers
* driver: Gadget driver * driver: Gadget driver
* gadget: Gadget device * gadget: Gadget device
* lock: Protects driver, vbus_timer, ep, ep0_*, DC_EPINDEX register * lock: Protects driver, vbus_timer, ep, ep0_*, DC_EPINDEX register
...@@ -59,12 +61,13 @@ struct isp1760_ep { ...@@ -59,12 +61,13 @@ struct isp1760_ep {
* connected: Tracks gadget driver bus connection state * connected: Tracks gadget driver bus connection state
*/ */
struct isp1760_udc { struct isp1760_udc {
#ifdef CONFIG_USB_ISP1761_UDC
struct isp1760_device *isp; struct isp1760_device *isp;
int irq; int irq;
char *irqname; char *irqname;
void __iomem *regs;
struct regmap *regs;
struct regmap_field *fields[DC_FIELD_MAX];
struct usb_gadget_driver *driver; struct usb_gadget_driver *driver;
struct usb_gadget gadget; struct usb_gadget gadget;
...@@ -81,7 +84,6 @@ struct isp1760_udc { ...@@ -81,7 +84,6 @@ struct isp1760_udc {
bool connected; bool connected;
unsigned int devstatus; unsigned int devstatus;
#endif
}; };
#ifdef CONFIG_USB_ISP1761_UDC #ifdef CONFIG_USB_ISP1761_UDC
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7