Input: tsc2007 - convert to use devres-managed resources
This simplifies error handling path and allows us get rid of tsc2007_remove(). Tested-by: Denis Carikli <denis@eukrea.com> Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
This commit is contained in:
parent
f261d46551
commit
fd91a5f013
|
@ -365,6 +365,14 @@ static int tsc2007_probe_pdev(struct i2c_client *client, struct tsc2007 *ts,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void tsc2007_call_exit_platform_hw(void *data)
|
||||
{
|
||||
struct device *dev = data;
|
||||
const struct tsc2007_platform_data *pdata = dev_get_platdata(dev);
|
||||
|
||||
pdata->exit_platform_hw();
|
||||
}
|
||||
|
||||
static int tsc2007_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
|
@ -388,11 +396,9 @@ static int tsc2007_probe(struct i2c_client *client,
|
|||
if (err)
|
||||
return err;
|
||||
|
||||
input_dev = input_allocate_device();
|
||||
if (!input_dev) {
|
||||
err = -ENOMEM;
|
||||
goto err_free_input;
|
||||
};
|
||||
input_dev = devm_input_allocate_device(&client->dev);
|
||||
if (!input_dev)
|
||||
return -ENOMEM;
|
||||
|
||||
i2c_set_clientdata(client, ts);
|
||||
|
||||
|
@ -421,46 +427,42 @@ static int tsc2007_probe(struct i2c_client *client,
|
|||
input_set_abs_params(input_dev, ABS_PRESSURE, 0, MAX_12BIT,
|
||||
ts->fuzzz, 0);
|
||||
|
||||
if (pdata && pdata->init_platform_hw)
|
||||
pdata->init_platform_hw();
|
||||
if (pdata) {
|
||||
if (pdata->exit_platform_hw) {
|
||||
err = devm_add_action(&client->dev,
|
||||
tsc2007_call_exit_platform_hw,
|
||||
&client->dev);
|
||||
if (err) {
|
||||
dev_err(&client->dev,
|
||||
"Failed to register exit_platform_hw action, %d\n",
|
||||
err);
|
||||
return err;
|
||||
}
|
||||
}
|
||||
|
||||
err = request_threaded_irq(ts->irq, tsc2007_hard_irq, tsc2007_soft_irq,
|
||||
IRQF_ONESHOT, client->dev.driver->name, ts);
|
||||
if (err < 0) {
|
||||
dev_err(&client->dev, "irq %d busy?\n", ts->irq);
|
||||
goto err_free_input;
|
||||
if (pdata->init_platform_hw)
|
||||
pdata->init_platform_hw();
|
||||
}
|
||||
|
||||
err = devm_request_threaded_irq(&client->dev, ts->irq,
|
||||
tsc2007_hard_irq, tsc2007_soft_irq,
|
||||
IRQF_ONESHOT,
|
||||
client->dev.driver->name, ts);
|
||||
if (err) {
|
||||
dev_err(&client->dev, "Failed to request irq %d: %d\n",
|
||||
ts->irq, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
tsc2007_stop(ts);
|
||||
|
||||
err = input_register_device(input_dev);
|
||||
if (err)
|
||||
goto err_free_irq;
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_irq:
|
||||
free_irq(ts->irq, ts);
|
||||
if (pdata && pdata->exit_platform_hw)
|
||||
pdata->exit_platform_hw();
|
||||
err_free_input:
|
||||
input_free_device(input_dev);
|
||||
if (err) {
|
||||
dev_err(&client->dev,
|
||||
"Failed to register input device: %d\n", err);
|
||||
return err;
|
||||
}
|
||||
|
||||
static int tsc2007_remove(struct i2c_client *client)
|
||||
{
|
||||
const struct tsc2007_platform_data *pdata = dev_get_platdata(&client->dev);
|
||||
struct tsc2007 *ts = i2c_get_clientdata(client);
|
||||
|
||||
free_irq(ts->irq, ts);
|
||||
|
||||
if (pdata && pdata->exit_platform_hw)
|
||||
pdata->exit_platform_hw();
|
||||
|
||||
input_unregister_device(ts->input);
|
||||
kfree(ts);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -487,7 +489,6 @@ static struct i2c_driver tsc2007_driver = {
|
|||
},
|
||||
.id_table = tsc2007_idtable,
|
||||
.probe = tsc2007_probe,
|
||||
.remove = tsc2007_remove,
|
||||
};
|
||||
|
||||
module_i2c_driver(tsc2007_driver);
|
||||
|
|
Loading…
Reference in New Issue