forked from Minki/linux
448373d9db
Some platforms (e.g. TI) will not have any platform data which will
lead to NULL pointer dereference if we don't check for NULL pdata.
Fixes: 7cea965775 ("usb: cdns3: add quirk for enable runtime pm by default")
Reported-by: Nishanth Menon <nm@ti.com>
Signed-off-by: Roger Quadros <rogerq@ti.com>
Acked-by: Pawel Laszczak <pawell@cadence.com>
Signed-off-by: Peter Chen <peter.chen@nxp.com>
141 lines
3.1 KiB
C
141 lines
3.1 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Cadence USBSS DRD Driver - host side
|
|
*
|
|
* Copyright (C) 2018-2019 Cadence Design Systems.
|
|
* Copyright (C) 2017-2018 NXP
|
|
*
|
|
* Authors: Peter Chen <peter.chen@nxp.com>
|
|
* Pawel Laszczak <pawell@cadence.com>
|
|
*/
|
|
|
|
#include <linux/platform_device.h>
|
|
#include "core.h"
|
|
#include "drd.h"
|
|
#include "host-export.h"
|
|
#include <linux/usb/hcd.h>
|
|
#include "../host/xhci.h"
|
|
#include "../host/xhci-plat.h"
|
|
|
|
#define XECP_PORT_CAP_REG 0x8000
|
|
#define XECP_AUX_CTRL_REG1 0x8120
|
|
|
|
#define CFG_RXDET_P3_EN BIT(15)
|
|
#define LPM_2_STB_SWITCH_EN BIT(25)
|
|
|
|
static const struct xhci_plat_priv xhci_plat_cdns3_xhci = {
|
|
.quirks = XHCI_SKIP_PHY_INIT | XHCI_AVOID_BEI,
|
|
.suspend_quirk = xhci_cdns3_suspend_quirk,
|
|
};
|
|
|
|
static int __cdns3_host_init(struct cdns3 *cdns)
|
|
{
|
|
struct platform_device *xhci;
|
|
int ret;
|
|
struct usb_hcd *hcd;
|
|
|
|
cdns3_drd_host_on(cdns);
|
|
|
|
xhci = platform_device_alloc("xhci-hcd", PLATFORM_DEVID_AUTO);
|
|
if (!xhci) {
|
|
dev_err(cdns->dev, "couldn't allocate xHCI device\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
xhci->dev.parent = cdns->dev;
|
|
cdns->host_dev = xhci;
|
|
|
|
ret = platform_device_add_resources(xhci, cdns->xhci_res,
|
|
CDNS3_XHCI_RESOURCES_NUM);
|
|
if (ret) {
|
|
dev_err(cdns->dev, "couldn't add resources to xHCI device\n");
|
|
goto err1;
|
|
}
|
|
|
|
cdns->xhci_plat_data = kmemdup(&xhci_plat_cdns3_xhci,
|
|
sizeof(struct xhci_plat_priv), GFP_KERNEL);
|
|
if (!cdns->xhci_plat_data) {
|
|
ret = -ENOMEM;
|
|
goto err1;
|
|
}
|
|
|
|
if (cdns->pdata && (cdns->pdata->quirks & CDNS3_DEFAULT_PM_RUNTIME_ALLOW))
|
|
cdns->xhci_plat_data->quirks |= XHCI_DEFAULT_PM_RUNTIME_ALLOW;
|
|
|
|
ret = platform_device_add_data(xhci, cdns->xhci_plat_data,
|
|
sizeof(struct xhci_plat_priv));
|
|
if (ret)
|
|
goto free_memory;
|
|
|
|
ret = platform_device_add(xhci);
|
|
if (ret) {
|
|
dev_err(cdns->dev, "failed to register xHCI device\n");
|
|
goto free_memory;
|
|
}
|
|
|
|
/* Glue needs to access xHCI region register for Power management */
|
|
hcd = platform_get_drvdata(xhci);
|
|
if (hcd)
|
|
cdns->xhci_regs = hcd->regs;
|
|
|
|
return 0;
|
|
|
|
free_memory:
|
|
kfree(cdns->xhci_plat_data);
|
|
err1:
|
|
platform_device_put(xhci);
|
|
return ret;
|
|
}
|
|
|
|
int xhci_cdns3_suspend_quirk(struct usb_hcd *hcd)
|
|
{
|
|
struct xhci_hcd *xhci = hcd_to_xhci(hcd);
|
|
u32 value;
|
|
|
|
if (pm_runtime_status_suspended(hcd->self.controller))
|
|
return 0;
|
|
|
|
/* set usbcmd.EU3S */
|
|
value = readl(&xhci->op_regs->command);
|
|
value |= CMD_PM_INDEX;
|
|
writel(value, &xhci->op_regs->command);
|
|
|
|
if (hcd->regs) {
|
|
value = readl(hcd->regs + XECP_AUX_CTRL_REG1);
|
|
value |= CFG_RXDET_P3_EN;
|
|
writel(value, hcd->regs + XECP_AUX_CTRL_REG1);
|
|
|
|
value = readl(hcd->regs + XECP_PORT_CAP_REG);
|
|
value |= LPM_2_STB_SWITCH_EN;
|
|
writel(value, hcd->regs + XECP_PORT_CAP_REG);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void cdns3_host_exit(struct cdns3 *cdns)
|
|
{
|
|
kfree(cdns->xhci_plat_data);
|
|
platform_device_unregister(cdns->host_dev);
|
|
cdns->host_dev = NULL;
|
|
cdns3_drd_host_off(cdns);
|
|
}
|
|
|
|
int cdns3_host_init(struct cdns3 *cdns)
|
|
{
|
|
struct cdns3_role_driver *rdrv;
|
|
|
|
rdrv = devm_kzalloc(cdns->dev, sizeof(*rdrv), GFP_KERNEL);
|
|
if (!rdrv)
|
|
return -ENOMEM;
|
|
|
|
rdrv->start = __cdns3_host_init;
|
|
rdrv->stop = cdns3_host_exit;
|
|
rdrv->state = CDNS3_ROLE_STATE_INACTIVE;
|
|
rdrv->name = "host";
|
|
|
|
cdns->roles[USB_ROLE_HOST] = rdrv;
|
|
|
|
return 0;
|
|
}
|