iio: cros_ec: Use Hertz as unit for sampling frequency

To be compliant with other sensors, set and get sensor sampling
frequency in Hz, not mHz.

Fixes: ae7b02ad2f ("iio: common: cros_ec_sensors: Expose cros_ec_sensors frequency range via iio sysfs")
Signed-off-by: Gwendal Grignou <gwendal@chromium.org>
Acked-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
Signed-off-by: Enric Balletbo i Serra <enric.balletbo@collabora.com>
This commit is contained in:
Gwendal Grignou 2020-03-27 15:34:42 -07:00 committed by Enric Balletbo i Serra
parent cb87556068
commit 317a0ebe53
2 changed files with 22 additions and 16 deletions

View File

@ -253,6 +253,7 @@ int cros_ec_sensors_core_init(struct platform_device *pdev,
struct cros_ec_dev *ec = sensor_hub->ec; struct cros_ec_dev *ec = sensor_hub->ec;
struct cros_ec_sensor_platform *sensor_platform = dev_get_platdata(dev); struct cros_ec_sensor_platform *sensor_platform = dev_get_platdata(dev);
u32 ver_mask; u32 ver_mask;
int frequencies[ARRAY_SIZE(state->frequencies) / 2] = { 0 };
int ret, i; int ret, i;
platform_set_drvdata(pdev, indio_dev); platform_set_drvdata(pdev, indio_dev);
@ -301,20 +302,22 @@ int cros_ec_sensors_core_init(struct platform_device *pdev,
state->calib[i].scale = MOTION_SENSE_DEFAULT_SCALE; state->calib[i].scale = MOTION_SENSE_DEFAULT_SCALE;
/* 0 is a correct value used to stop the device */ /* 0 is a correct value used to stop the device */
state->frequencies[0] = 0;
if (state->msg->version < 3) { if (state->msg->version < 3) {
get_default_min_max_freq(state->resp->info.type, get_default_min_max_freq(state->resp->info.type,
&state->frequencies[1], &frequencies[1],
&state->frequencies[2], &frequencies[2],
&state->fifo_max_event_count); &state->fifo_max_event_count);
} else { } else {
state->frequencies[1] = frequencies[1] = state->resp->info_3.min_frequency;
state->resp->info_3.min_frequency; frequencies[2] = state->resp->info_3.max_frequency;
state->frequencies[2] =
state->resp->info_3.max_frequency;
state->fifo_max_event_count = state->fifo_max_event_count =
state->resp->info_3.fifo_max_event_count; state->resp->info_3.fifo_max_event_count;
} }
for (i = 0; i < ARRAY_SIZE(frequencies); i++) {
state->frequencies[2 * i] = frequencies[i] / 1000;
state->frequencies[2 * i + 1] =
(frequencies[i] % 1000) * 1000;
}
if (cros_ec_check_features(ec, EC_FEATURE_MOTION_SENSE_FIFO)) { if (cros_ec_check_features(ec, EC_FEATURE_MOTION_SENSE_FIFO)) {
/* /*
@ -728,7 +731,7 @@ int cros_ec_sensors_core_read(struct cros_ec_sensors_core_state *st,
struct iio_chan_spec const *chan, struct iio_chan_spec const *chan,
int *val, int *val2, long mask) int *val, int *val2, long mask)
{ {
int ret; int ret, frequency;
switch (mask) { switch (mask) {
case IIO_CHAN_INFO_SAMP_FREQ: case IIO_CHAN_INFO_SAMP_FREQ:
@ -740,8 +743,10 @@ int cros_ec_sensors_core_read(struct cros_ec_sensors_core_state *st,
if (ret) if (ret)
break; break;
*val = st->resp->sensor_odr.ret; frequency = st->resp->sensor_odr.ret;
ret = IIO_VAL_INT; *val = frequency / 1000;
*val2 = (frequency % 1000) * 1000;
ret = IIO_VAL_INT_PLUS_MICRO;
break; break;
default: default:
ret = -EINVAL; ret = -EINVAL;
@ -776,7 +781,7 @@ int cros_ec_sensors_core_read_avail(struct iio_dev *indio_dev,
case IIO_CHAN_INFO_SAMP_FREQ: case IIO_CHAN_INFO_SAMP_FREQ:
*length = ARRAY_SIZE(state->frequencies); *length = ARRAY_SIZE(state->frequencies);
*vals = (const int *)&state->frequencies; *vals = (const int *)&state->frequencies;
*type = IIO_VAL_INT; *type = IIO_VAL_INT_PLUS_MICRO;
return IIO_AVAIL_LIST; return IIO_AVAIL_LIST;
} }
@ -798,12 +803,13 @@ int cros_ec_sensors_core_write(struct cros_ec_sensors_core_state *st,
struct iio_chan_spec const *chan, struct iio_chan_spec const *chan,
int val, int val2, long mask) int val, int val2, long mask)
{ {
int ret; int ret, frequency;
switch (mask) { switch (mask) {
case IIO_CHAN_INFO_SAMP_FREQ: case IIO_CHAN_INFO_SAMP_FREQ:
frequency = val * 1000 + val2 / 1000;
st->param.cmd = MOTIONSENSE_CMD_SENSOR_ODR; st->param.cmd = MOTIONSENSE_CMD_SENSOR_ODR;
st->param.sensor_odr.data = val; st->param.sensor_odr.data = frequency;
/* Always roundup, so caller gets at least what it asks for. */ /* Always roundup, so caller gets at least what it asks for. */
st->param.sensor_odr.roundup = 1; st->param.sensor_odr.roundup = 1;

View File

@ -51,6 +51,8 @@ typedef irqreturn_t (*cros_ec_sensors_capture_t)(int irq, void *p);
* is always 8-byte aligned. * is always 8-byte aligned.
* @read_ec_sensors_data: function used for accessing sensors values * @read_ec_sensors_data: function used for accessing sensors values
* @fifo_max_event_count: Size of the EC sensor FIFO * @fifo_max_event_count: Size of the EC sensor FIFO
* @frequencies: Table of known available frequencies:
* 0, Min and Max in mHz
*/ */
struct cros_ec_sensors_core_state { struct cros_ec_sensors_core_state {
struct cros_ec_device *ec; struct cros_ec_device *ec;
@ -74,9 +76,7 @@ struct cros_ec_sensors_core_state {
unsigned long scan_mask, s16 *data); unsigned long scan_mask, s16 *data);
u32 fifo_max_event_count; u32 fifo_max_event_count;
int frequencies[6];
/* Table of known available frequencies : 0, Min and Max in mHz */
int frequencies[3];
}; };
int cros_ec_sensors_read_lpc(struct iio_dev *indio_dev, unsigned long scan_mask, int cros_ec_sensors_read_lpc(struct iio_dev *indio_dev, unsigned long scan_mask,