Commit c7f6ee26 authored by Stephen Boyd's avatar Stephen Boyd Committed by Dmitry Torokhov

Input: pmic8xxx-keypad - migrate to devm_* APIs

Simplify the error paths and reduce the lines of code in this
driver by using the devm_* APIs.
Signed-off-by: default avatarStephen Boyd <sboyd@codeaurora.org>
Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent d3e6a67c
...@@ -543,7 +543,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -543,7 +543,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
return -EINVAL; return -EINVAL;
} }
kp = kzalloc(sizeof(*kp), GFP_KERNEL); kp = devm_kzalloc(&pdev->dev, sizeof(*kp), GFP_KERNEL);
if (!kp) if (!kp)
return -ENOMEM; return -ENOMEM;
...@@ -552,32 +552,27 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -552,32 +552,27 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
kp->pdata = pdata; kp->pdata = pdata;
kp->dev = &pdev->dev; kp->dev = &pdev->dev;
kp->input = input_allocate_device(); kp->input = devm_input_allocate_device(&pdev->dev);
if (!kp->input) { if (!kp->input) {
dev_err(&pdev->dev, "unable to allocate input device\n"); dev_err(&pdev->dev, "unable to allocate input device\n");
rc = -ENOMEM; return -ENOMEM;
goto err_alloc_device;
} }
kp->key_sense_irq = platform_get_irq(pdev, 0); kp->key_sense_irq = platform_get_irq(pdev, 0);
if (kp->key_sense_irq < 0) { if (kp->key_sense_irq < 0) {
dev_err(&pdev->dev, "unable to get keypad sense irq\n"); dev_err(&pdev->dev, "unable to get keypad sense irq\n");
rc = -ENXIO; return kp->key_sense_irq;
goto err_get_irq;
} }
kp->key_stuck_irq = platform_get_irq(pdev, 1); kp->key_stuck_irq = platform_get_irq(pdev, 1);
if (kp->key_stuck_irq < 0) { if (kp->key_stuck_irq < 0) {
dev_err(&pdev->dev, "unable to get keypad stuck irq\n"); dev_err(&pdev->dev, "unable to get keypad stuck irq\n");
rc = -ENXIO; return kp->key_stuck_irq;
goto err_get_irq;
} }
kp->input->name = pdata->input_name ? : "PMIC8XXX keypad"; kp->input->name = pdata->input_name ? : "PMIC8XXX keypad";
kp->input->phys = pdata->input_phys_device ? : "pmic8xxx_keypad/input0"; kp->input->phys = pdata->input_phys_device ? : "pmic8xxx_keypad/input0";
kp->input->dev.parent = &pdev->dev;
kp->input->id.bustype = BUS_I2C; kp->input->id.bustype = BUS_I2C;
kp->input->id.version = 0x0001; kp->input->id.version = 0x0001;
kp->input->id.product = 0x0001; kp->input->id.product = 0x0001;
...@@ -591,7 +586,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -591,7 +586,7 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
kp->keycodes, kp->input); kp->keycodes, kp->input);
if (rc) { if (rc) {
dev_err(&pdev->dev, "failed to build keymap\n"); dev_err(&pdev->dev, "failed to build keymap\n");
goto err_get_irq; return rc;
} }
if (pdata->rep) if (pdata->rep)
...@@ -607,27 +602,29 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -607,27 +602,29 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
rc = pmic8xxx_kpd_init(kp); rc = pmic8xxx_kpd_init(kp);
if (rc < 0) { if (rc < 0) {
dev_err(&pdev->dev, "unable to initialize keypad controller\n"); dev_err(&pdev->dev, "unable to initialize keypad controller\n");
goto err_get_irq; return rc;
} }
rc = request_any_context_irq(kp->key_sense_irq, pmic8xxx_kp_irq, rc = devm_request_any_context_irq(&pdev->dev, kp->key_sense_irq,
IRQF_TRIGGER_RISING, "pmic-keypad", kp); pmic8xxx_kp_irq, IRQF_TRIGGER_RISING, "pmic-keypad",
kp);
if (rc < 0) { if (rc < 0) {
dev_err(&pdev->dev, "failed to request keypad sense irq\n"); dev_err(&pdev->dev, "failed to request keypad sense irq\n");
goto err_get_irq; return rc;
} }
rc = request_any_context_irq(kp->key_stuck_irq, pmic8xxx_kp_stuck_irq, rc = devm_request_any_context_irq(&pdev->dev, kp->key_stuck_irq,
IRQF_TRIGGER_RISING, "pmic-keypad-stuck", kp); pmic8xxx_kp_stuck_irq, IRQF_TRIGGER_RISING,
"pmic-keypad-stuck", kp);
if (rc < 0) { if (rc < 0) {
dev_err(&pdev->dev, "failed to request keypad stuck irq\n"); dev_err(&pdev->dev, "failed to request keypad stuck irq\n");
goto err_req_stuck_irq; return rc;
} }
rc = pmic8xxx_kp_read_u8(kp, &ctrl_val, KEYP_CTRL); rc = pmic8xxx_kp_read_u8(kp, &ctrl_val, KEYP_CTRL);
if (rc < 0) { if (rc < 0) {
dev_err(&pdev->dev, "failed to read KEYP_CTRL register\n"); dev_err(&pdev->dev, "failed to read KEYP_CTRL register\n");
goto err_pmic_reg_read; return rc;
} }
kp->ctrl_reg = ctrl_val; kp->ctrl_reg = ctrl_val;
...@@ -635,34 +632,11 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev) ...@@ -635,34 +632,11 @@ static int pmic8xxx_kp_probe(struct platform_device *pdev)
rc = input_register_device(kp->input); rc = input_register_device(kp->input);
if (rc < 0) { if (rc < 0) {
dev_err(&pdev->dev, "unable to register keypad input device\n"); dev_err(&pdev->dev, "unable to register keypad input device\n");
goto err_pmic_reg_read; return rc;
} }
device_init_wakeup(&pdev->dev, pdata->wakeup); device_init_wakeup(&pdev->dev, pdata->wakeup);
return 0;
err_pmic_reg_read:
free_irq(kp->key_stuck_irq, kp);
err_req_stuck_irq:
free_irq(kp->key_sense_irq, kp);
err_get_irq:
input_free_device(kp->input);
err_alloc_device:
kfree(kp);
return rc;
}
static int pmic8xxx_kp_remove(struct platform_device *pdev)
{
struct pmic8xxx_kp *kp = platform_get_drvdata(pdev);
device_init_wakeup(&pdev->dev, 0);
free_irq(kp->key_stuck_irq, kp);
free_irq(kp->key_sense_irq, kp);
input_unregister_device(kp->input);
kfree(kp);
return 0; return 0;
} }
...@@ -713,7 +687,6 @@ static SIMPLE_DEV_PM_OPS(pm8xxx_kp_pm_ops, ...@@ -713,7 +687,6 @@ static SIMPLE_DEV_PM_OPS(pm8xxx_kp_pm_ops,
static struct platform_driver pmic8xxx_kp_driver = { static struct platform_driver pmic8xxx_kp_driver = {
.probe = pmic8xxx_kp_probe, .probe = pmic8xxx_kp_probe,
.remove = pmic8xxx_kp_remove,
.driver = { .driver = {
.name = PM8XXX_KEYPAD_DEV_NAME, .name = PM8XXX_KEYPAD_DEV_NAME,
.owner = THIS_MODULE, .owner = THIS_MODULE,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment