Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit a735e3d7 authored by Srinivas Pandruvada's avatar Srinivas Pandruvada Committed by Jonathan Cameron
Browse files

iio: accel: kxcjk-1013: Set adjustable range 



This chip can support 3 different ranges. Allowing range specification.

Signed-off-by: default avatarSrinivas Pandruvada <srinivas.pandruvada@linux.intel.com>
Signed-off-by: default avatarJonathan Cameron <jic23@kernel.org>
parent 124e1b1d

drivers/iio/accel/kxcjk-1013.c

+95 −5
Original line number Diff line number Diff line
@@ -82,6 +82,7 @@ struct kxcjk1013_data { 
	struct mutex mutex;

	s16 buffer[8];

	u8 odr_bits;

	u8 range;

	bool active_high_intr;

	bool trigger_on;

};
@@ -97,6 +98,12 @@ enum kxcjk1013_mode { 
	OPERATION,

};



enum kxcjk1013_range {

	KXCJK1013_RANGE_2G,

	KXCJK1013_RANGE_4G,

	KXCJK1013_RANGE_8G,

};



static const struct {

	int val;

	int val2;
@@ -116,6 +123,14 @@ static const struct { 
			   {0x02, 21000}, {0x03, 11000}, {0x04, 6400},

			   {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,

			      enum kxcjk1013_mode mode)

{
@@ -161,6 +176,32 @@ static int kxcjk1013_get_mode(struct kxcjk1013_data *data, 
	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)

{

	int ret;
@@ -183,10 +224,6 @@ static int kxcjk1013_chip_init(struct kxcjk1013_data *data) 
		return ret;

	}



	/* Setting range to 4G */

	ret |= KXCJK1013_REG_CTRL1_BIT_GSEL0;

	ret &= ~KXCJK1013_REG_CTRL1_BIT_GSEL1;



	/* Set 12 bit mode */

	ret |= KXCJK1013_REG_CTRL1_BIT_RES;
@@ -197,6 +234,14 @@ static int kxcjk1013_chip_init(struct kxcjk1013_data *data) 
		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);

	if (ret < 0) {

		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;

}



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,

			      struct iio_chan_spec const *chan, int *val,

			      int *val2, long mask)
@@ -439,7 +518,7 @@ static int kxcjk1013_read_raw(struct iio_dev *indio_dev, 


	case IIO_CHAN_INFO_SCALE:

		*val = 0;

		*val2 = 19163; /* range +-4g (4/2047*9.806650) */

		*val2 = KXCJK1013_scale_table[data->range].scale;

		return IIO_VAL_INT_PLUS_MICRO;



	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);

		mutex_unlock(&data->mutex);

		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:

		ret = -EINVAL;

	}
@@ -487,8 +574,11 @@ static int kxcjk1013_validate_trigger(struct iio_dev *indio_dev, 
static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(

	"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[] = {

	&iio_const_attr_sampling_frequency_available.dev_attr.attr,

	&iio_const_attr_in_accel_scale_available.dev_attr.attr,

	NULL,

};