mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
385 lines
8.8 KiB
385 lines
8.8 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* Copyright (C) 2010 ST-Ericsson AB |
|
* Mian Yousaf Kaukab <[email protected]> |
|
* |
|
* Based on omap2430.c |
|
*/ |
|
|
|
#include <linux/module.h> |
|
#include <linux/kernel.h> |
|
#include <linux/clk.h> |
|
#include <linux/err.h> |
|
#include <linux/io.h> |
|
#include <linux/of.h> |
|
#include <linux/platform_device.h> |
|
#include <linux/usb/musb-ux500.h> |
|
|
|
#include "musb_core.h" |
|
|
|
static const struct musb_hdrc_config ux500_musb_hdrc_config = { |
|
.multipoint = true, |
|
.dyn_fifo = true, |
|
.num_eps = 16, |
|
.ram_bits = 16, |
|
}; |
|
|
|
struct ux500_glue { |
|
struct device *dev; |
|
struct platform_device *musb; |
|
struct clk *clk; |
|
}; |
|
#define glue_to_musb(g) platform_get_drvdata(g->musb) |
|
|
|
static void ux500_musb_set_vbus(struct musb *musb, int is_on) |
|
{ |
|
u8 devctl; |
|
unsigned long timeout = jiffies + msecs_to_jiffies(1000); |
|
/* HDRC controls CPEN, but beware current surges during device |
|
* connect. They can trigger transient overcurrent conditions |
|
* that must be ignored. |
|
*/ |
|
|
|
devctl = musb_readb(musb->mregs, MUSB_DEVCTL); |
|
|
|
if (is_on) { |
|
if (musb->xceiv->otg->state == OTG_STATE_A_IDLE) { |
|
/* start the session */ |
|
devctl |= MUSB_DEVCTL_SESSION; |
|
musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); |
|
/* |
|
* Wait for the musb to set as A device to enable the |
|
* VBUS |
|
*/ |
|
while (musb_readb(musb->mregs, MUSB_DEVCTL) & 0x80) { |
|
|
|
if (time_after(jiffies, timeout)) { |
|
dev_err(musb->controller, |
|
"configured as A device timeout"); |
|
break; |
|
} |
|
} |
|
|
|
} else { |
|
musb->is_active = 1; |
|
musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE; |
|
devctl |= MUSB_DEVCTL_SESSION; |
|
MUSB_HST_MODE(musb); |
|
} |
|
} else { |
|
musb->is_active = 0; |
|
|
|
/* NOTE: we're skipping A_WAIT_VFALL -> A_IDLE and jumping |
|
* right to B_IDLE... |
|
*/ |
|
devctl &= ~MUSB_DEVCTL_SESSION; |
|
MUSB_DEV_MODE(musb); |
|
} |
|
musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); |
|
|
|
/* |
|
* Devctl values will be updated after vbus goes below |
|
* session_valid. The time taken depends on the capacitance |
|
* on VBUS line. The max discharge time can be upto 1 sec |
|
* as per the spec. Typically on our platform, it is 200ms |
|
*/ |
|
if (!is_on) |
|
mdelay(200); |
|
|
|
dev_dbg(musb->controller, "VBUS %s, devctl %02x\n", |
|
usb_otg_state_string(musb->xceiv->otg->state), |
|
musb_readb(musb->mregs, MUSB_DEVCTL)); |
|
} |
|
|
|
static int musb_otg_notifications(struct notifier_block *nb, |
|
unsigned long event, void *unused) |
|
{ |
|
struct musb *musb = container_of(nb, struct musb, nb); |
|
|
|
dev_dbg(musb->controller, "musb_otg_notifications %ld %s\n", |
|
event, usb_otg_state_string(musb->xceiv->otg->state)); |
|
|
|
switch (event) { |
|
case UX500_MUSB_ID: |
|
dev_dbg(musb->controller, "ID GND\n"); |
|
ux500_musb_set_vbus(musb, 1); |
|
break; |
|
case UX500_MUSB_VBUS: |
|
dev_dbg(musb->controller, "VBUS Connect\n"); |
|
break; |
|
case UX500_MUSB_NONE: |
|
dev_dbg(musb->controller, "VBUS Disconnect\n"); |
|
if (is_host_active(musb)) |
|
ux500_musb_set_vbus(musb, 0); |
|
else |
|
musb->xceiv->otg->state = OTG_STATE_B_IDLE; |
|
break; |
|
default: |
|
dev_dbg(musb->controller, "ID float\n"); |
|
return NOTIFY_DONE; |
|
} |
|
return NOTIFY_OK; |
|
} |
|
|
|
static irqreturn_t ux500_musb_interrupt(int irq, void *__hci) |
|
{ |
|
unsigned long flags; |
|
irqreturn_t retval = IRQ_NONE; |
|
struct musb *musb = __hci; |
|
|
|
spin_lock_irqsave(&musb->lock, flags); |
|
|
|
musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB); |
|
musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX); |
|
musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX); |
|
|
|
if (musb->int_usb || musb->int_tx || musb->int_rx) |
|
retval = musb_interrupt(musb); |
|
|
|
spin_unlock_irqrestore(&musb->lock, flags); |
|
|
|
return retval; |
|
} |
|
|
|
static int ux500_musb_init(struct musb *musb) |
|
{ |
|
int status; |
|
|
|
musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2); |
|
if (IS_ERR_OR_NULL(musb->xceiv)) { |
|
pr_err("HS USB OTG: no transceiver configured\n"); |
|
return -EPROBE_DEFER; |
|
} |
|
|
|
musb->nb.notifier_call = musb_otg_notifications; |
|
status = usb_register_notifier(musb->xceiv, &musb->nb); |
|
if (status < 0) { |
|
dev_dbg(musb->controller, "notification register failed\n"); |
|
return status; |
|
} |
|
|
|
musb->isr = ux500_musb_interrupt; |
|
|
|
return 0; |
|
} |
|
|
|
static int ux500_musb_exit(struct musb *musb) |
|
{ |
|
usb_unregister_notifier(musb->xceiv, &musb->nb); |
|
|
|
usb_put_phy(musb->xceiv); |
|
|
|
return 0; |
|
} |
|
|
|
static const struct musb_platform_ops ux500_ops = { |
|
.quirks = MUSB_DMA_UX500 | MUSB_INDEXED_EP, |
|
#ifdef CONFIG_USB_UX500_DMA |
|
.dma_init = ux500_dma_controller_create, |
|
.dma_exit = ux500_dma_controller_destroy, |
|
#endif |
|
.init = ux500_musb_init, |
|
.exit = ux500_musb_exit, |
|
.fifo_mode = 5, |
|
|
|
.set_vbus = ux500_musb_set_vbus, |
|
}; |
|
|
|
static struct musb_hdrc_platform_data * |
|
ux500_of_probe(struct platform_device *pdev, struct device_node *np) |
|
{ |
|
struct musb_hdrc_platform_data *pdata; |
|
const char *mode; |
|
int strlen; |
|
|
|
pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); |
|
if (!pdata) |
|
return NULL; |
|
|
|
mode = of_get_property(np, "dr_mode", &strlen); |
|
if (!mode) { |
|
dev_err(&pdev->dev, "No 'dr_mode' property found\n"); |
|
return NULL; |
|
} |
|
|
|
if (strlen > 0) { |
|
if (!strcmp(mode, "host")) |
|
pdata->mode = MUSB_HOST; |
|
if (!strcmp(mode, "otg")) |
|
pdata->mode = MUSB_OTG; |
|
if (!strcmp(mode, "peripheral")) |
|
pdata->mode = MUSB_PERIPHERAL; |
|
} |
|
|
|
return pdata; |
|
} |
|
|
|
static int ux500_probe(struct platform_device *pdev) |
|
{ |
|
struct resource musb_resources[2]; |
|
struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev); |
|
struct device_node *np = pdev->dev.of_node; |
|
struct platform_device *musb; |
|
struct ux500_glue *glue; |
|
struct clk *clk; |
|
int ret = -ENOMEM; |
|
|
|
if (!pdata) { |
|
if (np) { |
|
pdata = ux500_of_probe(pdev, np); |
|
if (!pdata) |
|
goto err0; |
|
|
|
pdev->dev.platform_data = pdata; |
|
} else { |
|
dev_err(&pdev->dev, "no pdata or device tree found\n"); |
|
goto err0; |
|
} |
|
} |
|
|
|
glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL); |
|
if (!glue) |
|
goto err0; |
|
|
|
musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO); |
|
if (!musb) { |
|
dev_err(&pdev->dev, "failed to allocate musb device\n"); |
|
goto err0; |
|
} |
|
|
|
clk = devm_clk_get(&pdev->dev, NULL); |
|
if (IS_ERR(clk)) { |
|
dev_err(&pdev->dev, "failed to get clock\n"); |
|
ret = PTR_ERR(clk); |
|
goto err1; |
|
} |
|
|
|
ret = clk_prepare_enable(clk); |
|
if (ret) { |
|
dev_err(&pdev->dev, "failed to enable clock\n"); |
|
goto err1; |
|
} |
|
|
|
musb->dev.parent = &pdev->dev; |
|
musb->dev.dma_mask = &pdev->dev.coherent_dma_mask; |
|
musb->dev.coherent_dma_mask = pdev->dev.coherent_dma_mask; |
|
|
|
glue->dev = &pdev->dev; |
|
glue->musb = musb; |
|
glue->clk = clk; |
|
|
|
pdata->platform_ops = &ux500_ops; |
|
pdata->config = &ux500_musb_hdrc_config; |
|
|
|
platform_set_drvdata(pdev, glue); |
|
|
|
memset(musb_resources, 0x00, sizeof(*musb_resources) * |
|
ARRAY_SIZE(musb_resources)); |
|
|
|
musb_resources[0].name = pdev->resource[0].name; |
|
musb_resources[0].start = pdev->resource[0].start; |
|
musb_resources[0].end = pdev->resource[0].end; |
|
musb_resources[0].flags = pdev->resource[0].flags; |
|
|
|
musb_resources[1].name = pdev->resource[1].name; |
|
musb_resources[1].start = pdev->resource[1].start; |
|
musb_resources[1].end = pdev->resource[1].end; |
|
musb_resources[1].flags = pdev->resource[1].flags; |
|
|
|
ret = platform_device_add_resources(musb, musb_resources, |
|
ARRAY_SIZE(musb_resources)); |
|
if (ret) { |
|
dev_err(&pdev->dev, "failed to add resources\n"); |
|
goto err2; |
|
} |
|
|
|
ret = platform_device_add_data(musb, pdata, sizeof(*pdata)); |
|
if (ret) { |
|
dev_err(&pdev->dev, "failed to add platform_data\n"); |
|
goto err2; |
|
} |
|
|
|
ret = platform_device_add(musb); |
|
if (ret) { |
|
dev_err(&pdev->dev, "failed to register musb device\n"); |
|
goto err2; |
|
} |
|
|
|
return 0; |
|
|
|
err2: |
|
clk_disable_unprepare(clk); |
|
|
|
err1: |
|
platform_device_put(musb); |
|
|
|
err0: |
|
return ret; |
|
} |
|
|
|
static int ux500_remove(struct platform_device *pdev) |
|
{ |
|
struct ux500_glue *glue = platform_get_drvdata(pdev); |
|
|
|
platform_device_unregister(glue->musb); |
|
clk_disable_unprepare(glue->clk); |
|
|
|
return 0; |
|
} |
|
|
|
#ifdef CONFIG_PM_SLEEP |
|
static int ux500_suspend(struct device *dev) |
|
{ |
|
struct ux500_glue *glue = dev_get_drvdata(dev); |
|
struct musb *musb = glue_to_musb(glue); |
|
|
|
if (musb) |
|
usb_phy_set_suspend(musb->xceiv, 1); |
|
|
|
clk_disable_unprepare(glue->clk); |
|
|
|
return 0; |
|
} |
|
|
|
static int ux500_resume(struct device *dev) |
|
{ |
|
struct ux500_glue *glue = dev_get_drvdata(dev); |
|
struct musb *musb = glue_to_musb(glue); |
|
int ret; |
|
|
|
ret = clk_prepare_enable(glue->clk); |
|
if (ret) { |
|
dev_err(dev, "failed to enable clock\n"); |
|
return ret; |
|
} |
|
|
|
if (musb) |
|
usb_phy_set_suspend(musb->xceiv, 0); |
|
|
|
return 0; |
|
} |
|
#endif |
|
|
|
static SIMPLE_DEV_PM_OPS(ux500_pm_ops, ux500_suspend, ux500_resume); |
|
|
|
static const struct of_device_id ux500_match[] = { |
|
{ .compatible = "stericsson,db8500-musb", }, |
|
{} |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(of, ux500_match); |
|
|
|
static struct platform_driver ux500_driver = { |
|
.probe = ux500_probe, |
|
.remove = ux500_remove, |
|
.driver = { |
|
.name = "musb-ux500", |
|
.pm = &ux500_pm_ops, |
|
.of_match_table = ux500_match, |
|
}, |
|
}; |
|
|
|
MODULE_DESCRIPTION("UX500 MUSB Glue Layer"); |
|
MODULE_AUTHOR("Mian Yousaf Kaukab <[email protected]>"); |
|
MODULE_LICENSE("GPL v2"); |
|
module_platform_driver(ux500_driver);
|
|
|