iio: accel: kxcjk-1013: Set adjustable range
This chip can support 3 different ranges. Allowing range specification. Signed-off-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
This commit is contained in:
parent
124e1b1d09
commit
a735e3d7f0
|
@ -82,6 +82,7 @@ struct kxcjk1013_data {
|
||||||
struct mutex mutex;
|
struct mutex mutex;
|
||||||
s16 buffer[8];
|
s16 buffer[8];
|
||||||
u8 odr_bits;
|
u8 odr_bits;
|
||||||
|
u8 range;
|
||||||
bool active_high_intr;
|
bool active_high_intr;
|
||||||
bool trigger_on;
|
bool trigger_on;
|
||||||
};
|
};
|
||||||
|
@ -97,6 +98,12 @@ enum kxcjk1013_mode {
|
||||||
OPERATION,
|
OPERATION,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
enum kxcjk1013_range {
|
||||||
|
KXCJK1013_RANGE_2G,
|
||||||
|
KXCJK1013_RANGE_4G,
|
||||||
|
KXCJK1013_RANGE_8G,
|
||||||
|
};
|
||||||
|
|
||||||
static const struct {
|
static const struct {
|
||||||
int val;
|
int val;
|
||||||
int val2;
|
int val2;
|
||||||
|
@ -116,6 +123,14 @@ static const struct {
|
||||||
{0x02, 21000}, {0x03, 11000}, {0x04, 6400},
|
{0x02, 21000}, {0x03, 11000}, {0x04, 6400},
|
||||||
{0x05, 3900}, {0x06, 2700}, {0x07, 2100} };
|
{0x05, 3900}, {0x06, 2700}, {0x07, 2100} };
|
||||||
|
|
||||||
|
static const struct {
|
||||||
|
u16 scale;
|
||||||
|
u8 gsel_0;
|
||||||
|
u8 gsel_1;
|
||||||
|
} KXCJK1013_scale_table[] = { {9582, 0, 0},
|
||||||
|
{19163, 1, 0},
|
||||||
|
{38326, 0, 1} };
|
||||||
|
|
||||||
static int kxcjk1013_set_mode(struct kxcjk1013_data *data,
|
static int kxcjk1013_set_mode(struct kxcjk1013_data *data,
|
||||||
enum kxcjk1013_mode mode)
|
enum kxcjk1013_mode mode)
|
||||||
{
|
{
|
||||||
|
@ -161,6 +176,32 @@ static int kxcjk1013_get_mode(struct kxcjk1013_data *data,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int kxcjk1013_set_range(struct kxcjk1013_data *data, int range_index)
|
||||||
|
{
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
|
||||||
|
if (ret < 0) {
|
||||||
|
dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret |= (KXCJK1013_scale_table[range_index].gsel_0 << 3);
|
||||||
|
ret |= (KXCJK1013_scale_table[range_index].gsel_1 << 4);
|
||||||
|
|
||||||
|
ret = i2c_smbus_write_byte_data(data->client,
|
||||||
|
KXCJK1013_REG_CTRL1,
|
||||||
|
ret);
|
||||||
|
if (ret < 0) {
|
||||||
|
dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
data->range = range_index;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static int kxcjk1013_chip_init(struct kxcjk1013_data *data)
|
static int kxcjk1013_chip_init(struct kxcjk1013_data *data)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
|
@ -183,10 +224,6 @@ static int kxcjk1013_chip_init(struct kxcjk1013_data *data)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Setting range to 4G */
|
|
||||||
ret |= KXCJK1013_REG_CTRL1_BIT_GSEL0;
|
|
||||||
ret &= ~KXCJK1013_REG_CTRL1_BIT_GSEL1;
|
|
||||||
|
|
||||||
/* Set 12 bit mode */
|
/* Set 12 bit mode */
|
||||||
ret |= KXCJK1013_REG_CTRL1_BIT_RES;
|
ret |= KXCJK1013_REG_CTRL1_BIT_RES;
|
||||||
|
|
||||||
|
@ -197,6 +234,14 @@ static int kxcjk1013_chip_init(struct kxcjk1013_data *data)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* Setting range to 4G */
|
||||||
|
ret = kxcjk1013_set_range(data, KXCJK1013_RANGE_4G);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
data->range = KXCJK1013_RANGE_4G;
|
||||||
|
|
||||||
|
|
||||||
ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_DATA_CTRL);
|
ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_DATA_CTRL);
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(&data->client->dev, "Error reading reg_data_ctrl\n");
|
dev_err(&data->client->dev, "Error reading reg_data_ctrl\n");
|
||||||
|
@ -403,6 +448,40 @@ static int kxcjk1013_get_acc_reg(struct kxcjk1013_data *data, int axis)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int kxcjk1013_set_scale(struct kxcjk1013_data *data, int val)
|
||||||
|
{
|
||||||
|
int ret, i;
|
||||||
|
enum kxcjk1013_mode store_mode;
|
||||||
|
|
||||||
|
|
||||||
|
for (i = 0; i < ARRAY_SIZE(KXCJK1013_scale_table); ++i) {
|
||||||
|
if (KXCJK1013_scale_table[i].scale == val) {
|
||||||
|
|
||||||
|
ret = kxcjk1013_get_mode(data, &store_mode);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
ret = kxcjk1013_set_mode(data, STANDBY);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
ret = kxcjk1013_set_range(data, i);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
if (store_mode == OPERATION) {
|
||||||
|
ret = kxcjk1013_set_mode(data, OPERATION);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
static int kxcjk1013_read_raw(struct iio_dev *indio_dev,
|
static int kxcjk1013_read_raw(struct iio_dev *indio_dev,
|
||||||
struct iio_chan_spec const *chan, int *val,
|
struct iio_chan_spec const *chan, int *val,
|
||||||
int *val2, long mask)
|
int *val2, long mask)
|
||||||
|
@ -439,7 +518,7 @@ static int kxcjk1013_read_raw(struct iio_dev *indio_dev,
|
||||||
|
|
||||||
case IIO_CHAN_INFO_SCALE:
|
case IIO_CHAN_INFO_SCALE:
|
||||||
*val = 0;
|
*val = 0;
|
||||||
*val2 = 19163; /* range +-4g (4/2047*9.806650) */
|
*val2 = KXCJK1013_scale_table[data->range].scale;
|
||||||
return IIO_VAL_INT_PLUS_MICRO;
|
return IIO_VAL_INT_PLUS_MICRO;
|
||||||
|
|
||||||
case IIO_CHAN_INFO_SAMP_FREQ:
|
case IIO_CHAN_INFO_SAMP_FREQ:
|
||||||
|
@ -466,6 +545,14 @@ static int kxcjk1013_write_raw(struct iio_dev *indio_dev,
|
||||||
ret = kxcjk1013_set_odr(data, val, val2);
|
ret = kxcjk1013_set_odr(data, val, val2);
|
||||||
mutex_unlock(&data->mutex);
|
mutex_unlock(&data->mutex);
|
||||||
break;
|
break;
|
||||||
|
case IIO_CHAN_INFO_SCALE:
|
||||||
|
if (val)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
mutex_lock(&data->mutex);
|
||||||
|
ret = kxcjk1013_set_scale(data, val2);
|
||||||
|
mutex_unlock(&data->mutex);
|
||||||
|
break;
|
||||||
default:
|
default:
|
||||||
ret = -EINVAL;
|
ret = -EINVAL;
|
||||||
}
|
}
|
||||||
|
@ -487,8 +574,11 @@ static int kxcjk1013_validate_trigger(struct iio_dev *indio_dev,
|
||||||
static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(
|
static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(
|
||||||
"0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800 1600");
|
"0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800 1600");
|
||||||
|
|
||||||
|
static IIO_CONST_ATTR(in_accel_scale_available, "0.009582 0.019163 0.038326");
|
||||||
|
|
||||||
static struct attribute *kxcjk1013_attributes[] = {
|
static struct attribute *kxcjk1013_attributes[] = {
|
||||||
&iio_const_attr_sampling_frequency_available.dev_attr.attr,
|
&iio_const_attr_sampling_frequency_available.dev_attr.attr,
|
||||||
|
&iio_const_attr_in_accel_scale_available.dev_attr.attr,
|
||||||
NULL,
|
NULL,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue