[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-ID: <20201030133114.GE2333887@kuha.fi.intel.com>
Date: Fri, 30 Oct 2020 15:31:14 +0200
From: Heikki Krogerus <heikki.krogerus@...ux.intel.com>
To: Prashant Malani <pmalani@...omium.org>
Cc: linux-kernel@...r.kernel.org, dzigterman@...omium.org,
alevkoy@...omium.org, Benson Leung <bleung@...omium.org>,
Enric Balletbo i Serra <enric.balletbo@...labora.com>,
Guenter Roeck <groeck@...omium.org>
Subject: Re: [PATCH v2 6/7] platform/chrome: cros_ec_typec: Parse partner PD
ID VDOs
On Thu, Oct 29, 2020 at 03:27:40PM -0700, Prashant Malani wrote:
> Use EC_CMD_TYPE_DISCOVERY to retrieve and store the discovery data for
> the port partner. With that data, update the PD Identity VDO values for
> the partner, which were earlier not initialized.
>
> Cc: Heikki Krogerus <heikki.krogerus@...ux.intel.com>
> Signed-off-by: Prashant Malani <pmalani@...omium.org>
FWIW:
Acked-by: Heikki Krogerus <heikki.krogerus@...ux.intel.com>
> ---
>
> Changes in v2:
> - No changes
>
> drivers/platform/chrome/cros_ec_typec.c | 60 ++++++++++++++++++++++++-
> 1 file changed, 59 insertions(+), 1 deletion(-)
>
> diff --git a/drivers/platform/chrome/cros_ec_typec.c b/drivers/platform/chrome/cros_ec_typec.c
> index f578d0bfbe5a..f14550dac614 100644
> --- a/drivers/platform/chrome/cros_ec_typec.c
> +++ b/drivers/platform/chrome/cros_ec_typec.c
> @@ -14,6 +14,7 @@
> #include <linux/platform_data/cros_usbpd_notify.h>
> #include <linux/platform_device.h>
> #include <linux/usb/pd.h>
> +#include <linux/usb/pd_vdo.h>
> #include <linux/usb/typec.h>
> #include <linux/usb/typec_altmode.h>
> #include <linux/usb/typec_dp.h>
> @@ -51,6 +52,7 @@ struct cros_typec_port {
>
> /* Flag indicating that PD discovery data parsing is completed. */
> bool disc_done;
> + struct ec_response_typec_discovery *sop_disc;
> };
>
> /* Platform-specific data for the Chrome OS EC Type C controller. */
> @@ -298,6 +300,12 @@ static int cros_typec_init_ports(struct cros_typec_data *typec)
> port_num);
>
> cros_typec_register_port_altmodes(typec, port_num);
> +
> + cros_port->sop_disc = devm_kzalloc(dev, EC_PROTO2_MAX_RESPONSE_SIZE, GFP_KERNEL);
> + if (!cros_port->sop_disc) {
> + ret = -ENOMEM;
> + goto unregister_ports;
> + }
> }
>
> return 0;
> @@ -582,6 +590,51 @@ static int cros_typec_get_mux_info(struct cros_typec_data *typec, int port_num,
> sizeof(req), resp, sizeof(*resp));
> }
>
> +static int cros_typec_handle_sop_disc(struct cros_typec_data *typec, int port_num)
> +{
> + struct cros_typec_port *port = typec->ports[port_num];
> + struct ec_response_typec_discovery *sop_disc = port->sop_disc;
> + struct ec_params_typec_discovery req = {
> + .port = port_num,
> + .partner_type = TYPEC_PARTNER_SOP,
> + };
> + int ret = 0;
> + int i;
> +
> + if (!port->partner) {
> + dev_err(typec->dev,
> + "SOP Discovery received without partner registered, port: %d\n",
> + port_num);
> + ret = -EINVAL;
> + goto disc_exit;
> + }
> +
> + memset(sop_disc, 0, EC_PROTO2_MAX_RESPONSE_SIZE);
> + ret = cros_typec_ec_command(typec, 0, EC_CMD_TYPEC_DISCOVERY, &req, sizeof(req),
> + sop_disc, EC_PROTO2_MAX_RESPONSE_SIZE);
> + if (ret < 0) {
> + dev_err(typec->dev, "Failed to get SOP discovery data for port: %d\n", port_num);
> + goto disc_exit;
> + }
> +
> + /* First, update the PD identity VDOs for the partner. */
> + if (sop_disc->identity_count > 0)
> + port->p_identity.id_header = sop_disc->discovery_vdo[0];
> + if (sop_disc->identity_count > 1)
> + port->p_identity.cert_stat = sop_disc->discovery_vdo[1];
> + if (sop_disc->identity_count > 2)
> + port->p_identity.product = sop_disc->discovery_vdo[2];
> +
> + /* Copy the remaining identity VDOs till a maximum of 6. */
> + for (i = 3; i < sop_disc->identity_count && i < VDO_MAX_OBJECTS; i++)
> + port->p_identity.vdo[i - 3] = sop_disc->discovery_vdo[i];
> +
> + ret = typec_partner_set_identity(port->partner);
> +
> +disc_exit:
> + return ret;
> +}
> +
> static void cros_typec_handle_status(struct cros_typec_data *typec, int port_num)
> {
> struct ec_response_typec_status resp;
> @@ -602,7 +655,12 @@ static void cros_typec_handle_status(struct cros_typec_data *typec, int port_num
>
> /* Handle any events appropriately. */
> if (resp.events & PD_STATUS_EVENT_SOP_DISC_DONE) {
> - dev_dbg(typec->dev, "SOP Discovery done for port: %d\n", port_num);
> + ret = cros_typec_handle_sop_disc(typec, port_num);
> + if (ret < 0) {
> + dev_err(typec->dev, "Couldn't parse SOP Disc data, port: %d\n", port_num);
> + return;
> + }
> +
> typec->ports[port_num]->disc_done = true;
> }
> }
thanks,
--
heikki
Powered by blists - more mailing lists