Commit 57f1677b authored by Jean-Baptiste Maneyrol's avatar Jean-Baptiste Maneyrol Committed by Jonathan Cameron

iio: imu: inv_mpu6050: use devm_* at init and delete remove

Use devm_* for iio_triggered_buffer_setup, iio_device_register,
iio_trigger_register. Delete unneeded inv_mpu6050_remove_trigger,
inv_mpu_core_remove, and inv_mpu_remove for spi driver.
Signed-off-by: default avatarJean-Baptiste Maneyrol <jmaneyrol@invensense.com>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent eaa54d96
...@@ -984,10 +984,10 @@ int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name, ...@@ -984,10 +984,10 @@ int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name,
indio_dev->info = &mpu_info; indio_dev->info = &mpu_info;
indio_dev->modes = INDIO_BUFFER_TRIGGERED; indio_dev->modes = INDIO_BUFFER_TRIGGERED;
result = iio_triggered_buffer_setup(indio_dev, result = devm_iio_triggered_buffer_setup(dev, indio_dev,
inv_mpu6050_irq_handler, inv_mpu6050_irq_handler,
inv_mpu6050_read_fifo, inv_mpu6050_read_fifo,
NULL); NULL);
if (result) { if (result) {
dev_err(dev, "configure buffer fail %d\n", result); dev_err(dev, "configure buffer fail %d\n", result);
return result; return result;
...@@ -995,39 +995,21 @@ int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name, ...@@ -995,39 +995,21 @@ int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name,
result = inv_mpu6050_probe_trigger(indio_dev, irq_type); result = inv_mpu6050_probe_trigger(indio_dev, irq_type);
if (result) { if (result) {
dev_err(dev, "trigger probe fail %d\n", result); dev_err(dev, "trigger probe fail %d\n", result);
goto out_unreg_ring; return result;
} }
INIT_KFIFO(st->timestamps); INIT_KFIFO(st->timestamps);
spin_lock_init(&st->time_stamp_lock); spin_lock_init(&st->time_stamp_lock);
result = iio_device_register(indio_dev); result = devm_iio_device_register(dev, indio_dev);
if (result) { if (result) {
dev_err(dev, "IIO register fail %d\n", result); dev_err(dev, "IIO register fail %d\n", result);
goto out_remove_trigger; return result;
} }
return 0; return 0;
out_remove_trigger:
inv_mpu6050_remove_trigger(st);
out_unreg_ring:
iio_triggered_buffer_cleanup(indio_dev);
return result;
} }
EXPORT_SYMBOL_GPL(inv_mpu_core_probe); EXPORT_SYMBOL_GPL(inv_mpu_core_probe);
int inv_mpu_core_remove(struct device *dev)
{
struct iio_dev *indio_dev = dev_get_drvdata(dev);
iio_device_unregister(indio_dev);
inv_mpu6050_remove_trigger(iio_priv(indio_dev));
iio_triggered_buffer_cleanup(indio_dev);
return 0;
}
EXPORT_SYMBOL_GPL(inv_mpu_core_remove);
#ifdef CONFIG_PM_SLEEP #ifdef CONFIG_PM_SLEEP
static int inv_mpu_resume(struct device *dev) static int inv_mpu_resume(struct device *dev)
......
...@@ -129,14 +129,12 @@ static int inv_mpu_probe(struct i2c_client *client, ...@@ -129,14 +129,12 @@ static int inv_mpu_probe(struct i2c_client *client,
1, 0, I2C_MUX_LOCKED | I2C_MUX_GATE, 1, 0, I2C_MUX_LOCKED | I2C_MUX_GATE,
inv_mpu6050_select_bypass, inv_mpu6050_select_bypass,
inv_mpu6050_deselect_bypass); inv_mpu6050_deselect_bypass);
if (!st->muxc) { if (!st->muxc)
result = -ENOMEM; return -ENOMEM;
goto out_unreg_device;
}
st->muxc->priv = dev_get_drvdata(&client->dev); st->muxc->priv = dev_get_drvdata(&client->dev);
result = i2c_mux_add_adapter(st->muxc, 0, 0, 0); result = i2c_mux_add_adapter(st->muxc, 0, 0, 0);
if (result) if (result)
goto out_unreg_device; return result;
result = inv_mpu_acpi_create_mux_client(client); result = inv_mpu_acpi_create_mux_client(client);
if (result) if (result)
...@@ -146,8 +144,6 @@ static int inv_mpu_probe(struct i2c_client *client, ...@@ -146,8 +144,6 @@ static int inv_mpu_probe(struct i2c_client *client,
out_del_mux: out_del_mux:
i2c_mux_del_adapters(st->muxc); i2c_mux_del_adapters(st->muxc);
out_unreg_device:
inv_mpu_core_remove(&client->dev);
return result; return result;
} }
...@@ -159,7 +155,7 @@ static int inv_mpu_remove(struct i2c_client *client) ...@@ -159,7 +155,7 @@ static int inv_mpu_remove(struct i2c_client *client)
inv_mpu_acpi_delete_mux_client(client); inv_mpu_acpi_delete_mux_client(client);
i2c_mux_del_adapters(st->muxc); i2c_mux_del_adapters(st->muxc);
return inv_mpu_core_remove(&client->dev); return 0;
} }
/* /*
......
...@@ -301,7 +301,6 @@ enum inv_mpu6050_clock_sel_e { ...@@ -301,7 +301,6 @@ enum inv_mpu6050_clock_sel_e {
irqreturn_t inv_mpu6050_irq_handler(int irq, void *p); irqreturn_t inv_mpu6050_irq_handler(int irq, void *p);
irqreturn_t inv_mpu6050_read_fifo(int irq, void *p); irqreturn_t inv_mpu6050_read_fifo(int irq, void *p);
int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev, int irq_type); int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev, int irq_type);
void inv_mpu6050_remove_trigger(struct inv_mpu6050_state *st);
int inv_reset_fifo(struct iio_dev *indio_dev); int inv_reset_fifo(struct iio_dev *indio_dev);
int inv_mpu6050_switch_engine(struct inv_mpu6050_state *st, bool en, u32 mask); int inv_mpu6050_switch_engine(struct inv_mpu6050_state *st, bool en, u32 mask);
int inv_mpu6050_write_reg(struct inv_mpu6050_state *st, int reg, u8 val); int inv_mpu6050_write_reg(struct inv_mpu6050_state *st, int reg, u8 val);
...@@ -310,5 +309,4 @@ int inv_mpu_acpi_create_mux_client(struct i2c_client *client); ...@@ -310,5 +309,4 @@ int inv_mpu_acpi_create_mux_client(struct i2c_client *client);
void inv_mpu_acpi_delete_mux_client(struct i2c_client *client); void inv_mpu_acpi_delete_mux_client(struct i2c_client *client);
int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name, int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name,
int (*inv_mpu_bus_setup)(struct iio_dev *), int chip_type); int (*inv_mpu_bus_setup)(struct iio_dev *), int chip_type);
int inv_mpu_core_remove(struct device *dev);
extern const struct dev_pm_ops inv_mpu_pmops; extern const struct dev_pm_ops inv_mpu_pmops;
...@@ -69,11 +69,6 @@ static int inv_mpu_probe(struct spi_device *spi) ...@@ -69,11 +69,6 @@ static int inv_mpu_probe(struct spi_device *spi)
inv_mpu_i2c_disable, chip_type); inv_mpu_i2c_disable, chip_type);
} }
static int inv_mpu_remove(struct spi_device *spi)
{
return inv_mpu_core_remove(&spi->dev);
}
/* /*
* device id table is used to identify what device can be * device id table is used to identify what device can be
* supported by this driver * supported by this driver
...@@ -98,7 +93,6 @@ MODULE_DEVICE_TABLE(acpi, inv_acpi_match); ...@@ -98,7 +93,6 @@ MODULE_DEVICE_TABLE(acpi, inv_acpi_match);
static struct spi_driver inv_mpu_driver = { static struct spi_driver inv_mpu_driver = {
.probe = inv_mpu_probe, .probe = inv_mpu_probe,
.remove = inv_mpu_remove,
.id_table = inv_mpu_id, .id_table = inv_mpu_id,
.driver = { .driver = {
.acpi_match_table = ACPI_PTR(inv_acpi_match), .acpi_match_table = ACPI_PTR(inv_acpi_match),
......
...@@ -154,7 +154,7 @@ int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev, int irq_type) ...@@ -154,7 +154,7 @@ int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev, int irq_type)
st->trig->ops = &inv_mpu_trigger_ops; st->trig->ops = &inv_mpu_trigger_ops;
iio_trigger_set_drvdata(st->trig, indio_dev); iio_trigger_set_drvdata(st->trig, indio_dev);
ret = iio_trigger_register(st->trig); ret = devm_iio_trigger_register(&indio_dev->dev, st->trig);
if (ret) if (ret)
return ret; return ret;
...@@ -162,8 +162,3 @@ int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev, int irq_type) ...@@ -162,8 +162,3 @@ int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev, int irq_type)
return 0; return 0;
} }
void inv_mpu6050_remove_trigger(struct inv_mpu6050_state *st)
{
iio_trigger_unregister(st->trig);
}
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