Re: [PATCH 1/3] iio: common: cros_ec_sensors: support protocol v3 message

From: Benson Leung
Date: Wed May 22 2019 - 15:21:02 EST

Next message: Loys Ollivier: "Re: [PATCH 1/6] arch: riscv: add support for building DTB files from DT source data"
Previous message: Bharath Vedartham: "[PATCH] 9p/cache.c: Fix memory leak in v9fs_cache_session_get_cookie"
In reply to: Gwendal Grignou: "Re: [PATCH 1/3] iio: common: cros_ec_sensors: support protocol v3 message"
Messages sorted by: [ date ] [ thread ] [ subject ] [ author ]

Hi Fabien,

On Wed, May 22, 2019 at 04:09:52PM +0200, Fabien Lahoudere wrote:
> Version 3 of the EC protocol provides min and max frequencies and fifo
> size for EC sensors.
>
> Signed-off-by: Fabien Lahoudere <fabien.lahoudere@xxxxxxxxxxxxx>

It looks like this is mainly based on patches from the chromium kernel:
https://chromium-review.googlesource.com/c/chromiumos/third_party/kernel/+/490495
and a subsequent revert of a revert:
https://chromium-review.googlesource.com/c/chromiumos/third_party/kernel/+/529686

originally by Nick Vaccaro <nvaccaro@xxxxxxxxxxxx>.
Please put links to that original work here, and include Nick in the
Signed-off-by. Also, don't forget to CC him when posting to the list.

Thanks,
Benson

> ---
> .../cros_ec_sensors/cros_ec_sensors_core.c | 98 ++++++++++++++++++-
> .../linux/iio/common/cros_ec_sensors_core.h | 7 ++
> include/linux/mfd/cros_ec_commands.h | 21 ++++
> 3 files changed, 125 insertions(+), 1 deletion(-)
>
> diff --git a/drivers/iio/common/cros_ec_sensors/cros_ec_sensors_core.c b/drivers/iio/common/cros_ec_sensors/cros_ec_sensors_core.c
> index 719a0df5aeeb..d5c8b4714ad6 100644
> --- a/drivers/iio/common/cros_ec_sensors/cros_ec_sensors_core.c
> +++ b/drivers/iio/common/cros_ec_sensors/cros_ec_sensors_core.c
> @@ -19,12 +19,84 @@
> #include <linux/slab.h>
> #include <linux/platform_device.h>
>
> +/*
> + * Hard coded to the first device to support sensor fifo. The EC has a 2048
> + * byte fifo and will trigger an interrupt when fifo is 2/3 full.
> + */
> +#define CROS_EC_FIFO_SIZE (2048 * 2 / 3)
> +
> static char *cros_ec_loc[] = {
> [MOTIONSENSE_LOC_BASE] = "base",
> [MOTIONSENSE_LOC_LID] = "lid",
> [MOTIONSENSE_LOC_MAX] = "unknown",
> };
>
> +static void get_default_min_max_freq_and_fifo_size(enum motionsensor_type type,
> + u32 *min_freq,
> + u32 *max_freq,
> + u32 *max_fifo_events)
> +{
> + /* we don't know fifo size, set to size previously used by sensor HAL */
> + *max_fifo_events = CROS_EC_FIFO_SIZE;
> +
> + switch (type) {
> + case MOTIONSENSE_TYPE_ACCEL:
> + case MOTIONSENSE_TYPE_GYRO:
> + *min_freq = 12500;
> + *max_freq = 100000;
> + break;
> + case MOTIONSENSE_TYPE_MAG:
> + *min_freq = 5000;
> + *max_freq = 25000;
> + break;
> + case MOTIONSENSE_TYPE_PROX:
> + case MOTIONSENSE_TYPE_LIGHT:
> + *min_freq = 100;
> + *max_freq = 50000;
> + break;
> + case MOTIONSENSE_TYPE_BARO:
> + *min_freq = 250;
> + *max_freq = 20000;
> + break;
> + case MOTIONSENSE_TYPE_ACTIVITY:
> + default:
> + *max_fifo_events = 0;
> + *min_freq = 0;
> + *max_freq = 0;
> + break;
> + }
> +}
> +
> +static int cros_ec_get_host_cmd_version_mask(struct cros_ec_device *ec_dev,
> + u16 cmd_offset, u16 cmd, u32 *mask)
> +{
> + struct {
> + struct cros_ec_command msg;
> + union {
> + struct ec_params_get_cmd_versions params;
> + struct ec_response_get_cmd_versions resp;
> + };
> + } __packed buf;
> + struct ec_params_get_cmd_versions *params = &buf.params;
> + struct ec_response_get_cmd_versions *resp = &buf.resp;
> + struct cros_ec_command *msg = &buf.msg;
> + int ret;
> +
> + memset(&buf, 0, sizeof(buf));
> + msg->command = EC_CMD_GET_CMD_VERSIONS + cmd_offset;
> + msg->insize = sizeof(*resp);
> + msg->outsize = sizeof(*params);
> + params->cmd = cmd;
> + ret = cros_ec_cmd_xfer_status(ec_dev, msg);
> + if (ret >= 0) {
> + if (msg->result == EC_RES_SUCCESS)
> + *mask = resp->version_mask;
> + else
> + *mask = 0;
> + }
> + return ret;
> +}
> +
> int cros_ec_sensors_core_init(struct platform_device *pdev,
> struct iio_dev *indio_dev,
> bool physical_device)
> @@ -33,6 +105,8 @@ int cros_ec_sensors_core_init(struct platform_device *pdev,
> struct cros_ec_sensors_core_state *state = iio_priv(indio_dev);
> struct cros_ec_dev *ec = dev_get_drvdata(pdev->dev.parent);
> struct cros_ec_sensor_platform *sensor_platform = dev_get_platdata(dev);
> + u32 ver_mask;
> + int ret;
>
> platform_set_drvdata(pdev, indio_dev);
>
> @@ -47,8 +121,16 @@ int cros_ec_sensors_core_init(struct platform_device *pdev,
>
> mutex_init(&state->cmd_lock);
>
> + /* determine what version of MOTIONSENSE CMD EC has */
> + ret = cros_ec_get_host_cmd_version_mask(state->ec,
> + ec->cmd_offset,
> + EC_CMD_MOTION_SENSE_CMD,
> + &ver_mask);
> + if (ret < 0 || ver_mask == 0)
> + return -ENODEV;
> +
> /* Set up the host command structure. */
> - state->msg->version = 2;
> + state->msg->version = fls(ver_mask) - 1;
> state->msg->command = EC_CMD_MOTION_SENSE_CMD + ec->cmd_offset;
> state->msg->outsize = sizeof(struct ec_params_motion_sense);
>
> @@ -66,6 +148,20 @@ int cros_ec_sensors_core_init(struct platform_device *pdev,
> }
> state->type = state->resp->info.type;
> state->loc = state->resp->info.location;
> + if (state->msg->version < 3) {
> + get_default_min_max_freq_and_fifo_size(
> + state->resp->info.type,
> + &state->min_freq,
> + &state->max_freq,
> + &state->fifo_max_event_count);
> + } else {
> + state->min_freq =
> + state->resp->info_3.min_frequency;
> + state->max_freq =
> + state->resp->info_3.max_frequency;
> + state->fifo_max_event_count =
> + state->resp->info_3.fifo_max_event_count;
> + }
> }
>
> return 0;
> diff --git a/include/linux/iio/common/cros_ec_sensors_core.h b/include/linux/iio/common/cros_ec_sensors_core.h
> index ce16445411ac..4742a9637a85 100644
> --- a/include/linux/iio/common/cros_ec_sensors_core.h
> +++ b/include/linux/iio/common/cros_ec_sensors_core.h
> @@ -78,6 +78,13 @@ struct cros_ec_sensors_core_state {
> unsigned long scan_mask, s16 *data);
>
> int curr_sampl_freq;
> +
> + /* Min and Max Sampling Frequency in mHz */
> + u32 min_freq;
> + u32 max_freq;
> +
> + /* event fifo size represented in number of events */
> + u32 fifo_max_event_count;
> };
>
> /**
> diff --git a/include/linux/mfd/cros_ec_commands.h b/include/linux/mfd/cros_ec_commands.h
> index dcec96f01879..27d71cbf22f1 100644
> --- a/include/linux/mfd/cros_ec_commands.h
> +++ b/include/linux/mfd/cros_ec_commands.h
> @@ -1744,6 +1744,27 @@ struct ec_response_motion_sense {
> uint8_t chip;
> } info;
>
> + /* Used for MOTIONSENSE_CMD_INFO version 3 */
> + struct __ec_todo_unpacked {
> + /* Should be element of enum motionsensor_type. */
> + uint8_t type;
> +
> + /* Should be element of enum motionsensor_location. */
> + uint8_t location;
> +
> + /* Should be element of enum motionsensor_chip. */
> + uint8_t chip;
> +
> + /* Minimum sensor sampling frequency */
> + uint32_t min_frequency;
> +
> + /* Maximum sensor sampling frequency */
> + uint32_t max_frequency;
> +
> + /* Max number of sensor events that could be in fifo */
> + uint32_t fifo_max_event_count;
> + } info_3;
> +
> /* Used for MOTIONSENSE_CMD_DATA */
> struct ec_response_motion_sensor_data data;
>
> --
> 2.20.1
>

--
Benson Leung
Staff Software Engineer
Chrome OS Kernel
Google Inc.
bleung@xxxxxxxxxx
Chromium OS Project
bleung@xxxxxxxxxxxx

Attachment: signature.asc
Description: PGP signature

Next message: Loys Ollivier: "Re: [PATCH 1/6] arch: riscv: add support for building DTB files from DT source data"
Previous message: Bharath Vedartham: "[PATCH] 9p/cache.c: Fix memory leak in v9fs_cache_session_get_cookie"
In reply to: Gwendal Grignou: "Re: [PATCH 1/3] iio: common: cros_ec_sensors: support protocol v3 message"
Messages sorted by: [ date ] [ thread ] [ subject ] [ author ]