1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Cadence USBSS and USBSSP DRD Driver - host side
  4 *
  5 * Copyright (C) 2018-2019 Cadence Design Systems.
  6 * Copyright (C) 2017-2018 NXP
  7 *
  8 * Authors: Peter Chen <peter.chen@nxp.com>
  9 *          Pawel Laszczak <pawell@cadence.com>
 10 */
 11
 12#include <linux/platform_device.h>
 13#include <linux/slab.h>
 14#include "core.h"
 15#include "drd.h"
 16#include "host-export.h"
 17#include <linux/usb/hcd.h>
 18#include "../host/xhci.h"
 19#include "../host/xhci-plat.h"
 20
 21#define XECP_PORT_CAP_REG	0x8000
 22#define XECP_AUX_CTRL_REG1	0x8120
 23
 24#define CFG_RXDET_P3_EN		BIT(15)
 25#define LPM_2_STB_SWITCH_EN	BIT(25)
 26
 27static void xhci_cdns3_plat_start(struct usb_hcd *hcd)
 28{
 29	struct xhci_hcd *xhci = hcd_to_xhci(hcd);
 30	u32 value;
 31
 32	/* set usbcmd.EU3S */
 33	value = readl(&xhci->op_regs->command);
 34	value |= CMD_PM_INDEX;
 35	writel(value, &xhci->op_regs->command);
 36
 37	if (hcd->regs) {
 38		value = readl(hcd->regs + XECP_AUX_CTRL_REG1);
 39		value |= CFG_RXDET_P3_EN;
 40		writel(value, hcd->regs + XECP_AUX_CTRL_REG1);
 41
 42		value = readl(hcd->regs + XECP_PORT_CAP_REG);
 43		value |= LPM_2_STB_SWITCH_EN;
 44		writel(value, hcd->regs + XECP_PORT_CAP_REG);
 45	}
 46}
 47
 48static int xhci_cdns3_resume_quirk(struct usb_hcd *hcd)
 49{
 50	xhci_cdns3_plat_start(hcd);
 51	return 0;
 52}
 53
 54static const struct xhci_plat_priv xhci_plat_cdns3_xhci = {
 55	.quirks = XHCI_SKIP_PHY_INIT | XHCI_AVOID_BEI,
 56	.plat_start = xhci_cdns3_plat_start,
 57	.resume_quirk = xhci_cdns3_resume_quirk,
 58};
 59
 60static int __cdns_host_init(struct cdns *cdns)
 61{
 62	struct platform_device *xhci;
 63	int ret;
 64	struct usb_hcd *hcd;
 65
 66	cdns_drd_host_on(cdns);
 67
 68	xhci = platform_device_alloc("xhci-hcd", PLATFORM_DEVID_AUTO);
 69	if (!xhci) {
 70		dev_err(cdns->dev, "couldn't allocate xHCI device\n");
 71		return -ENOMEM;
 72	}
 73
 74	xhci->dev.parent = cdns->dev;
 75	cdns->host_dev = xhci;
 76
 77	ret = platform_device_add_resources(xhci, cdns->xhci_res,
 78					    CDNS_XHCI_RESOURCES_NUM);
 79	if (ret) {
 80		dev_err(cdns->dev, "couldn't add resources to xHCI device\n");
 81		goto err1;
 82	}
 83
 84	cdns->xhci_plat_data = kmemdup(&xhci_plat_cdns3_xhci,
 85			sizeof(struct xhci_plat_priv), GFP_KERNEL);
 86	if (!cdns->xhci_plat_data) {
 87		ret = -ENOMEM;
 88		goto err1;
 89	}
 90
 91	if (cdns->pdata && (cdns->pdata->quirks & CDNS3_DEFAULT_PM_RUNTIME_ALLOW))
 92		cdns->xhci_plat_data->quirks |= XHCI_DEFAULT_PM_RUNTIME_ALLOW;
 93
 94	ret = platform_device_add_data(xhci, cdns->xhci_plat_data,
 95			sizeof(struct xhci_plat_priv));
 96	if (ret)
 97		goto free_memory;
 98
 99	ret = platform_device_add(xhci);
100	if (ret) {
101		dev_err(cdns->dev, "failed to register xHCI device\n");
102		goto free_memory;
103	}
104
105	/* Glue needs to access xHCI region register for Power management */
106	hcd = platform_get_drvdata(xhci);
107	if (hcd)
108		cdns->xhci_regs = hcd->regs;
109
110	return 0;
111
112free_memory:
113	kfree(cdns->xhci_plat_data);
114err1:
115	platform_device_put(xhci);
116	return ret;
117}
118
119static void cdns_host_exit(struct cdns *cdns)
120{
121	kfree(cdns->xhci_plat_data);
122	platform_device_unregister(cdns->host_dev);
123	cdns->host_dev = NULL;
124	cdns_drd_host_off(cdns);
125}
126
127int cdns_host_init(struct cdns *cdns)
128{
129	struct cdns_role_driver *rdrv;
130
131	rdrv = devm_kzalloc(cdns->dev, sizeof(*rdrv), GFP_KERNEL);
132	if (!rdrv)
133		return -ENOMEM;
134
135	rdrv->start	= __cdns_host_init;
136	rdrv->stop	= cdns_host_exit;
137	rdrv->state	= CDNS_ROLE_STATE_INACTIVE;
138	rdrv->name	= "host";
139
140	cdns->roles[USB_ROLE_HOST] = rdrv;
141
142	return 0;
143}