mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-21 12:36:45 +07:00
cabdf83dad
Platform device is allocated before adding resources. Make sure to
properly cleanup on error case.
Cc: <stable@vger.kernel.org>
Fixes: f1c7e71081 ("usb: dwc3: convert to pcim_enable_device()")
Signed-off-by: Thinh Nguyen <thinhn@synopsys.com>
Signed-off-by: Felipe Balbi <felipe.balbi@linux.intel.com>
386 lines
10 KiB
C
386 lines
10 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/**
|
|
* dwc3-pci.c - PCI Specific glue layer
|
|
*
|
|
* Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com
|
|
*
|
|
* Authors: Felipe Balbi <balbi@ti.com>,
|
|
* Sebastian Andrzej Siewior <bigeasy@linutronix.de>
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/gpio/consumer.h>
|
|
#include <linux/acpi.h>
|
|
#include <linux/delay.h>
|
|
|
|
#define PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3 0xabcd
|
|
#define PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3_AXI 0xabce
|
|
#define PCI_DEVICE_ID_SYNOPSYS_HAPSUSB31 0xabcf
|
|
#define PCI_DEVICE_ID_INTEL_BYT 0x0f37
|
|
#define PCI_DEVICE_ID_INTEL_MRFLD 0x119e
|
|
#define PCI_DEVICE_ID_INTEL_BSW 0x22b7
|
|
#define PCI_DEVICE_ID_INTEL_SPTLP 0x9d30
|
|
#define PCI_DEVICE_ID_INTEL_SPTH 0xa130
|
|
#define PCI_DEVICE_ID_INTEL_BXT 0x0aaa
|
|
#define PCI_DEVICE_ID_INTEL_BXT_M 0x1aaa
|
|
#define PCI_DEVICE_ID_INTEL_APL 0x5aaa
|
|
#define PCI_DEVICE_ID_INTEL_KBP 0xa2b0
|
|
#define PCI_DEVICE_ID_INTEL_GLK 0x31aa
|
|
#define PCI_DEVICE_ID_INTEL_CNPLP 0x9dee
|
|
#define PCI_DEVICE_ID_INTEL_CNPH 0xa36e
|
|
|
|
#define PCI_INTEL_BXT_DSM_GUID "732b85d5-b7a7-4a1b-9ba0-4bbd00ffd511"
|
|
#define PCI_INTEL_BXT_FUNC_PMU_PWR 4
|
|
#define PCI_INTEL_BXT_STATE_D0 0
|
|
#define PCI_INTEL_BXT_STATE_D3 3
|
|
|
|
/**
|
|
* struct dwc3_pci - Driver private structure
|
|
* @dwc3: child dwc3 platform_device
|
|
* @pci: our link to PCI bus
|
|
* @guid: _DSM GUID
|
|
* @has_dsm_for_pm: true for devices which need to run _DSM on runtime PM
|
|
*/
|
|
struct dwc3_pci {
|
|
struct platform_device *dwc3;
|
|
struct pci_dev *pci;
|
|
|
|
guid_t guid;
|
|
|
|
unsigned int has_dsm_for_pm:1;
|
|
struct work_struct wakeup_work;
|
|
};
|
|
|
|
static const struct acpi_gpio_params reset_gpios = { 0, 0, false };
|
|
static const struct acpi_gpio_params cs_gpios = { 1, 0, false };
|
|
|
|
static const struct acpi_gpio_mapping acpi_dwc3_byt_gpios[] = {
|
|
{ "reset-gpios", &reset_gpios, 1 },
|
|
{ "cs-gpios", &cs_gpios, 1 },
|
|
{ },
|
|
};
|
|
|
|
static int dwc3_pci_quirks(struct dwc3_pci *dwc)
|
|
{
|
|
struct platform_device *dwc3 = dwc->dwc3;
|
|
struct pci_dev *pdev = dwc->pci;
|
|
|
|
if (pdev->vendor == PCI_VENDOR_ID_AMD &&
|
|
pdev->device == PCI_DEVICE_ID_AMD_NL_USB) {
|
|
struct property_entry properties[] = {
|
|
PROPERTY_ENTRY_BOOL("snps,has-lpm-erratum"),
|
|
PROPERTY_ENTRY_U8("snps,lpm-nyet-threshold", 0xf),
|
|
PROPERTY_ENTRY_BOOL("snps,u2exit_lfps_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,u2ss_inp3_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,req_p1p2p3_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,del_p1p2p3_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,del_phy_power_chg_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,lfps_filter_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,rx_detect_poll_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,tx_de_emphasis_quirk"),
|
|
PROPERTY_ENTRY_U8("snps,tx_de_emphasis", 1),
|
|
/*
|
|
* FIXME these quirks should be removed when AMD NL
|
|
* tapes out
|
|
*/
|
|
PROPERTY_ENTRY_BOOL("snps,disable_scramble_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,dis_u3_susphy_quirk"),
|
|
PROPERTY_ENTRY_BOOL("snps,dis_u2_susphy_quirk"),
|
|
PROPERTY_ENTRY_BOOL("linux,sysdev_is_parent"),
|
|
{ },
|
|
};
|
|
|
|
return platform_device_add_properties(dwc3, properties);
|
|
}
|
|
|
|
if (pdev->vendor == PCI_VENDOR_ID_INTEL) {
|
|
int ret;
|
|
|
|
struct property_entry properties[] = {
|
|
PROPERTY_ENTRY_STRING("dr_mode", "peripheral"),
|
|
PROPERTY_ENTRY_BOOL("linux,sysdev_is_parent"),
|
|
{ }
|
|
};
|
|
|
|
ret = platform_device_add_properties(dwc3, properties);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (pdev->device == PCI_DEVICE_ID_INTEL_BXT ||
|
|
pdev->device == PCI_DEVICE_ID_INTEL_BXT_M) {
|
|
guid_parse(PCI_INTEL_BXT_DSM_GUID, &dwc->guid);
|
|
dwc->has_dsm_for_pm = true;
|
|
}
|
|
|
|
if (pdev->device == PCI_DEVICE_ID_INTEL_BYT) {
|
|
struct gpio_desc *gpio;
|
|
|
|
ret = devm_acpi_dev_add_driver_gpios(&pdev->dev,
|
|
acpi_dwc3_byt_gpios);
|
|
if (ret)
|
|
dev_dbg(&pdev->dev, "failed to add mapping table\n");
|
|
|
|
/*
|
|
* These GPIOs will turn on the USB2 PHY. Note that we have to
|
|
* put the gpio descriptors again here because the phy driver
|
|
* might want to grab them, too.
|
|
*/
|
|
gpio = gpiod_get_optional(&pdev->dev, "cs", GPIOD_OUT_LOW);
|
|
if (IS_ERR(gpio))
|
|
return PTR_ERR(gpio);
|
|
|
|
gpiod_set_value_cansleep(gpio, 1);
|
|
gpiod_put(gpio);
|
|
|
|
gpio = gpiod_get_optional(&pdev->dev, "reset", GPIOD_OUT_LOW);
|
|
if (IS_ERR(gpio))
|
|
return PTR_ERR(gpio);
|
|
|
|
if (gpio) {
|
|
gpiod_set_value_cansleep(gpio, 1);
|
|
gpiod_put(gpio);
|
|
usleep_range(10000, 11000);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (pdev->vendor == PCI_VENDOR_ID_SYNOPSYS &&
|
|
(pdev->device == PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3 ||
|
|
pdev->device == PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3_AXI ||
|
|
pdev->device == PCI_DEVICE_ID_SYNOPSYS_HAPSUSB31)) {
|
|
struct property_entry properties[] = {
|
|
PROPERTY_ENTRY_BOOL("snps,usb3_lpm_capable"),
|
|
PROPERTY_ENTRY_BOOL("snps,has-lpm-erratum"),
|
|
PROPERTY_ENTRY_BOOL("snps,dis_enblslpm_quirk"),
|
|
PROPERTY_ENTRY_BOOL("linux,sysdev_is_parent"),
|
|
{ },
|
|
};
|
|
|
|
return platform_device_add_properties(dwc3, properties);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static void dwc3_pci_resume_work(struct work_struct *work)
|
|
{
|
|
struct dwc3_pci *dwc = container_of(work, struct dwc3_pci, wakeup_work);
|
|
struct platform_device *dwc3 = dwc->dwc3;
|
|
int ret;
|
|
|
|
ret = pm_runtime_get_sync(&dwc3->dev);
|
|
if (ret)
|
|
return;
|
|
|
|
pm_runtime_mark_last_busy(&dwc3->dev);
|
|
pm_runtime_put_sync_autosuspend(&dwc3->dev);
|
|
}
|
|
#endif
|
|
|
|
static int dwc3_pci_probe(struct pci_dev *pci,
|
|
const struct pci_device_id *id)
|
|
{
|
|
struct dwc3_pci *dwc;
|
|
struct resource res[2];
|
|
int ret;
|
|
struct device *dev = &pci->dev;
|
|
|
|
ret = pcim_enable_device(pci);
|
|
if (ret) {
|
|
dev_err(dev, "failed to enable pci device\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
pci_set_master(pci);
|
|
|
|
dwc = devm_kzalloc(dev, sizeof(*dwc), GFP_KERNEL);
|
|
if (!dwc)
|
|
return -ENOMEM;
|
|
|
|
dwc->dwc3 = platform_device_alloc("dwc3", PLATFORM_DEVID_AUTO);
|
|
if (!dwc->dwc3)
|
|
return -ENOMEM;
|
|
|
|
memset(res, 0x00, sizeof(struct resource) * ARRAY_SIZE(res));
|
|
|
|
res[0].start = pci_resource_start(pci, 0);
|
|
res[0].end = pci_resource_end(pci, 0);
|
|
res[0].name = "dwc_usb3";
|
|
res[0].flags = IORESOURCE_MEM;
|
|
|
|
res[1].start = pci->irq;
|
|
res[1].name = "dwc_usb3";
|
|
res[1].flags = IORESOURCE_IRQ;
|
|
|
|
ret = platform_device_add_resources(dwc->dwc3, res, ARRAY_SIZE(res));
|
|
if (ret) {
|
|
dev_err(dev, "couldn't add resources to dwc3 device\n");
|
|
goto err;
|
|
}
|
|
|
|
dwc->pci = pci;
|
|
dwc->dwc3->dev.parent = dev;
|
|
ACPI_COMPANION_SET(&dwc->dwc3->dev, ACPI_COMPANION(dev));
|
|
|
|
ret = dwc3_pci_quirks(dwc);
|
|
if (ret)
|
|
goto err;
|
|
|
|
ret = platform_device_add(dwc->dwc3);
|
|
if (ret) {
|
|
dev_err(dev, "failed to register dwc3 device\n");
|
|
goto err;
|
|
}
|
|
|
|
device_init_wakeup(dev, true);
|
|
pci_set_drvdata(pci, dwc);
|
|
pm_runtime_put(dev);
|
|
#ifdef CONFIG_PM
|
|
INIT_WORK(&dwc->wakeup_work, dwc3_pci_resume_work);
|
|
#endif
|
|
|
|
return 0;
|
|
err:
|
|
platform_device_put(dwc->dwc3);
|
|
return ret;
|
|
}
|
|
|
|
static void dwc3_pci_remove(struct pci_dev *pci)
|
|
{
|
|
struct dwc3_pci *dwc = pci_get_drvdata(pci);
|
|
|
|
#ifdef CONFIG_PM
|
|
cancel_work_sync(&dwc->wakeup_work);
|
|
#endif
|
|
device_init_wakeup(&pci->dev, false);
|
|
pm_runtime_get(&pci->dev);
|
|
platform_device_unregister(dwc->dwc3);
|
|
}
|
|
|
|
static const struct pci_device_id dwc3_pci_id_table[] = {
|
|
{
|
|
PCI_DEVICE(PCI_VENDOR_ID_SYNOPSYS,
|
|
PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3),
|
|
},
|
|
{
|
|
PCI_DEVICE(PCI_VENDOR_ID_SYNOPSYS,
|
|
PCI_DEVICE_ID_SYNOPSYS_HAPSUSB3_AXI),
|
|
},
|
|
{
|
|
PCI_DEVICE(PCI_VENDOR_ID_SYNOPSYS,
|
|
PCI_DEVICE_ID_SYNOPSYS_HAPSUSB31),
|
|
},
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_BSW), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_BYT), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_MRFLD), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_SPTLP), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_SPTH), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_BXT), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_BXT_M), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_APL), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_KBP), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_GLK), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_CNPLP), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_CNPH), },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_NL_USB), },
|
|
{ } /* Terminating Entry */
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, dwc3_pci_id_table);
|
|
|
|
#if defined(CONFIG_PM) || defined(CONFIG_PM_SLEEP)
|
|
static int dwc3_pci_dsm(struct dwc3_pci *dwc, int param)
|
|
{
|
|
union acpi_object *obj;
|
|
union acpi_object tmp;
|
|
union acpi_object argv4 = ACPI_INIT_DSM_ARGV4(1, &tmp);
|
|
|
|
if (!dwc->has_dsm_for_pm)
|
|
return 0;
|
|
|
|
tmp.type = ACPI_TYPE_INTEGER;
|
|
tmp.integer.value = param;
|
|
|
|
obj = acpi_evaluate_dsm(ACPI_HANDLE(&dwc->pci->dev), &dwc->guid,
|
|
1, PCI_INTEL_BXT_FUNC_PMU_PWR, &argv4);
|
|
if (!obj) {
|
|
dev_err(&dwc->pci->dev, "failed to evaluate _DSM\n");
|
|
return -EIO;
|
|
}
|
|
|
|
ACPI_FREE(obj);
|
|
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_PM || CONFIG_PM_SLEEP */
|
|
|
|
#ifdef CONFIG_PM
|
|
static int dwc3_pci_runtime_suspend(struct device *dev)
|
|
{
|
|
struct dwc3_pci *dwc = dev_get_drvdata(dev);
|
|
|
|
if (device_can_wakeup(dev))
|
|
return dwc3_pci_dsm(dwc, PCI_INTEL_BXT_STATE_D3);
|
|
|
|
return -EBUSY;
|
|
}
|
|
|
|
static int dwc3_pci_runtime_resume(struct device *dev)
|
|
{
|
|
struct dwc3_pci *dwc = dev_get_drvdata(dev);
|
|
int ret;
|
|
|
|
ret = dwc3_pci_dsm(dwc, PCI_INTEL_BXT_STATE_D0);
|
|
if (ret)
|
|
return ret;
|
|
|
|
queue_work(pm_wq, &dwc->wakeup_work);
|
|
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_PM */
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
static int dwc3_pci_suspend(struct device *dev)
|
|
{
|
|
struct dwc3_pci *dwc = dev_get_drvdata(dev);
|
|
|
|
return dwc3_pci_dsm(dwc, PCI_INTEL_BXT_STATE_D3);
|
|
}
|
|
|
|
static int dwc3_pci_resume(struct device *dev)
|
|
{
|
|
struct dwc3_pci *dwc = dev_get_drvdata(dev);
|
|
|
|
return dwc3_pci_dsm(dwc, PCI_INTEL_BXT_STATE_D0);
|
|
}
|
|
#endif /* CONFIG_PM_SLEEP */
|
|
|
|
static const struct dev_pm_ops dwc3_pci_dev_pm_ops = {
|
|
SET_SYSTEM_SLEEP_PM_OPS(dwc3_pci_suspend, dwc3_pci_resume)
|
|
SET_RUNTIME_PM_OPS(dwc3_pci_runtime_suspend, dwc3_pci_runtime_resume,
|
|
NULL)
|
|
};
|
|
|
|
static struct pci_driver dwc3_pci_driver = {
|
|
.name = "dwc3-pci",
|
|
.id_table = dwc3_pci_id_table,
|
|
.probe = dwc3_pci_probe,
|
|
.remove = dwc3_pci_remove,
|
|
.driver = {
|
|
.pm = &dwc3_pci_dev_pm_ops,
|
|
}
|
|
};
|
|
|
|
MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_DESCRIPTION("DesignWare USB3 PCI Glue Layer");
|
|
|
|
module_pci_driver(dwc3_pci_driver);
|