1fa31b3cbSHans de Goede // SPDX-License-Identifier: GPL-2.0
2fa31b3cbSHans de Goede /*
3fa31b3cbSHans de Goede * XHCI extended capability handling
4fa31b3cbSHans de Goede *
5fa31b3cbSHans de Goede * Copyright (c) 2017 Hans de Goede <hdegoede@redhat.com>
6fa31b3cbSHans de Goede */
7fa31b3cbSHans de Goede
8fa31b3cbSHans de Goede #include <linux/platform_device.h>
96ed151f2SSaranya Gopal #include <linux/property.h>
106ed151f2SSaranya Gopal #include <linux/pci.h>
11fa31b3cbSHans de Goede #include "xhci.h"
12fa31b3cbSHans de Goede
13fa31b3cbSHans de Goede #define USB_SW_DRV_NAME "intel_xhci_usb_sw"
14fa31b3cbSHans de Goede #define USB_SW_RESOURCE_SIZE 0x400
15fa31b3cbSHans de Goede
166ed151f2SSaranya Gopal #define PCI_DEVICE_ID_INTEL_CHERRYVIEW_XHCI 0x22b5
176ed151f2SSaranya Gopal
186ed151f2SSaranya Gopal static const struct property_entry role_switch_props[] = {
196ed151f2SSaranya Gopal PROPERTY_ENTRY_BOOL("sw_switch_disable"),
206ed151f2SSaranya Gopal {},
216ed151f2SSaranya Gopal };
226ed151f2SSaranya Gopal
xhci_intel_unregister_pdev(void * arg)23fa31b3cbSHans de Goede static void xhci_intel_unregister_pdev(void *arg)
24fa31b3cbSHans de Goede {
25fa31b3cbSHans de Goede platform_device_unregister(arg);
26fa31b3cbSHans de Goede }
27fa31b3cbSHans de Goede
xhci_create_intel_xhci_sw_pdev(struct xhci_hcd * xhci,u32 cap_offset)28fa31b3cbSHans de Goede static int xhci_create_intel_xhci_sw_pdev(struct xhci_hcd *xhci, u32 cap_offset)
29fa31b3cbSHans de Goede {
30fa31b3cbSHans de Goede struct usb_hcd *hcd = xhci_to_hcd(xhci);
31fa31b3cbSHans de Goede struct device *dev = hcd->self.controller;
32fa31b3cbSHans de Goede struct platform_device *pdev;
336ed151f2SSaranya Gopal struct pci_dev *pci = to_pci_dev(dev);
34fa31b3cbSHans de Goede struct resource res = { 0, };
35fa31b3cbSHans de Goede int ret;
36fa31b3cbSHans de Goede
37fa31b3cbSHans de Goede pdev = platform_device_alloc(USB_SW_DRV_NAME, PLATFORM_DEVID_NONE);
38fa31b3cbSHans de Goede if (!pdev) {
39fa31b3cbSHans de Goede xhci_err(xhci, "couldn't allocate %s platform device\n",
40fa31b3cbSHans de Goede USB_SW_DRV_NAME);
41fa31b3cbSHans de Goede return -ENOMEM;
42fa31b3cbSHans de Goede }
43fa31b3cbSHans de Goede
44fa31b3cbSHans de Goede res.start = hcd->rsrc_start + cap_offset;
45fa31b3cbSHans de Goede res.end = res.start + USB_SW_RESOURCE_SIZE - 1;
46fa31b3cbSHans de Goede res.name = USB_SW_DRV_NAME;
47fa31b3cbSHans de Goede res.flags = IORESOURCE_MEM;
48fa31b3cbSHans de Goede
49fa31b3cbSHans de Goede ret = platform_device_add_resources(pdev, &res, 1);
50fa31b3cbSHans de Goede if (ret) {
51fa31b3cbSHans de Goede dev_err(dev, "couldn't add resources to intel_xhci_usb_sw pdev\n");
52fa31b3cbSHans de Goede platform_device_put(pdev);
53fa31b3cbSHans de Goede return ret;
54fa31b3cbSHans de Goede }
55fa31b3cbSHans de Goede
566ed151f2SSaranya Gopal if (pci->device == PCI_DEVICE_ID_INTEL_CHERRYVIEW_XHCI) {
57*c8134c00SHeikki Krogerus ret = device_create_managed_software_node(&pdev->dev, role_switch_props,
58*c8134c00SHeikki Krogerus NULL);
596ed151f2SSaranya Gopal if (ret) {
606ed151f2SSaranya Gopal dev_err(dev, "failed to register device properties\n");
61ee4155f4SWei Yongjun platform_device_put(pdev);
626ed151f2SSaranya Gopal return ret;
636ed151f2SSaranya Gopal }
646ed151f2SSaranya Gopal }
656ed151f2SSaranya Gopal
66fa31b3cbSHans de Goede pdev->dev.parent = dev;
67fa31b3cbSHans de Goede
68fa31b3cbSHans de Goede ret = platform_device_add(pdev);
69fa31b3cbSHans de Goede if (ret) {
70fa31b3cbSHans de Goede dev_err(dev, "couldn't register intel_xhci_usb_sw pdev\n");
71fa31b3cbSHans de Goede platform_device_put(pdev);
72fa31b3cbSHans de Goede return ret;
73fa31b3cbSHans de Goede }
74fa31b3cbSHans de Goede
75fa31b3cbSHans de Goede ret = devm_add_action_or_reset(dev, xhci_intel_unregister_pdev, pdev);
76fa31b3cbSHans de Goede if (ret) {
77fa31b3cbSHans de Goede dev_err(dev, "couldn't add unregister action for intel_xhci_usb_sw pdev\n");
78fa31b3cbSHans de Goede return ret;
79fa31b3cbSHans de Goede }
80fa31b3cbSHans de Goede
81fa31b3cbSHans de Goede return 0;
82fa31b3cbSHans de Goede }
83fa31b3cbSHans de Goede
xhci_ext_cap_init(struct xhci_hcd * xhci)84fa31b3cbSHans de Goede int xhci_ext_cap_init(struct xhci_hcd *xhci)
85fa31b3cbSHans de Goede {
86fa31b3cbSHans de Goede void __iomem *base = &xhci->cap_regs->hc_capbase;
87fa31b3cbSHans de Goede u32 offset, val;
88fa31b3cbSHans de Goede int ret;
89fa31b3cbSHans de Goede
90fa31b3cbSHans de Goede offset = xhci_find_next_ext_cap(base, 0, 0);
91fa31b3cbSHans de Goede
92fa31b3cbSHans de Goede while (offset) {
93fa31b3cbSHans de Goede val = readl(base + offset);
94fa31b3cbSHans de Goede
95fa31b3cbSHans de Goede switch (XHCI_EXT_CAPS_ID(val)) {
96fa31b3cbSHans de Goede case XHCI_EXT_CAPS_VENDOR_INTEL:
97fa31b3cbSHans de Goede if (xhci->quirks & XHCI_INTEL_USB_ROLE_SW) {
98fa31b3cbSHans de Goede ret = xhci_create_intel_xhci_sw_pdev(xhci,
99fa31b3cbSHans de Goede offset);
100fa31b3cbSHans de Goede if (ret)
101fa31b3cbSHans de Goede return ret;
102fa31b3cbSHans de Goede }
103fa31b3cbSHans de Goede break;
104fa31b3cbSHans de Goede }
105fa31b3cbSHans de Goede offset = xhci_find_next_ext_cap(base, offset, 0);
106fa31b3cbSHans de Goede }
107fa31b3cbSHans de Goede
108fa31b3cbSHans de Goede return 0;
109fa31b3cbSHans de Goede }
110fa31b3cbSHans de Goede EXPORT_SYMBOL_GPL(xhci_ext_cap_init);
111