evie/android_kernel_oneplus_msm8998
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

staging:iio:hmc5843: Rewrite init function

Browse source 
Signed-off-by: Peter Meerwald <pmeerw@pmeerw.net>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>
This commit is contained in:
Peter Meerwald 2013-09-19 20:35:00 +01:00 • committed by Jonathan Cameron
parent 8a5c191324
commit 8e2e2971b0
1 changed files with 13 additions and 21 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

34
drivers/staging/iio/magnetometer/hmc5843.c
View file

@ -78,6 +78,7 @@ enum hmc5843_ids {
* HMC5883: Typical data output rate * HMC5883: Typical data output rate
*/ */
#define HMC5843_RATE_OFFSET 0x02 #define HMC5843_RATE_OFFSET 0x02
#define HMC5843_RATE_DEFAULT 0x04
#define HMC5843_RATE_BITMASK 0x1C #define HMC5843_RATE_BITMASK 0x1C
#define HMC5843_RATE_NOT_USED 0x07 #define HMC5843_RATE_NOT_USED 0x07
@ -599,23 +600,13 @@ static const struct hmc5843_chip_info hmc5843_chip_info_tbl[] = {
}, },
}; };
/* Called when we have found a new HMC58X3 */ static void hmc5843_init(struct hmc5843_data *data)
static void hmc5843_init_client(struct i2c_client *client,
const struct i2c_device_id *id)
{ {
struct iio_dev *indio_dev = i2c_get_clientdata(client); hmc5843_set_meas_conf(data, HMC5843_MEAS_CONF_NORMAL);
struct hmc5843_data *data = iio_priv(indio_dev); hmc5843_set_rate(data, HMC5843_RATE_DEFAULT);
hmc5843_configure(data->client, HMC5843_MODE_CONVERSION_CONTINUOUS);
data->variant = &hmc5843_chip_info_tbl[id->driver_data]; i2c_smbus_write_byte_data(data->client, HMC5843_CONFIG_REG_B,
indio_dev->channels = data->variant->channels; HMC5843_RANGE_GAIN_DEFAULT);
indio_dev->num_channels = 3;
hmc5843_set_meas_conf(data, data->meas_conf);
hmc5843_set_rate(data, data->rate);
hmc5843_configure(client, data->operating_mode);
i2c_smbus_write_byte_data(client, HMC5843_CONFIG_REG_B, data->range);
mutex_init(&data->lock);
pr_info("%s initialized\n", id->name);
} }
static const struct iio_info hmc5843_info = { static const struct iio_info hmc5843_info = {
@ -638,17 +629,18 @@ static int hmc5843_probe(struct i2c_client *client,
/* default settings at probe */ /* default settings at probe */
data = iio_priv(indio_dev); data = iio_priv(indio_dev);
data->client = client; data->client = client;
data->meas_conf = HMC5843_MEAS_CONF_NORMAL; data->variant = &hmc5843_chip_info_tbl[id->driver_data];
data->range = HMC5843_RANGE_GAIN_DEFAULT; mutex_init(&data->lock);
data->operating_mode = HMC5843_MODE_CONVERSION_CONTINUOUS;
i2c_set_clientdata(client, indio_dev); i2c_set_clientdata(client, indio_dev);
hmc5843_init_client(client, id);
indio_dev->info = &hmc5843_info; indio_dev->info = &hmc5843_info;
indio_dev->name = id->name; indio_dev->name = id->name;
indio_dev->dev.parent = &client->dev; indio_dev->dev.parent = &client->dev;
indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->modes = INDIO_DIRECT_MODE;
indio_dev->channels = data->variant->channels;
indio_dev->num_channels = 3;
hmc5843_init(data);
err = iio_device_register(indio_dev); err = iio_device_register(indio_dev);
if (err) if (err)