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