Input: opencores-kbd - switch to using managed resources

This change switch to managed resources to simplifies error handling
and module unloading and does away with platform_driver remove function.

Signed-off-by: Pramod Gurav <pramod.gurav@smartplayin.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
This commit is contained in:
Pramod Gurav 2014-10-07 09:06:31 -07:00 коммит произвёл Dmitry Torokhov
Родитель 7c4f56070f
Коммит 848d479361
1 изменённых файлов: 17 добавлений и 55 удалений

Просмотреть файл

@ -18,7 +18,6 @@
struct opencores_kbd { struct opencores_kbd {
struct input_dev *input; struct input_dev *input;
struct resource *addr_res;
void __iomem *addr; void __iomem *addr;
int irq; int irq;
unsigned short keycodes[128]; unsigned short keycodes[128];
@ -56,35 +55,25 @@ static int opencores_kbd_probe(struct platform_device *pdev)
return -EINVAL; return -EINVAL;
} }
opencores_kbd = kzalloc(sizeof(*opencores_kbd), GFP_KERNEL); opencores_kbd = devm_kzalloc(&pdev->dev, sizeof(*opencores_kbd),
input = input_allocate_device(); GFP_KERNEL);
if (!opencores_kbd || !input) { if (!opencores_kbd)
dev_err(&pdev->dev, "failed to allocate device structures\n"); return -ENOMEM;
error = -ENOMEM;
goto err_free_mem;
}
opencores_kbd->addr_res = res; input = devm_input_allocate_device(&pdev->dev);
res = request_mem_region(res->start, resource_size(res), pdev->name); if (!input) {
if (!res) { dev_err(&pdev->dev, "failed to allocate input device\n");
dev_err(&pdev->dev, "failed to request I/O memory\n"); return -ENOMEM;
error = -EBUSY;
goto err_free_mem;
}
opencores_kbd->addr = ioremap(res->start, resource_size(res));
if (!opencores_kbd->addr) {
dev_err(&pdev->dev, "failed to remap I/O memory\n");
error = -ENXIO;
goto err_rel_mem;
} }
opencores_kbd->input = input; opencores_kbd->input = input;
opencores_kbd->irq = irq;
opencores_kbd->addr = devm_ioremap_resource(&pdev->dev, res);
if (IS_ERR(opencores_kbd->addr))
error = PTR_ERR(opencores_kbd->addr);
input->name = pdev->name; input->name = pdev->name;
input->phys = "opencores-kbd/input0"; input->phys = "opencores-kbd/input0";
input->dev.parent = &pdev->dev;
input_set_drvdata(input, opencores_kbd); input_set_drvdata(input, opencores_kbd);
@ -109,54 +98,27 @@ static int opencores_kbd_probe(struct platform_device *pdev)
} }
__clear_bit(KEY_RESERVED, input->keybit); __clear_bit(KEY_RESERVED, input->keybit);
error = request_irq(irq, &opencores_kbd_isr, error = devm_request_irq(&pdev->dev, irq, &opencores_kbd_isr,
IRQF_TRIGGER_RISING, pdev->name, opencores_kbd); IRQF_TRIGGER_RISING,
pdev->name, opencores_kbd);
if (error) { if (error) {
dev_err(&pdev->dev, "unable to claim irq %d\n", irq); dev_err(&pdev->dev, "unable to claim irq %d\n", irq);
goto err_unmap_mem; return error;
} }
error = input_register_device(input); error = input_register_device(input);
if (error) { if (error) {
dev_err(&pdev->dev, "unable to register input device\n"); dev_err(&pdev->dev, "unable to register input device\n");
goto err_free_irq; return error;
} }
platform_set_drvdata(pdev, opencores_kbd); platform_set_drvdata(pdev, opencores_kbd);
return 0;
err_free_irq:
free_irq(irq, opencores_kbd);
err_unmap_mem:
iounmap(opencores_kbd->addr);
err_rel_mem:
release_mem_region(res->start, resource_size(res));
err_free_mem:
input_free_device(input);
kfree(opencores_kbd);
return error;
}
static int opencores_kbd_remove(struct platform_device *pdev)
{
struct opencores_kbd *opencores_kbd = platform_get_drvdata(pdev);
free_irq(opencores_kbd->irq, opencores_kbd);
iounmap(opencores_kbd->addr);
release_mem_region(opencores_kbd->addr_res->start,
resource_size(opencores_kbd->addr_res));
input_unregister_device(opencores_kbd->input);
kfree(opencores_kbd);
return 0; return 0;
} }
static struct platform_driver opencores_kbd_device_driver = { static struct platform_driver opencores_kbd_device_driver = {
.probe = opencores_kbd_probe, .probe = opencores_kbd_probe,
.remove = opencores_kbd_remove,
.driver = { .driver = {
.name = "opencores-kbd", .name = "opencores-kbd",
}, },