platform/x86: intel_pmc_ipc: Use devm_* calls in driver probe function
This patch cleans up unnecessary free/alloc calls in ipc_plat_probe(), ipc_pci_probe() and ipc_plat_get_res() functions by using devm_* calls. This patch also adds proper error handling for failure cases in ipc_pci_probe() function. Signed-off-by: Kuppuswamy Sathyanarayanan <sathyanarayanan.kuppuswamy@linux.intel.com> [andy: fixed style issues, missed devm_free_irq(), removed unnecessary log message] Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
This commit is contained in:
parent
dda3ec0aa6
commit
d7ca5ebf24
@ -480,52 +480,39 @@ static irqreturn_t ioc(int irq, void *dev_id)
|
|||||||
|
|
||||||
static int ipc_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
|
static int ipc_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
|
||||||
{
|
{
|
||||||
resource_size_t pci_resource;
|
struct intel_pmc_ipc_dev *pmc = &ipcdev;
|
||||||
int ret;
|
int ret;
|
||||||
int len;
|
|
||||||
|
|
||||||
ipcdev.dev = &pci_dev_get(pdev)->dev;
|
/* Only one PMC is supported */
|
||||||
ipcdev.irq_mode = IPC_TRIGGER_MODE_IRQ;
|
if (pmc->dev)
|
||||||
|
|
||||||
ret = pci_enable_device(pdev);
|
|
||||||
if (ret)
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
ret = pci_request_regions(pdev, "intel_pmc_ipc");
|
|
||||||
if (ret)
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
pci_resource = pci_resource_start(pdev, 0);
|
|
||||||
len = pci_resource_len(pdev, 0);
|
|
||||||
if (!pci_resource || !len) {
|
|
||||||
dev_err(&pdev->dev, "Failed to get resource\n");
|
|
||||||
return -ENOMEM;
|
|
||||||
}
|
|
||||||
|
|
||||||
init_completion(&ipcdev.cmd_complete);
|
|
||||||
|
|
||||||
if (request_irq(pdev->irq, ioc, 0, "intel_pmc_ipc", &ipcdev)) {
|
|
||||||
dev_err(&pdev->dev, "Failed to request irq\n");
|
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
|
|
||||||
|
pmc->irq_mode = IPC_TRIGGER_MODE_IRQ;
|
||||||
|
|
||||||
|
ret = pcim_enable_device(pdev);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
ret = pcim_iomap_regions(pdev, 1 << 0, pci_name(pdev));
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
init_completion(&pmc->cmd_complete);
|
||||||
|
|
||||||
|
pmc->ipc_base = pcim_iomap_table(pdev)[0];
|
||||||
|
|
||||||
|
ret = devm_request_irq(&pdev->dev, pdev->irq, ioc, 0, "intel_pmc_ipc",
|
||||||
|
pmc);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(&pdev->dev, "Failed to request irq\n");
|
||||||
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
ipcdev.ipc_base = ioremap_nocache(pci_resource, len);
|
pmc->dev = &pdev->dev;
|
||||||
if (!ipcdev.ipc_base) {
|
|
||||||
dev_err(&pdev->dev, "Failed to ioremap ipc base\n");
|
|
||||||
free_irq(pdev->irq, &ipcdev);
|
|
||||||
ret = -ENOMEM;
|
|
||||||
}
|
|
||||||
|
|
||||||
return ret;
|
pci_set_drvdata(pdev, pmc);
|
||||||
}
|
|
||||||
|
|
||||||
static void ipc_pci_remove(struct pci_dev *pdev)
|
return 0;
|
||||||
{
|
|
||||||
free_irq(pdev->irq, &ipcdev);
|
|
||||||
pci_release_regions(pdev);
|
|
||||||
pci_dev_put(pdev);
|
|
||||||
iounmap(ipcdev.ipc_base);
|
|
||||||
ipcdev.dev = NULL;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static const struct pci_device_id ipc_pci_ids[] = {
|
static const struct pci_device_id ipc_pci_ids[] = {
|
||||||
@ -540,7 +527,6 @@ static struct pci_driver ipc_pci_driver = {
|
|||||||
.name = "intel_pmc_ipc",
|
.name = "intel_pmc_ipc",
|
||||||
.id_table = ipc_pci_ids,
|
.id_table = ipc_pci_ids,
|
||||||
.probe = ipc_pci_probe,
|
.probe = ipc_pci_probe,
|
||||||
.remove = ipc_pci_remove,
|
|
||||||
};
|
};
|
||||||
|
|
||||||
static ssize_t intel_pmc_ipc_simple_cmd_store(struct device *dev,
|
static ssize_t intel_pmc_ipc_simple_cmd_store(struct device *dev,
|
||||||
@ -850,17 +836,12 @@ static int ipc_plat_get_res(struct platform_device *pdev)
|
|||||||
return -ENXIO;
|
return -ENXIO;
|
||||||
}
|
}
|
||||||
size = PLAT_RESOURCE_IPC_SIZE + PLAT_RESOURCE_GCR_SIZE;
|
size = PLAT_RESOURCE_IPC_SIZE + PLAT_RESOURCE_GCR_SIZE;
|
||||||
|
res->end = res->start + size - 1;
|
||||||
|
|
||||||
|
addr = devm_ioremap_resource(&pdev->dev, res);
|
||||||
|
if (IS_ERR(addr))
|
||||||
|
return PTR_ERR(addr);
|
||||||
|
|
||||||
if (!request_mem_region(res->start, size, pdev->name)) {
|
|
||||||
dev_err(&pdev->dev, "Failed to request ipc resource\n");
|
|
||||||
return -EBUSY;
|
|
||||||
}
|
|
||||||
addr = ioremap_nocache(res->start, size);
|
|
||||||
if (!addr) {
|
|
||||||
dev_err(&pdev->dev, "I/O memory remapping failed\n");
|
|
||||||
release_mem_region(res->start, size);
|
|
||||||
return -ENOMEM;
|
|
||||||
}
|
|
||||||
ipcdev.ipc_base = addr;
|
ipcdev.ipc_base = addr;
|
||||||
|
|
||||||
ipcdev.gcr_mem_base = addr + PLAT_RESOURCE_GCR_OFFSET;
|
ipcdev.gcr_mem_base = addr + PLAT_RESOURCE_GCR_OFFSET;
|
||||||
@ -917,7 +898,6 @@ MODULE_DEVICE_TABLE(acpi, ipc_acpi_ids);
|
|||||||
|
|
||||||
static int ipc_plat_probe(struct platform_device *pdev)
|
static int ipc_plat_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct resource *res;
|
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
ipcdev.dev = &pdev->dev;
|
ipcdev.dev = &pdev->dev;
|
||||||
@ -939,11 +919,11 @@ static int ipc_plat_probe(struct platform_device *pdev)
|
|||||||
ret = ipc_create_pmc_devices();
|
ret = ipc_create_pmc_devices();
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_err(&pdev->dev, "Failed to create pmc devices\n");
|
dev_err(&pdev->dev, "Failed to create pmc devices\n");
|
||||||
goto err_device;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (request_irq(ipcdev.irq, ioc, IRQF_NO_SUSPEND,
|
if (devm_request_irq(&pdev->dev, ipcdev.irq, ioc, IRQF_NO_SUSPEND,
|
||||||
"intel_pmc_ipc", &ipcdev)) {
|
"intel_pmc_ipc", &ipcdev)) {
|
||||||
dev_err(&pdev->dev, "Failed to request irq\n");
|
dev_err(&pdev->dev, "Failed to request irq\n");
|
||||||
ret = -EBUSY;
|
ret = -EBUSY;
|
||||||
goto err_irq;
|
goto err_irq;
|
||||||
@ -960,40 +940,22 @@ static int ipc_plat_probe(struct platform_device *pdev)
|
|||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
err_sys:
|
err_sys:
|
||||||
free_irq(ipcdev.irq, &ipcdev);
|
devm_free_irq(&pdev->dev, ipcdev.irq, &ipcdev);
|
||||||
err_irq:
|
err_irq:
|
||||||
platform_device_unregister(ipcdev.tco_dev);
|
platform_device_unregister(ipcdev.tco_dev);
|
||||||
platform_device_unregister(ipcdev.punit_dev);
|
platform_device_unregister(ipcdev.punit_dev);
|
||||||
platform_device_unregister(ipcdev.telemetry_dev);
|
platform_device_unregister(ipcdev.telemetry_dev);
|
||||||
err_device:
|
|
||||||
iounmap(ipcdev.ipc_base);
|
|
||||||
res = platform_get_resource(pdev, IORESOURCE_MEM,
|
|
||||||
PLAT_RESOURCE_IPC_INDEX);
|
|
||||||
if (res) {
|
|
||||||
release_mem_region(res->start,
|
|
||||||
PLAT_RESOURCE_IPC_SIZE +
|
|
||||||
PLAT_RESOURCE_GCR_SIZE);
|
|
||||||
}
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int ipc_plat_remove(struct platform_device *pdev)
|
static int ipc_plat_remove(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct resource *res;
|
|
||||||
|
|
||||||
sysfs_remove_group(&pdev->dev.kobj, &intel_ipc_group);
|
sysfs_remove_group(&pdev->dev.kobj, &intel_ipc_group);
|
||||||
free_irq(ipcdev.irq, &ipcdev);
|
devm_free_irq(&pdev->dev, ipcdev.irq, &ipcdev);
|
||||||
platform_device_unregister(ipcdev.tco_dev);
|
platform_device_unregister(ipcdev.tco_dev);
|
||||||
platform_device_unregister(ipcdev.punit_dev);
|
platform_device_unregister(ipcdev.punit_dev);
|
||||||
platform_device_unregister(ipcdev.telemetry_dev);
|
platform_device_unregister(ipcdev.telemetry_dev);
|
||||||
iounmap(ipcdev.ipc_base);
|
|
||||||
res = platform_get_resource(pdev, IORESOURCE_MEM,
|
|
||||||
PLAT_RESOURCE_IPC_INDEX);
|
|
||||||
if (res) {
|
|
||||||
release_mem_region(res->start,
|
|
||||||
PLAT_RESOURCE_IPC_SIZE +
|
|
||||||
PLAT_RESOURCE_GCR_SIZE);
|
|
||||||
}
|
|
||||||
ipcdev.dev = NULL;
|
ipcdev.dev = NULL;
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user