Commit 261d7794 authored by Guenter Roeck's avatar Guenter Roeck Committed by Dmitry Torokhov

Input: synaptics-rmi4 - fix error handling in I2C transport driver

Instantiating the rmi4 I2C transport driver without interrupts assigned
(for example using manual i2c instantiation from the command line)
caused the driver to fail to load, but it does not clean up its regulator
or transport device registrations. Result is a crash at a later time,
for example when rebooting the system.

Fixes: 946c8432 ("Input: synaptics-rmi4 - support regulator supplies")
Cc: Bjorn Andersson <bjorn.andersson@linaro.org>
Signed-off-by: default avatarGuenter Roeck <linux@roeck-us.net>
Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent bbc2ceeb
...@@ -221,6 +221,21 @@ static const struct of_device_id rmi_i2c_of_match[] = { ...@@ -221,6 +221,21 @@ static const struct of_device_id rmi_i2c_of_match[] = {
MODULE_DEVICE_TABLE(of, rmi_i2c_of_match); MODULE_DEVICE_TABLE(of, rmi_i2c_of_match);
#endif #endif
static void rmi_i2c_regulator_bulk_disable(void *data)
{
struct rmi_i2c_xport *rmi_i2c = data;
regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
rmi_i2c->supplies);
}
static void rmi_i2c_unregister_transport(void *data)
{
struct rmi_i2c_xport *rmi_i2c = data;
rmi_unregister_transport_device(&rmi_i2c->xport);
}
static int rmi_i2c_probe(struct i2c_client *client, static int rmi_i2c_probe(struct i2c_client *client,
const struct i2c_device_id *id) const struct i2c_device_id *id)
{ {
...@@ -264,6 +279,12 @@ static int rmi_i2c_probe(struct i2c_client *client, ...@@ -264,6 +279,12 @@ static int rmi_i2c_probe(struct i2c_client *client,
if (retval < 0) if (retval < 0)
return retval; return retval;
retval = devm_add_action_or_reset(&client->dev,
rmi_i2c_regulator_bulk_disable,
rmi_i2c);
if (retval)
return retval;
of_property_read_u32(client->dev.of_node, "syna,startup-delay-ms", of_property_read_u32(client->dev.of_node, "syna,startup-delay-ms",
&rmi_i2c->startup_delay); &rmi_i2c->startup_delay);
...@@ -294,6 +315,11 @@ static int rmi_i2c_probe(struct i2c_client *client, ...@@ -294,6 +315,11 @@ static int rmi_i2c_probe(struct i2c_client *client,
client->addr); client->addr);
return retval; return retval;
} }
retval = devm_add_action_or_reset(&client->dev,
rmi_i2c_unregister_transport,
rmi_i2c);
if (retval)
return retval;
retval = rmi_i2c_init_irq(client); retval = rmi_i2c_init_irq(client);
if (retval < 0) if (retval < 0)
...@@ -304,17 +330,6 @@ static int rmi_i2c_probe(struct i2c_client *client, ...@@ -304,17 +330,6 @@ static int rmi_i2c_probe(struct i2c_client *client,
return 0; return 0;
} }
static int rmi_i2c_remove(struct i2c_client *client)
{
struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
rmi_unregister_transport_device(&rmi_i2c->xport);
regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
rmi_i2c->supplies);
return 0;
}
#ifdef CONFIG_PM_SLEEP #ifdef CONFIG_PM_SLEEP
static int rmi_i2c_suspend(struct device *dev) static int rmi_i2c_suspend(struct device *dev)
{ {
...@@ -431,7 +446,6 @@ static struct i2c_driver rmi_i2c_driver = { ...@@ -431,7 +446,6 @@ static struct i2c_driver rmi_i2c_driver = {
}, },
.id_table = rmi_id, .id_table = rmi_id,
.probe = rmi_i2c_probe, .probe = rmi_i2c_probe,
.remove = rmi_i2c_remove,
}; };
module_i2c_driver(rmi_i2c_driver); module_i2c_driver(rmi_i2c_driver);
......
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