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 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 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) { 576ed151f2SSaranya Gopal ret = platform_device_add_properties(pdev, role_switch_props); 586ed151f2SSaranya Gopal if (ret) { 596ed151f2SSaranya Gopal dev_err(dev, "failed to register device properties\n"); 60ee4155f4SWei Yongjun platform_device_put(pdev); 616ed151f2SSaranya Gopal return ret; 626ed151f2SSaranya Gopal } 636ed151f2SSaranya Gopal } 646ed151f2SSaranya Gopal 65fa31b3cbSHans de Goede pdev->dev.parent = dev; 66fa31b3cbSHans de Goede 67fa31b3cbSHans de Goede ret = platform_device_add(pdev); 68fa31b3cbSHans de Goede if (ret) { 69fa31b3cbSHans de Goede dev_err(dev, "couldn't register intel_xhci_usb_sw pdev\n"); 70fa31b3cbSHans de Goede platform_device_put(pdev); 71fa31b3cbSHans de Goede return ret; 72fa31b3cbSHans de Goede } 73fa31b3cbSHans de Goede 74fa31b3cbSHans de Goede ret = devm_add_action_or_reset(dev, xhci_intel_unregister_pdev, pdev); 75fa31b3cbSHans de Goede if (ret) { 76fa31b3cbSHans de Goede dev_err(dev, "couldn't add unregister action for intel_xhci_usb_sw pdev\n"); 77fa31b3cbSHans de Goede return ret; 78fa31b3cbSHans de Goede } 79fa31b3cbSHans de Goede 80fa31b3cbSHans de Goede return 0; 81fa31b3cbSHans de Goede } 82fa31b3cbSHans de Goede 83fa31b3cbSHans de Goede int xhci_ext_cap_init(struct xhci_hcd *xhci) 84fa31b3cbSHans de Goede { 85fa31b3cbSHans de Goede void __iomem *base = &xhci->cap_regs->hc_capbase; 86fa31b3cbSHans de Goede u32 offset, val; 87fa31b3cbSHans de Goede int ret; 88fa31b3cbSHans de Goede 89fa31b3cbSHans de Goede offset = xhci_find_next_ext_cap(base, 0, 0); 90fa31b3cbSHans de Goede 91fa31b3cbSHans de Goede while (offset) { 92fa31b3cbSHans de Goede val = readl(base + offset); 93fa31b3cbSHans de Goede 94fa31b3cbSHans de Goede switch (XHCI_EXT_CAPS_ID(val)) { 95fa31b3cbSHans de Goede case XHCI_EXT_CAPS_VENDOR_INTEL: 96fa31b3cbSHans de Goede if (xhci->quirks & XHCI_INTEL_USB_ROLE_SW) { 97fa31b3cbSHans de Goede ret = xhci_create_intel_xhci_sw_pdev(xhci, 98fa31b3cbSHans de Goede offset); 99fa31b3cbSHans de Goede if (ret) 100fa31b3cbSHans de Goede return ret; 101fa31b3cbSHans de Goede } 102fa31b3cbSHans de Goede break; 103fa31b3cbSHans de Goede } 104fa31b3cbSHans de Goede offset = xhci_find_next_ext_cap(base, offset, 0); 105fa31b3cbSHans de Goede } 106fa31b3cbSHans de Goede 107fa31b3cbSHans de Goede return 0; 108fa31b3cbSHans de Goede } 109fa31b3cbSHans de Goede EXPORT_SYMBOL_GPL(xhci_ext_cap_init); 110