Commit 83ec2d54 authored by Stefan Popa's avatar Stefan Popa Committed by Jonathan Cameron

iio: imu: adis16480: Deal with filter freq in a generic way

When setting the filter frequency, the driver looks into the
adis16480_def_filter_freqs table for the best match. Pass this table to
the chip_info struct since future devices will need to use a different
table.
Signed-off-by: default avatarStefan Popa <stefan.popa@analog.com>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent e0e6398e
...@@ -127,6 +127,7 @@ struct adis16480_chip_info { ...@@ -127,6 +127,7 @@ struct adis16480_chip_info {
unsigned int temp_scale; unsigned int temp_scale;
unsigned int int_clk; unsigned int int_clk;
unsigned int max_dec_rate; unsigned int max_dec_rate;
const unsigned int *filter_freqs;
}; };
enum adis16480_int_pin { enum adis16480_int_pin {
...@@ -483,7 +484,7 @@ static int adis16480_get_filter_freq(struct iio_dev *indio_dev, ...@@ -483,7 +484,7 @@ static int adis16480_get_filter_freq(struct iio_dev *indio_dev,
if (!(val & enable_mask)) if (!(val & enable_mask))
*freq = 0; *freq = 0;
else else
*freq = adis16480_def_filter_freqs[(val >> offset) & 0x3]; *freq = st->chip_info->filter_freqs[(val >> offset) & 0x3];
return IIO_VAL_INT; return IIO_VAL_INT;
} }
...@@ -510,10 +511,10 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev, ...@@ -510,10 +511,10 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev,
val &= ~enable_mask; val &= ~enable_mask;
} else { } else {
best_freq = 0; best_freq = 0;
best_diff = 310; best_diff = st->chip_info->filter_freqs[0];
for (i = 0; i < ARRAY_SIZE(adis16480_def_filter_freqs); i++) { for (i = 0; i < ARRAY_SIZE(adis16480_def_filter_freqs); i++) {
if (adis16480_def_filter_freqs[i] >= freq) { if (st->chip_info->filter_freqs[i] >= freq) {
diff = adis16480_def_filter_freqs[i] - freq; diff = st->chip_info->filter_freqs[i] - freq;
if (diff < best_diff) { if (diff < best_diff) {
best_diff = diff; best_diff = diff;
best_freq = i; best_freq = i;
...@@ -730,6 +731,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = { ...@@ -730,6 +731,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = {
.temp_scale = 5650, /* 5.65 milli degree Celsius */ .temp_scale = 5650, /* 5.65 milli degree Celsius */
.int_clk = 2460000, .int_clk = 2460000,
.max_dec_rate = 2048, .max_dec_rate = 2048,
.filter_freqs = adis16480_def_filter_freqs,
}, },
[ADIS16480] = { [ADIS16480] = {
.channels = adis16480_channels, .channels = adis16480_channels,
...@@ -741,6 +743,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = { ...@@ -741,6 +743,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = {
.temp_scale = 5650, /* 5.65 milli degree Celsius */ .temp_scale = 5650, /* 5.65 milli degree Celsius */
.int_clk = 2460000, .int_clk = 2460000,
.max_dec_rate = 2048, .max_dec_rate = 2048,
.filter_freqs = adis16480_def_filter_freqs,
}, },
[ADIS16485] = { [ADIS16485] = {
.channels = adis16485_channels, .channels = adis16485_channels,
...@@ -752,6 +755,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = { ...@@ -752,6 +755,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = {
.temp_scale = 5650, /* 5.65 milli degree Celsius */ .temp_scale = 5650, /* 5.65 milli degree Celsius */
.int_clk = 2460000, .int_clk = 2460000,
.max_dec_rate = 2048, .max_dec_rate = 2048,
.filter_freqs = adis16480_def_filter_freqs,
}, },
[ADIS16488] = { [ADIS16488] = {
.channels = adis16480_channels, .channels = adis16480_channels,
...@@ -763,6 +767,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = { ...@@ -763,6 +767,7 @@ static const struct adis16480_chip_info adis16480_chip_info[] = {
.temp_scale = 5650, /* 5.65 milli degree Celsius */ .temp_scale = 5650, /* 5.65 milli degree Celsius */
.int_clk = 2460000, .int_clk = 2460000,
.max_dec_rate = 2048, .max_dec_rate = 2048,
.filter_freqs = adis16480_def_filter_freqs,
}, },
}; };
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment