提交 a36385a2 编写于 作者: D Daniel Baluta 提交者: Jonathan Cameron

iio: imu: kmx61: Drop odr_bits from kmx61_samp_freq_table

odr_bits values are between 0 and 11, so we can use the index
in kmx61_samp_freq_table instead of odr_bits structure member.
Signed-off-by: NDaniel Baluta <daniel.baluta@intel.com>
Reviewed-by: NHartmut Knaack <knaack.h@gmx.de>
Signed-off-by: NJonathan Cameron <jic23@kernel.org>
上级 1e716a15
...@@ -169,19 +169,18 @@ static const u16 kmx61_uscale_table[] = {9582, 19163, 38326}; ...@@ -169,19 +169,18 @@ static const u16 kmx61_uscale_table[] = {9582, 19163, 38326};
static const struct { static const struct {
int val; int val;
int val2; int val2;
u8 odr_bits; } kmx61_samp_freq_table[] = { {12, 500000},
} kmx61_samp_freq_table[] = { {12, 500000, 0x00}, {25, 0},
{25, 0, 0x01}, {50, 0},
{50, 0, 0x02}, {100, 0},
{100, 0, 0x03}, {200, 0},
{200, 0, 0x04}, {400, 0},
{400, 0, 0x05}, {800, 0},
{800, 0, 0x06}, {1600, 0},
{1600, 0, 0x07}, {0, 781000},
{0, 781000, 0x08}, {1, 563000},
{1, 563000, 0x09}, {3, 125000},
{3, 125000, 0x0A}, {6, 250000} };
{6, 250000, 0x0B} };
static const struct { static const struct {
int val; int val;
...@@ -302,24 +301,10 @@ static int kmx61_convert_freq_to_bit(int val, int val2) ...@@ -302,24 +301,10 @@ static int kmx61_convert_freq_to_bit(int val, int val2)
for (i = 0; i < ARRAY_SIZE(kmx61_samp_freq_table); i++) for (i = 0; i < ARRAY_SIZE(kmx61_samp_freq_table); i++)
if (val == kmx61_samp_freq_table[i].val && if (val == kmx61_samp_freq_table[i].val &&
val2 == kmx61_samp_freq_table[i].val2) val2 == kmx61_samp_freq_table[i].val2)
return kmx61_samp_freq_table[i].odr_bits; return i;
return -EINVAL;
}
static int kmx61_convert_bit_to_freq(u8 odr_bits, int *val, int *val2)
{
int i;
for (i = 0; i < ARRAY_SIZE(kmx61_samp_freq_table); i++)
if (odr_bits == kmx61_samp_freq_table[i].odr_bits) {
*val = kmx61_samp_freq_table[i].val;
*val2 = kmx61_samp_freq_table[i].val2;
return 0;
}
return -EINVAL; return -EINVAL;
} }
static int kmx61_convert_wake_up_odr_to_bit(int val, int val2) static int kmx61_convert_wake_up_odr_to_bit(int val, int val2)
{ {
int i; int i;
...@@ -478,7 +463,7 @@ static int kmx61_set_odr(struct kmx61_data *data, int val, int val2, u8 device) ...@@ -478,7 +463,7 @@ static int kmx61_set_odr(struct kmx61_data *data, int val, int val2, u8 device)
static int kmx61_get_odr(struct kmx61_data *data, int *val, int *val2, static int kmx61_get_odr(struct kmx61_data *data, int *val, int *val2,
u8 device) u8 device)
{ int i; {
u8 lodr_bits; u8 lodr_bits;
if (device & KMX61_ACC) if (device & KMX61_ACC)
...@@ -490,13 +475,13 @@ static int kmx61_get_odr(struct kmx61_data *data, int *val, int *val2, ...@@ -490,13 +475,13 @@ static int kmx61_get_odr(struct kmx61_data *data, int *val, int *val2,
else else
return -EINVAL; return -EINVAL;
for (i = 0; i < ARRAY_SIZE(kmx61_samp_freq_table); i++) if (lodr_bits >= ARRAY_SIZE(kmx61_samp_freq_table))
if (lodr_bits == kmx61_samp_freq_table[i].odr_bits) {
*val = kmx61_samp_freq_table[i].val;
*val2 = kmx61_samp_freq_table[i].val2;
return 0;
}
return -EINVAL; return -EINVAL;
*val = kmx61_samp_freq_table[lodr_bits].val;
*val2 = kmx61_samp_freq_table[lodr_bits].val2;
return 0;
} }
static int kmx61_set_range(struct kmx61_data *data, u8 range) static int kmx61_set_range(struct kmx61_data *data, u8 range)
...@@ -580,8 +565,11 @@ static int kmx61_chip_init(struct kmx61_data *data) ...@@ -580,8 +565,11 @@ static int kmx61_chip_init(struct kmx61_data *data)
} }
data->odr_bits = ret; data->odr_bits = ret;
/* set output data rate for wake up (motion detection) function */ /*
ret = kmx61_convert_bit_to_freq(data->odr_bits, &val, &val2); * set output data rate for wake up (motion detection) function
* to match data rate for accelerometer sampling
*/
ret = kmx61_get_odr(data, &val, &val2, KMX61_ACC);
if (ret < 0) if (ret < 0)
return ret; return ret;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册