iio: imu: inv_mpu6050: Use devm_iio_device_alloc
Using devm_iio_device_alloc makes code simpler. While at it include missing iio.h header file and do some cleanup. Signed-off-by: Sachin Kamat <sachin.kamat@linaro.org> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
This commit is contained in:
parent
297c8876d9
commit
452204ae53
|
@ -23,6 +23,7 @@
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/kfifo.h>
|
#include <linux/kfifo.h>
|
||||||
#include <linux/spinlock.h>
|
#include <linux/spinlock.h>
|
||||||
|
#include <linux/iio/iio.h>
|
||||||
#include "inv_mpu_iio.h"
|
#include "inv_mpu_iio.h"
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -663,16 +664,13 @@ static int inv_mpu_probe(struct i2c_client *client,
|
||||||
int result;
|
int result;
|
||||||
|
|
||||||
if (!i2c_check_functionality(client->adapter,
|
if (!i2c_check_functionality(client->adapter,
|
||||||
I2C_FUNC_SMBUS_I2C_BLOCK)) {
|
I2C_FUNC_SMBUS_I2C_BLOCK))
|
||||||
|
return -ENOSYS;
|
||||||
|
|
||||||
|
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*st));
|
||||||
|
if (!indio_dev)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
result = -ENOSYS;
|
|
||||||
goto out_no_free;
|
|
||||||
}
|
|
||||||
indio_dev = iio_device_alloc(sizeof(*st));
|
|
||||||
if (indio_dev == NULL) {
|
|
||||||
result = -ENOMEM;
|
|
||||||
goto out_no_free;
|
|
||||||
}
|
|
||||||
st = iio_priv(indio_dev);
|
st = iio_priv(indio_dev);
|
||||||
st->client = client;
|
st->client = client;
|
||||||
st->plat_data = *(struct inv_mpu6050_platform_data
|
st->plat_data = *(struct inv_mpu6050_platform_data
|
||||||
|
@ -680,13 +678,13 @@ static int inv_mpu_probe(struct i2c_client *client,
|
||||||
/* power is turned on inside check chip type*/
|
/* power is turned on inside check chip type*/
|
||||||
result = inv_check_and_setup_chip(st, id);
|
result = inv_check_and_setup_chip(st, id);
|
||||||
if (result)
|
if (result)
|
||||||
goto out_free;
|
return result;
|
||||||
|
|
||||||
result = inv_mpu6050_init_config(indio_dev);
|
result = inv_mpu6050_init_config(indio_dev);
|
||||||
if (result) {
|
if (result) {
|
||||||
dev_err(&client->dev,
|
dev_err(&client->dev,
|
||||||
"Could not initialize device.\n");
|
"Could not initialize device.\n");
|
||||||
goto out_free;
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
i2c_set_clientdata(client, indio_dev);
|
i2c_set_clientdata(client, indio_dev);
|
||||||
|
@ -705,7 +703,7 @@ static int inv_mpu_probe(struct i2c_client *client,
|
||||||
if (result) {
|
if (result) {
|
||||||
dev_err(&st->client->dev, "configure buffer fail %d\n",
|
dev_err(&st->client->dev, "configure buffer fail %d\n",
|
||||||
result);
|
result);
|
||||||
goto out_free;
|
return result;
|
||||||
}
|
}
|
||||||
result = inv_mpu6050_probe_trigger(indio_dev);
|
result = inv_mpu6050_probe_trigger(indio_dev);
|
||||||
if (result) {
|
if (result) {
|
||||||
|
@ -727,10 +725,6 @@ out_remove_trigger:
|
||||||
inv_mpu6050_remove_trigger(st);
|
inv_mpu6050_remove_trigger(st);
|
||||||
out_unreg_ring:
|
out_unreg_ring:
|
||||||
iio_triggered_buffer_cleanup(indio_dev);
|
iio_triggered_buffer_cleanup(indio_dev);
|
||||||
out_free:
|
|
||||||
iio_device_free(indio_dev);
|
|
||||||
out_no_free:
|
|
||||||
|
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -742,7 +736,6 @@ static int inv_mpu_remove(struct i2c_client *client)
|
||||||
iio_device_unregister(indio_dev);
|
iio_device_unregister(indio_dev);
|
||||||
inv_mpu6050_remove_trigger(st);
|
inv_mpu6050_remove_trigger(st);
|
||||||
iio_triggered_buffer_cleanup(indio_dev);
|
iio_triggered_buffer_cleanup(indio_dev);
|
||||||
iio_device_free(indio_dev);
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue