diff options
| author | Dmitry Torokhov <dmitry.torokhov@gmail.com> | 2013-12-15 06:28:26 -0500 |
|---|---|---|
| committer | Dmitry Torokhov <dmitry.torokhov@gmail.com> | 2013-12-27 20:18:29 -0500 |
| commit | eb735d3b841b42fd56d6bfb4039d61aa0fc3cf8d (patch) | |
| tree | 83caf969703156d85782a3393055e00b5e1aa50b /drivers/input | |
| parent | e77a715ac3af14d16c027caebdb0ce5412976b9e (diff) | |
Input: pmic8xxx-pwrkey - switch to using managed resources
This simplifies error handling and device removal paths.
Acked-by: Stephen Boyd <sboyd@codeaurora.org>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
Diffstat (limited to 'drivers/input')
| -rw-r--r-- | drivers/input/misc/pmic8xxx-pwrkey.c | 74 |
1 files changed, 25 insertions, 49 deletions
diff --git a/drivers/input/misc/pmic8xxx-pwrkey.c b/drivers/input/misc/pmic8xxx-pwrkey.c index 3914e5ba05a1..aaf332510623 100644 --- a/drivers/input/misc/pmic8xxx-pwrkey.c +++ b/drivers/input/misc/pmic8xxx-pwrkey.c | |||
| @@ -32,7 +32,6 @@ | |||
| 32 | * @key_press_irq: key press irq number | 32 | * @key_press_irq: key press irq number |
| 33 | */ | 33 | */ |
| 34 | struct pmic8xxx_pwrkey { | 34 | struct pmic8xxx_pwrkey { |
| 35 | struct input_dev *pwr; | ||
| 36 | int key_press_irq; | 35 | int key_press_irq; |
| 37 | }; | 36 | }; |
| 38 | 37 | ||
| @@ -110,22 +109,22 @@ static int pmic8xxx_pwrkey_probe(struct platform_device *pdev) | |||
| 110 | return -ENODEV; | 109 | return -ENODEV; |
| 111 | } | 110 | } |
| 112 | 111 | ||
| 113 | pwrkey = kzalloc(sizeof(*pwrkey), GFP_KERNEL); | 112 | pwrkey = devm_kzalloc(&pdev->dev, sizeof(*pwrkey), GFP_KERNEL); |
| 114 | if (!pwrkey) | 113 | if (!pwrkey) |
| 115 | return -ENOMEM; | 114 | return -ENOMEM; |
| 116 | 115 | ||
| 117 | pwr = input_allocate_device(); | 116 | pwrkey->key_press_irq = key_press_irq; |
| 117 | |||
| 118 | pwr = devm_input_allocate_device(&pdev->dev); | ||
| 118 | if (!pwr) { | 119 | if (!pwr) { |
| 119 | dev_dbg(&pdev->dev, "Can't allocate power button\n"); | 120 | dev_dbg(&pdev->dev, "Can't allocate power button\n"); |
| 120 | err = -ENOMEM; | 121 | return -ENOMEM; |
| 121 | goto free_pwrkey; | ||
| 122 | } | 122 | } |
| 123 | 123 | ||
| 124 | input_set_capability(pwr, EV_KEY, KEY_POWER); | 124 | input_set_capability(pwr, EV_KEY, KEY_POWER); |
| 125 | 125 | ||
| 126 | pwr->name = "pmic8xxx_pwrkey"; | 126 | pwr->name = "pmic8xxx_pwrkey"; |
| 127 | pwr->phys = "pmic8xxx_pwrkey/input0"; | 127 | pwr->phys = "pmic8xxx_pwrkey/input0"; |
| 128 | pwr->dev.parent = &pdev->dev; | ||
| 129 | 128 | ||
| 130 | delay = (pdata->kpd_trigger_delay_us << 10) / USEC_PER_SEC; | 129 | delay = (pdata->kpd_trigger_delay_us << 10) / USEC_PER_SEC; |
| 131 | delay = 1 + ilog2(delay); | 130 | delay = 1 + ilog2(delay); |
| @@ -133,7 +132,7 @@ static int pmic8xxx_pwrkey_probe(struct platform_device *pdev) | |||
| 133 | err = regmap_read(regmap, PON_CNTL_1, &pon_cntl); | 132 | err = regmap_read(regmap, PON_CNTL_1, &pon_cntl); |
| 134 | if (err < 0) { | 133 | if (err < 0) { |
| 135 | dev_err(&pdev->dev, "failed reading PON_CNTL_1 err=%d\n", err); | 134 | dev_err(&pdev->dev, "failed reading PON_CNTL_1 err=%d\n", err); |
| 136 | goto free_input_dev; | 135 | return err; |
| 137 | } | 136 | } |
| 138 | 137 | ||
| 139 | pon_cntl &= ~PON_CNTL_TRIG_DELAY_MASK; | 138 | pon_cntl &= ~PON_CNTL_TRIG_DELAY_MASK; |
| @@ -146,66 +145,43 @@ static int pmic8xxx_pwrkey_probe(struct platform_device *pdev) | |||
| 146 | err = regmap_write(regmap, PON_CNTL_1, pon_cntl); | 145 | err = regmap_write(regmap, PON_CNTL_1, pon_cntl); |
| 147 | if (err < 0) { | 146 | if (err < 0) { |
| 148 | dev_err(&pdev->dev, "failed writing PON_CNTL_1 err=%d\n", err); | 147 | dev_err(&pdev->dev, "failed writing PON_CNTL_1 err=%d\n", err); |
| 149 | goto free_input_dev; | 148 | return err; |
| 150 | } | 149 | } |
| 151 | 150 | ||
| 152 | err = input_register_device(pwr); | 151 | err = devm_request_irq(&pdev->dev, key_press_irq, pwrkey_press_irq, |
| 152 | IRQF_TRIGGER_RISING, | ||
| 153 | "pmic8xxx_pwrkey_press", pwr); | ||
| 153 | if (err) { | 154 | if (err) { |
| 154 | dev_dbg(&pdev->dev, "Can't register power key: %d\n", err); | 155 | dev_err(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n", |
| 155 | goto free_input_dev; | 156 | key_press_irq, err); |
| 157 | return err; | ||
| 156 | } | 158 | } |
| 157 | 159 | ||
| 158 | pwrkey->key_press_irq = key_press_irq; | 160 | err = devm_request_irq(&pdev->dev, key_release_irq, pwrkey_release_irq, |
| 159 | pwrkey->pwr = pwr; | 161 | IRQF_TRIGGER_RISING, |
| 160 | 162 | "pmic8xxx_pwrkey_release", pwr); | |
| 161 | platform_set_drvdata(pdev, pwrkey); | 163 | if (err) { |
| 162 | 164 | dev_err(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n", | |
| 163 | err = request_irq(key_press_irq, pwrkey_press_irq, | 165 | key_release_irq, err); |
| 164 | IRQF_TRIGGER_RISING, "pmic8xxx_pwrkey_press", pwr); | 166 | return err; |
| 165 | if (err < 0) { | ||
| 166 | dev_dbg(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n", | ||
| 167 | key_press_irq, err); | ||
| 168 | goto unreg_input_dev; | ||
| 169 | } | 167 | } |
| 170 | 168 | ||
| 171 | err = request_irq(key_release_irq, pwrkey_release_irq, | 169 | err = input_register_device(pwr); |
| 172 | IRQF_TRIGGER_RISING, "pmic8xxx_pwrkey_release", pwr); | 170 | if (err) { |
| 173 | if (err < 0) { | 171 | dev_err(&pdev->dev, "Can't register power key: %d\n", err); |
| 174 | dev_dbg(&pdev->dev, "Can't get %d IRQ for pwrkey: %d\n", | 172 | return err; |
| 175 | key_release_irq, err); | ||
| 176 | |||
| 177 | goto free_press_irq; | ||
| 178 | } | 173 | } |
| 179 | 174 | ||
| 175 | platform_set_drvdata(pdev, pwrkey); | ||
| 180 | device_init_wakeup(&pdev->dev, pdata->wakeup); | 176 | device_init_wakeup(&pdev->dev, pdata->wakeup); |
| 181 | 177 | ||
| 182 | return 0; | 178 | return 0; |
| 183 | |||
| 184 | free_press_irq: | ||
| 185 | free_irq(key_press_irq, pwr); | ||
| 186 | unreg_input_dev: | ||
| 187 | input_unregister_device(pwr); | ||
| 188 | pwr = NULL; | ||
| 189 | free_input_dev: | ||
| 190 | input_free_device(pwr); | ||
| 191 | free_pwrkey: | ||
| 192 | kfree(pwrkey); | ||
| 193 | return err; | ||
| 194 | } | 179 | } |
| 195 | 180 | ||
| 196 | static int pmic8xxx_pwrkey_remove(struct platform_device *pdev) | 181 | static int pmic8xxx_pwrkey_remove(struct platform_device *pdev) |
| 197 | { | 182 | { |
| 198 | struct pmic8xxx_pwrkey *pwrkey = platform_get_drvdata(pdev); | ||
| 199 | int key_release_irq = platform_get_irq(pdev, 0); | ||
| 200 | int key_press_irq = platform_get_irq(pdev, 1); | ||
| 201 | |||
| 202 | device_init_wakeup(&pdev->dev, 0); | 183 | device_init_wakeup(&pdev->dev, 0); |
| 203 | 184 | ||
| 204 | free_irq(key_press_irq, pwrkey->pwr); | ||
| 205 | free_irq(key_release_irq, pwrkey->pwr); | ||
| 206 | input_unregister_device(pwrkey->pwr); | ||
| 207 | kfree(pwrkey); | ||
| 208 | |||
| 209 | return 0; | 185 | return 0; |
| 210 | } | 186 | } |
| 211 | 187 | ||
