iio:accel:bmc150-accel: Move bmc150_accel_chip_init()
PATCH 1/2 iio:accel:bmc150-accel: Move bmc150_accel_chip_init()
Move bmc150_accel_chip_init() so that we can use
bmc150_accel_chip_info_tbl[] in it.
Signed-off-by Bastien Nocera <[email protected]>
--- drivers/iio/accel/bmc150-accel.c | 118 +++++++++++++++++++-------------------- 1 file changed, 59 insertions(+), 59 deletions(-)
drivers/iio/accel/bmc150-accel.c +59 -59
@@ -345,65 +345,6 @@ static int bmc150_accel_any_motion_setup(struct bmc150_accel_trigger *t,return 0 ; } -static int bmc150_accel_chip_init (struct bmc150_accel_data *data) -{ -int ret; - - ret =i2c_smbus_read_byte_data (data->client,BMC150_ACCEL_REG_CHIP_ID ); -if (ret <0 ) { -dev_err (&data->client->dev, -"Error: Reading chip id\n" ); -return ret; - } - -dev_dbg (&data->client->dev,"Chip Id %x\n" , ret); -if (ret != data->chip_info->chip_id) { -dev_err (&data->client->dev,"Invalid chip %x\n" , ret); -return -ENODEV ; - } - - ret =bmc150_accel_set_mode (data,BMC150_ACCEL_SLEEP_MODE_NORMAL ,0 ); -if (ret <0 ) -return ret; - -/* Set Bandwidth */ - ret =bmc150_accel_set_bw (data,BMC150_ACCEL_DEF_BW ,0 ); -if (ret <0 ) -return ret; - -/* Set Default Range */ - ret =i2c_smbus_write_byte_data (data->client, -BMC150_ACCEL_REG_PMU_RANGE , -BMC150_ACCEL_DEF_RANGE_4G ); -if (ret <0 ) { -dev_err (&data->client->dev, -"Error writing reg_pmu_range\n" ); -return ret; - } - - data->range =BMC150_ACCEL_DEF_RANGE_4G ; - -/* Set default slope duration and thresholds */ - data->slope_thres =BMC150_ACCEL_DEF_SLOPE_THRESHOLD ; - data->slope_dur =BMC150_ACCEL_DEF_SLOPE_DURATION ; - ret =bmc150_accel_update_slope (data); -if (ret <0 ) -return ret; - -/* Set default as latched interrupts */ - ret =i2c_smbus_write_byte_data (data->client, -BMC150_ACCEL_REG_INT_RST_LATCH , -BMC150_ACCEL_INT_MODE_LATCH_INT | -BMC150_ACCEL_INT_MODE_LATCH_RESET ); -if (ret <0 ) { -dev_err (&data->client->dev, -"Error writing reg_int_rst_latch\n" ); -return ret; - } - -return 0 ; -} -static int bmc150_accel_get_bw (struct bmc150_accel_data *data,int *val,int *val2) {
@@ -1611,6 +1552,65 @@ static const struct iio_buffer_setup_ops bmc150_accel_buffer_ops = { .postdisable = bmc150_accel_buffer_postdisable, }; +static int bmc150_accel_chip_init (struct bmc150_accel_data *data) +{ +int ret; + + ret =i2c_smbus_read_byte_data (data->client,BMC150_ACCEL_REG_CHIP_ID ); +if (ret <0 ) { +dev_err (&data->client->dev, +"Error: Reading chip id\n" ); +return ret; + } + +dev_dbg (&data->client->dev,"Chip Id %x\n" , ret); +if (ret != data->chip_info->chip_id) { +dev_err (&data->client->dev,"Invalid chip %x\n" , ret); +return -ENODEV ; + } + + ret =bmc150_accel_set_mode (data,BMC150_ACCEL_SLEEP_MODE_NORMAL ,0 ); +if (ret <0 ) +return ret; + +/* Set Bandwidth */ + ret =bmc150_accel_set_bw (data,BMC150_ACCEL_DEF_BW ,0 ); +if (ret <0 ) +return ret; + +/* Set Default Range */ + ret =i2c_smbus_write_byte_data (data->client, +BMC150_ACCEL_REG_PMU_RANGE , +BMC150_ACCEL_DEF_RANGE_4G ); +if (ret <0 ) { +dev_err (&data->client->dev, +"Error writing reg_pmu_range\n" ); +return ret; + } + + data->range =BMC150_ACCEL_DEF_RANGE_4G ; + +/* Set default slope duration and thresholds */ + data->slope_thres =BMC150_ACCEL_DEF_SLOPE_THRESHOLD ; + data->slope_dur =BMC150_ACCEL_DEF_SLOPE_DURATION ; + ret =bmc150_accel_update_slope (data); +if (ret <0 ) +return ret; + +/* Set default as latched interrupts */ + ret =i2c_smbus_write_byte_data (data->client, +BMC150_ACCEL_REG_INT_RST_LATCH , +BMC150_ACCEL_INT_MODE_LATCH_INT | +BMC150_ACCEL_INT_MODE_LATCH_RESET ); +if (ret <0 ) { +dev_err (&data->client->dev, +"Error writing reg_int_rst_latch\n" ); +return ret; + } + +return 0 ; +} +static int bmc150_accel_probe (struct i2c_client *client,const struct i2c_device_id *id) {
Signature · 1 line
2.4.3
Jonathan Cameron
maintainerQuoted 4 lines · Bastien Nocera
Move
bmc150_accel_chip_init()so that we can use
bmc150_accel_chip_info_tbl[] in it.Signed-off-by Bastien Nocera <[email protected]>
Whilst it would be nice to have this in stable etc it's going to need some backporting. For now I've applied it by hand to the togreg branch of iio.git (late in cycle so I'm wary of pushing this out in a fixes patchset).
I have marked it as for stable, but it almost certainly won't apply as is. (or at least the chances of both applying is rather small!)
Jonathan
Quoted 141 lines
--- drivers/iio/accel/bmc150-accel.c | 118 +++++++++++++++++++-------------------- 1 file changed, 59 insertions(+), 59 deletions(-)drivers/iio/accel/bmc150-accel.c +59
-59@@ -345,65 +345,6 @@ static int bmc150_accel_any_motion_setup(struct bmc150_accel_trigger *t,return 0 ; } -static int bmc150_accel_chip_init (struct bmc150_accel_data *data) -{ -int ret; - - ret =i2c_smbus_read_byte_data (data->client,BMC150_ACCEL_REG_CHIP_ID ); -if (ret <0 ) { -dev_err (&data->client->dev, -"Error: Reading chip id\n" ); -return ret; - } - -dev_dbg (&data->client->dev,"Chip Id %x\n" , ret); -if (ret != data->chip_info->chip_id) { -dev_err (&data->client->dev,"Invalid chip %x\n" , ret); -return -ENODEV ; - } - - ret =bmc150_accel_set_mode (data,BMC150_ACCEL_SLEEP_MODE_NORMAL ,0 ); -if (ret <0 ) -return ret; - -/* Set Bandwidth */ - ret =bmc150_accel_set_bw (data,BMC150_ACCEL_DEF_BW ,0 ); -if (ret <0 ) -return ret; - -/* Set Default Range */ - ret =i2c_smbus_write_byte_data (data->client, -BMC150_ACCEL_REG_PMU_RANGE , -BMC150_ACCEL_DEF_RANGE_4G ); -if (ret <0 ) { -dev_err (&data->client->dev, -"Error writing reg_pmu_range\n" ); -return ret; - } - - data->range =BMC150_ACCEL_DEF_RANGE_4G ; - -/* Set default slope duration and thresholds */ - data->slope_thres =BMC150_ACCEL_DEF_SLOPE_THRESHOLD ; - data->slope_dur =BMC150_ACCEL_DEF_SLOPE_DURATION ; - ret =bmc150_accel_update_slope (data); -if (ret <0 ) -return ret; - -/* Set default as latched interrupts */ - ret =i2c_smbus_write_byte_data (data->client, -BMC150_ACCEL_REG_INT_RST_LATCH , -BMC150_ACCEL_INT_MODE_LATCH_INT | -BMC150_ACCEL_INT_MODE_LATCH_RESET ); -if (ret <0 ) { -dev_err (&data->client->dev, -"Error writing reg_int_rst_latch\n" ); -return ret; - } - -return 0 ; -} -static int bmc150_accel_get_bw (struct bmc150_accel_data *data,int *val,int *val2) {@@ -1611,6 +1552,65 @@ static const struct iio_buffer_setup_ops bmc150_accel_buffer_ops = { .postdisable = bmc150_accel_buffer_postdisable, }; +static int bmc150_accel_chip_init (struct bmc150_accel_data *data) +{ +int ret; + + ret =i2c_smbus_read_byte_data (data->client,BMC150_ACCEL_REG_CHIP_ID ); +if (ret <0 ) { +dev_err (&data->client->dev, +"Error: Reading chip id\n" ); +return ret; + } + +dev_dbg (&data->client->dev,"Chip Id %x\n" , ret); +if (ret != data->chip_info->chip_id) { +dev_err (&data->client->dev,"Invalid chip %x\n" , ret); +return -ENODEV ; + } + + ret =bmc150_accel_set_mode (data,BMC150_ACCEL_SLEEP_MODE_NORMAL ,0 ); +if (ret <0 ) +return ret; + +/* Set Bandwidth */ + ret =bmc150_accel_set_bw (data,BMC150_ACCEL_DEF_BW ,0 ); +if (ret <0 ) +return ret; + +/* Set Default Range */ + ret =i2c_smbus_write_byte_data (data->client, +BMC150_ACCEL_REG_PMU_RANGE , +BMC150_ACCEL_DEF_RANGE_4G ); +if (ret <0 ) { +dev_err (&data->client->dev, +"Error writing reg_pmu_range\n" ); +return ret; + } + + data->range =BMC150_ACCEL_DEF_RANGE_4G ; + +/* Set default slope duration and thresholds */ + data->slope_thres =BMC150_ACCEL_DEF_SLOPE_THRESHOLD ; + data->slope_dur =BMC150_ACCEL_DEF_SLOPE_DURATION ; + ret =bmc150_accel_update_slope (data); +if (ret <0 ) +return ret; + +/* Set default as latched interrupts */ + ret =i2c_smbus_write_byte_data (data->client, +BMC150_ACCEL_REG_INT_RST_LATCH , +BMC150_ACCEL_INT_MODE_LATCH_INT | +BMC150_ACCEL_INT_MODE_LATCH_RESET ); +if (ret <0 ) { +dev_err (&data->client->dev, +"Error writing reg_int_rst_latch\n" ); +return ret; + } + +return 0 ; +} +static int bmc150_accel_probe (struct i2c_client *client,const struct i2c_device_id *id) {