Re: [PATCH v4 1/1] iio: common: cros_ec_sensors: determine protocol version
From: Fabien Lahoudere
Date: Tue Jul 16 2019 - 04:56:45 EST
Le dimanche 14 juillet 2019 Ã 17:19 +0100, Jonathan Cameron a Ãcrit :
> On Tue, 2 Jul 2019 10:49:38 +0200
> Fabien Lahoudere <fabien.lahoudere@xxxxxxxxxxxxx> wrote:
>
> > This patch adds a function to determine which version of the
> > protocol is used to communicate with EC.
> >
> > Signed-off-by: Fabien Lahoudere <fabien.lahoudere@xxxxxxxxxxxxx>
> > Signed-off-by: Nick Vaccaro <nvaccaro@xxxxxxxxxxxx>
> > Reviewed-by: Gwendal Grignou <gwendal@xxxxxxxxxxxx>
> > Tested-by: Gwendal Grignou <gwendal@xxxxxxxxxxxx>
> > Acked-by: Enric Balletbo i Serra <enric.balletbo@xxxxxxxxxxxxx>
> There are so many different series flying around for this driver that
> I have given up trying to figure out if I should be picking some of
> them up. I'll ack them on the assumption they'll all go together,
> but feel free to ping me if you want me to pick some of them up
> through IIO.
>
Yes sorry for all that confusing series.
Enric wanted this patch first and it is independant of others, so feel
free to pick it. Others patcheshave been sent separately.
Thanks
> Acked-by: Jonathan Cameron <Jonathan.Cameron@xxxxxxxxxx>
>
> Thanks,
>
> Jonathan
>
> > ---
> > .../cros_ec_sensors/cros_ec_sensors_core.c | 36
> > ++++++++++++++++++-
> > 1 file changed, 35 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 130362ca421b..81111af8a167 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
> > @@ -25,6 +25,31 @@ static char *cros_ec_loc[] = {
> > [MOTIONSENSE_LOC_MAX] = "unknown",
> > };
> >
> > +static int cros_ec_get_host_cmd_version_mask(struct cros_ec_device
> > *ec_dev,
> > + u16 cmd_offset, u16 cmd,
> > u32 *mask)
> > +{
> > + int ret;
> > + struct {
> > + struct cros_ec_command msg;
> > + union {
> > + struct ec_params_get_cmd_versions params;
> > + struct ec_response_get_cmd_versions resp;
> > + };
> > + } __packed buf = {
> > + .msg = {
> > + .command = EC_CMD_GET_CMD_VERSIONS +
> > cmd_offset,
> > + .insize = sizeof(struct
> > ec_response_get_cmd_versions),
> > + .outsize = sizeof(struct
> > ec_params_get_cmd_versions)
> > + },
> > + .params = {.cmd = cmd}
> > + };
> > +
> > + ret = cros_ec_cmd_xfer_status(ec_dev, &buf.msg);
> > + if (ret >= 0)
> > + *mask = buf.resp.version_mask;
> > + return ret;
> > +}
> > +
> > int cros_ec_sensors_core_init(struct platform_device *pdev,
> > struct iio_dev *indio_dev,
> > bool physical_device)
> > @@ -33,6 +58,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 +74,15 @@ int cros_ec_sensors_core_init(struct
> > platform_device *pdev,
> >
> > mutex_init(&state->cmd_lock);
> >
> > + ret = cros_ec_get_host_cmd_version_mask(state->ec,
> > + ec->cmd_offset,
> > + EC_CMD_MOTION_SENSE_CMD
> > ,
> > + &ver_mask);
> > + if (ret < 0)
> > + return ret;
> > +
> > /* 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);
> >