All of lore.kernel.org
 help / color / mirror / Atom feed
* [5/5] usb: typec: ucsi: Support for DisplayPort alt mode
@ 2019-02-06  8:32 Heikki Krogerus
  0 siblings, 0 replies; 5+ messages in thread
From: Heikki Krogerus @ 2019-02-06  8:32 UTC (permalink / raw)
  To: Ajay Gupta; +Cc: Greg Kroah-Hartman, Michael Hsu, linux-usb

Hi,

On Tue, Feb 05, 2019 at 01:03:58AM +0000, Ajay Gupta wrote:
> > @@ -412,6 +424,12 @@ static void ucsi_unregister_altmodes(struct
> > ucsi_connector *con, u8 recipient)
> >  	}
> > 
> >  	while (adev[i]) {
> > +		if (recipient == UCSI_RECIPIENT_SOP &&
> > +		    adev[i]->svid == USB_TYPEC_DP_SID) {
> > +			alt = typec_match_altmode(con->port_altmode, -1,
> > +						  USB_TYPEC_DP_SID, 1);
> > +			ucsi_displayport_remove_partner(alt);
> "alt" may be null here in cases where attached type-C device has DP alt mode which is not supported
> by connector. Please change as
> 			If (alt)
> 				ucsi_displayport_remove_partner(alt);

That should not be necessary. Check ucsi_displayport_remove_partner().
I put a condition there if (!alt) return;


thanks,

^ permalink raw reply	[flat|nested] 5+ messages in thread

* [5/5] usb: typec: ucsi: Support for DisplayPort alt mode
@ 2019-02-06  8:46 Heikki Krogerus
  0 siblings, 0 replies; 5+ messages in thread
From: Heikki Krogerus @ 2019-02-06  8:46 UTC (permalink / raw)
  To: Ajay Gupta; +Cc: Greg Kroah-Hartman, Michael Hsu, linux-usb

Hi Ajay,

On Tue, Feb 05, 2019 at 07:24:49PM +0000, Ajay Gupta wrote:
> > +static int ucsi_displayport_configure(struct ucsi_dp *dp) {
> > +	u32 pins = DP_CONF_GET_PIN_ASSIGN(dp->data.conf);
> > +	struct ucsi_control ctrl;
> > +
> > +	if (!dp->override)
> > +		return 0;
> > +
> > +	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 1, dp-
> > >offset,
> > +pins);
> If previous CAM is active at this point then we should exit before setting new
> CAM. Please add something like :
> 
> +	if (!dp->override)
> +		return 0;
> 
>         UCSI_CMD_GET_CURRENT_CAM(ctrl, dp->con->num);
>         ret = ucsi_send_command(dp->con->ucsi, &ctrl, &cur, sizeof(cur));
>         while ((cur != 0xff) && (cur != dp->offset)) {
>                 ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 0, cur, 0);
>                 ret = ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0);
>                 UCSI_CMD_GET_CURRENT_CAM(ctrl, dp->con->num);
>                 ret = ucsi_send_command(dp->con->ucsi, &ctrl, &cur, sizeof(cur));
>         }
> +	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 1, dp-

I'll take a look at this before preparing the next version.


thanks,

^ permalink raw reply	[flat|nested] 5+ messages in thread

* [5/5] usb: typec: ucsi: Support for DisplayPort alt mode
@ 2019-02-05 19:24 Ajay Gupta
  0 siblings, 0 replies; 5+ messages in thread
From: Ajay Gupta @ 2019-02-05 19:24 UTC (permalink / raw)
  To: Heikki Krogerus, Greg Kroah-Hartman, Michael Hsu; +Cc: linux-usb

Hi Heikki,

> -----Original Message-----
> From: linux-usb-owner@vger.kernel.org <linux-usb-owner@vger.kernel.org> On
> Behalf Of Heikki Krogerus
> Sent: Friday, February 1, 2019 2:48 AM
> To: Greg Kroah-Hartman <gregkh@linuxfoundation.org>; Ajay Gupta
> <ajayg@nvidia.com>; Michael Hsu <mhsu@nvidia.com>
> Cc: linux-usb@vger.kernel.org
> Subject: [PATCH 5/5] usb: typec: ucsi: Support for DisplayPort alt mode
> 
> This makes it possible to bind a driver to a DisplayPort alt mode adapter devices.
> 
> The driver attempts to cope with the limitations of UCSI by "emulating"
> behaviour and attempting to guess things when ever possible in order to satisfy
> the requirements the standard DisplayPort alt mode driver has.
> 
> Signed-off-by: Heikki Krogerus <heikki.krogerus@linux.intel.com>
> ---
>  drivers/usb/typec/ucsi/Makefile      |  15 +-
>  drivers/usb/typec/ucsi/displayport.c | 301 +++++++++++++++++++++++++++
>  drivers/usb/typec/ucsi/ucsi.c        |  22 +-
>  drivers/usb/typec/ucsi/ucsi.h        |  21 ++
>  4 files changed, 351 insertions(+), 8 deletions(-)  create mode 100644
> drivers/usb/typec/ucsi/displayport.c
> 
> diff --git a/drivers/usb/typec/ucsi/Makefile b/drivers/usb/typec/ucsi/Makefile
> index 2f4900b26210..b35e15a1f02c 100644
> --- a/drivers/usb/typec/ucsi/Makefile
> +++ b/drivers/usb/typec/ucsi/Makefile
> @@ -1,12 +1,15 @@
>  # SPDX-License-Identifier: GPL-2.0
> -CFLAGS_trace.o			:= -I$(src)
> +CFLAGS_trace.o				:= -I$(src)
> 
> -obj-$(CONFIG_TYPEC_UCSI)	+= typec_ucsi.o
> +obj-$(CONFIG_TYPEC_UCSI)		+= typec_ucsi.o
> 
> -typec_ucsi-y			:= ucsi.o
> +typec_ucsi-y				:= ucsi.o
> 
> -typec_ucsi-$(CONFIG_TRACING)	+= trace.o
> +typec_ucsi-$(CONFIG_TRACING)		+= trace.o
> 
> -obj-$(CONFIG_UCSI_ACPI)		+= ucsi_acpi.o
> +ifneq ($(CONFIG_TYPEC_DP_ALTMODE),)
> +	typec_ucsi-y			+= displayport.o
> +endif
> 
> -obj-$(CONFIG_UCSI_CCG)		+= ucsi_ccg.o
> +obj-$(CONFIG_UCSI_ACPI)			+= ucsi_acpi.o
> +obj-$(CONFIG_UCSI_CCG)			+= ucsi_ccg.o
> diff --git a/drivers/usb/typec/ucsi/displayport.c
> b/drivers/usb/typec/ucsi/displayport.c
> new file mode 100644
> index 000000000000..3c5312cc7130
> --- /dev/null
> +++ b/drivers/usb/typec/ucsi/displayport.c
> @@ -0,0 +1,301 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * UCSI DisplayPort Alternate Mode Support
> + *
> + * Copyright (C) 2018, Intel Corporation
> + * Author: Heikki Krogerus <heikki.krogerus@linux.intel.com>  */
> +
> +#include <linux/usb/typec_dp.h>
> +#include <linux/usb/pd_vdo.h>
> +
> +#include "ucsi.h"
> +
> +#define UCSI_CMD_SET_NEW_CAM(_con_num_, _enter_, _cam_, _am_)
> 		\
> +	 (UCSI_SET_NEW_CAM | ((_con_num_) << 16) | ((_enter_) << 23) |
> 	\
> +	  ((_cam_) << 24) | ((u64)(_am_) << 32))
> +
> +struct ucsi_dp {
> +	struct typec_displayport_data data;
> +	struct ucsi_connector *con;
> +	struct typec_altmode *alt;
> +	struct work_struct work;
> +	int offset;
> +
> +	bool override;
> +	bool initialized;
> +
> +	u32 header;
> +	u32 *vdo_data;
> +	u8 vdo_size;
> +};
> +
> +/*
> + * Note. Alternate mode control is optional feature in UCSI. It means
> +that even
> + * if the system supports alternate modes, the OS may not be aware of them.
> + *
> + * In most cases however, the OS will be able to see the supported
> +alternate
> + * modes, but it may still not be able to configure them, not even
> +enter or exit
> + * them. That is because UCSI defines alt mode details and alt mode
> "overriding"
> + * as separate options.
> + *
> + * In case alt mode details are supported, but overriding is not, the
> +driver
> + * will still display the supported pin assignments and configuration,
> +but any
> + * changes the user attempts to do will lead into failure with return
> +value of
> + * -EOPNOTSUPP.
> + */
> +
> +static int ucsi_displayport_enter(struct typec_altmode *alt) {
> +	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	if (!dp->override && dp->initialized) {
> +		const struct typec_altmode *p =
> typec_altmode_get_partner(alt);
> +
> +		dev_warn(&p->dev,
> +			 "firmware doesn't support alternate mode
> overriding\n");
> +		mutex_unlock(&dp->con->lock);
> +		return -EOPNOTSUPP;
> +	}
> +
> +	/*
> +	 * We can't send the New CAM command yet to the PPM as it needs the
> +	 * configuration value as well. Pretending that we have now entered the
> +	 * mode, and letting the alt mode driver continue.
> +	 */
> +
> +	dp->header = VDO(USB_TYPEC_DP_SID, 1, CMD_ENTER_MODE);
> +	dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
> +	dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +
> +	dp->vdo_data = NULL;
> +	dp->vdo_size = 1;
> +
> +	schedule_work(&dp->work);
> +
> +	mutex_unlock(&dp->con->lock);
> +
> +	return 0;
> +}
> +
> +static int ucsi_displayport_exit(struct typec_altmode *alt) {
> +	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
> +	struct ucsi_control ctrl;
> +	int ret = 0;
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	if (!dp->override) {
> +		const struct typec_altmode *p =
> typec_altmode_get_partner(alt);
> +
> +		dev_warn(&p->dev,
> +			 "firmware doesn't support alternate mode
> overriding\n");
> +		ret = -EOPNOTSUPP;
> +		goto out_unlock;
> +	}
> +
> +	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 0, dp-
> >offset, 0);
> +	ret = ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0);
> +	if (ret < 0)
> +		goto out_unlock;
> +
> +	dp->header = VDO(USB_TYPEC_DP_SID, 1, CMD_EXIT_MODE);
> +	dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
> +	dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +
> +	dp->vdo_data = NULL;
> +	dp->vdo_size = 1;
> +
> +	schedule_work(&dp->work);
> +
> +out_unlock:
> +	mutex_unlock(&dp->con->lock);
> +
> +	return ret;
> +}
> +
> +/*
> + * We do not actually have access to the Status Update VDO, so we have
> +to guess
> + * things.
> + */
> +static int ucsi_displayport_status_update(struct ucsi_dp *dp) {
> +	u32 cap = dp->alt->vdo;
> +
> +	dp->data.status = DP_STATUS_ENABLED;
> +
> +	/*
> +	 * If pin assignement D is supported, claiming always
> +	 * that Multi-function is preferred.
> +	 */
> +	if (DP_CAP_CAPABILITY(cap) & DP_CAP_UFP_D) {
> +		dp->data.status |= DP_STATUS_CON_UFP_D;
> +
> +		if (DP_CAP_UFP_D_PIN_ASSIGN(cap) & BIT(DP_PIN_ASSIGN_D))
> +			dp->data.status |= DP_STATUS_PREFER_MULTI_FUNC;
> +	} else {
> +		dp->data.status |= DP_STATUS_CON_DFP_D;
> +
> +		if (DP_CAP_DFP_D_PIN_ASSIGN(cap) & BIT(DP_PIN_ASSIGN_D))
> +			dp->data.status |= DP_STATUS_PREFER_MULTI_FUNC;
> +	}
> +
> +	dp->vdo_data = &dp->data.status;
> +	dp->vdo_size = 2;
> +
> +	return 0;
> +}
> +
> +static int ucsi_displayport_configure(struct ucsi_dp *dp) {
> +	u32 pins = DP_CONF_GET_PIN_ASSIGN(dp->data.conf);
> +	struct ucsi_control ctrl;
> +
> +	if (!dp->override)
> +		return 0;
> +
> +	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 1, dp-
> >offset,
> +pins);
If previous CAM is active at this point then we should exit before setting new
CAM. Please add something like :

+	if (!dp->override)
+		return 0;

        UCSI_CMD_GET_CURRENT_CAM(ctrl, dp->con->num);
        ret = ucsi_send_command(dp->con->ucsi, &ctrl, &cur, sizeof(cur));
        while ((cur != 0xff) && (cur != dp->offset)) {
                ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 0, cur, 0);
                ret = ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0);
                UCSI_CMD_GET_CURRENT_CAM(ctrl, dp->con->num);
                ret = ucsi_send_command(dp->con->ucsi, &ctrl, &cur, sizeof(cur));
        }
+	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 1, dp-

thanks
> nvpublic
> +
> +	return ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0); }
> +
> +static int ucsi_displayport_vdm(struct typec_altmode *alt,
> +				u32 header, const u32 *data, int count) {
> +	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
> +	int cmd_type = PD_VDO_CMDT(header);
> +	int cmd = PD_VDO_CMD(header);
> +	struct typec_altmode *pdev;
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	if (!dp->override && dp->initialized) {
> +		const struct typec_altmode *p =
> typec_altmode_get_partner(alt);
> +
> +		dev_warn(&p->dev,
> +			 "firmware doesn't support alternate mode
> overriding\n");
> +		mutex_unlock(&dp->con->lock);
> +		return -EOPNOTSUPP;
> +	}
> +
> +	pdev = typec_match_altmode(dp->con->partner_altmode, -1,
> +				   alt->svid, alt->mode);
> +
> +	switch (cmd_type) {
> +	case CMDT_INIT:
> +		dp->header = VDO(USB_TYPEC_DP_SID, 1, cmd);
> +		dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
> +
> +		switch (cmd) {
> +		case DP_CMD_STATUS_UPDATE:
> +			if (ucsi_displayport_status_update(dp))
> +				dp->header |= VDO_CMDT(CMDT_RSP_NAK);
> +			else
> +				dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +			break;
> +		case DP_CMD_CONFIGURE:
> +			dp->data.conf = *data;
> +			if (ucsi_displayport_configure(dp)) {
> +				dp->header |= VDO_CMDT(CMDT_RSP_NAK);
> +			} else {
> +				dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +				if (dp->initialized)
> +					ucsi_altmode_update_active(dp->con);
> +				else
> +					dp->initialized = true;
> +			}
> +			break;
> +		default:
> +			dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +			break;
> +		}
> +
> +		schedule_work(&dp->work);
> +		break;
> +	default:
> +		break;
> +	}
> +
> +	mutex_unlock(&dp->con->lock);
> +
> +	return 0;
> +}
> +
> +static const struct typec_altmode_ops ucsi_displayport_ops = {
> +	.enter = ucsi_displayport_enter,
> +	.exit = ucsi_displayport_exit,
> +	.vdm = ucsi_displayport_vdm,
> +};
> +
> +static void ucsi_displayport_work(struct work_struct *work) {
> +	struct ucsi_dp *dp = container_of(work, struct ucsi_dp, work);
> +	int ret;
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	ret = typec_altmode_vdm(dp->alt, dp->header,
> +				dp->vdo_data, dp->vdo_size);
> +	if (ret)
> +		dev_err(&dp->alt->dev, "VDM 0x%x failed\n", dp->header);
> +
> +	dp->vdo_data = NULL;
> +	dp->vdo_size = 0;
> +	dp->header = 0;
> +
> +	mutex_unlock(&dp->con->lock);
> +}
> +
> +void ucsi_displayport_remove_partner(struct typec_altmode *alt) {
> +	struct ucsi_dp *dp;
> +
> +	if (!alt)
> +		return;
> +
> +	dp = typec_altmode_get_drvdata(alt);
> +	dp->data.conf = 0;
> +	dp->data.status = 0;
> +	dp->initialized = false;
> +}
> +
> +struct typec_altmode *ucsi_register_displayport(struct ucsi_connector *con,
> +						bool override, int offset,
> +						struct typec_altmode_desc
> *desc)
> +{
> +	u8 all_assignments = BIT(DP_PIN_ASSIGN_C) | BIT(DP_PIN_ASSIGN_D) |
> +			     BIT(DP_PIN_ASSIGN_E);
> +	struct typec_altmode *alt;
> +	struct ucsi_dp *dp;
> +
> +	/* We can't rely on the firmware with the capabilities. */
> +	desc->vdo |= DP_CAP_DP_SIGNALING | DP_CAP_RECEPTACLE;
> +
> +	/* Claiming that we support all pin assignments */
> +	desc->vdo |= all_assignments << 8;
> +	desc->vdo |= all_assignments << 16;
> +
> +	alt = typec_port_register_altmode(con->port, desc);
> +	if (IS_ERR(alt))
> +		return alt;
> +
> +	dp = devm_kzalloc(&alt->dev, sizeof(*dp), GFP_KERNEL);
> +	if (!dp) {
> +		typec_unregister_altmode(alt);
> +		return ERR_PTR(-ENOMEM);
> +	}
> +
> +	INIT_WORK(&dp->work, ucsi_displayport_work);
> +	dp->override = override;
> +	dp->offset = offset;
> +	dp->con = con;
> +	dp->alt = alt;
> +
> +	alt->ops = &ucsi_displayport_ops;
> +	typec_altmode_set_drvdata(alt, dp);
> +
> +	return alt;
> +}
> diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index
> 5190f8dd4548..760d69eaa029 100644
> --- a/drivers/usb/typec/ucsi/ucsi.c
> +++ b/drivers/usb/typec/ucsi/ucsi.c
> @@ -12,7 +12,7 @@
>  #include <linux/module.h>
>  #include <linux/delay.h>
>  #include <linux/slab.h>
> -#include <linux/usb/typec_altmode.h>
> +#include <linux/usb/typec_dp.h>
> 
>  #include "ucsi.h"
>  #include "trace.h"
> @@ -288,9 +288,12 @@ static int ucsi_register_altmode(struct ucsi_connector
> *con,
>  				 u8 recipient)
>  {
>  	struct typec_altmode *alt;
> +	bool override;
>  	int ret;
>  	int i;
> 
> +	override = !!(con->ucsi->cap.features &
> UCSI_CAP_ALT_MODE_OVERRIDE);
> +
>  	switch (recipient) {
>  	case UCSI_RECIPIENT_CON:
>  		i = ucsi_next_altmode(con->port_altmode);
> @@ -302,7 +305,15 @@ static int ucsi_register_altmode(struct ucsi_connector
> *con,
>  		desc->mode = ucsi_altmode_next_mode(con->port_altmode,
>  						    desc->svid);
> 
> -		alt = typec_port_register_altmode(con->port, desc);
> +		switch (desc->svid) {
> +		case USB_TYPEC_DP_SID:
> +			alt = ucsi_register_displayport(con, override, i, desc);
> +			break;
> +		default:
> +			alt = typec_port_register_altmode(con->port, desc);
> +			break;
> +		}
> +
>  		if (IS_ERR(alt)) {
>  			ret = PTR_ERR(alt);
>  			goto err;
> @@ -398,6 +409,7 @@ static int ucsi_register_altmodes(struct ucsi_connector
> *con, u8 recipient)  static void ucsi_unregister_altmodes(struct ucsi_connector
> *con, u8 recipient)  {
>  	struct typec_altmode **adev;
> +	struct typec_altmode *alt;
>  	int i = 0;
> 
>  	switch (recipient) {
> @@ -412,6 +424,12 @@ static void ucsi_unregister_altmodes(struct
> ucsi_connector *con, u8 recipient)
>  	}
> 
>  	while (adev[i]) {
> +		if (recipient == UCSI_RECIPIENT_SOP &&
> +		    adev[i]->svid == USB_TYPEC_DP_SID) {
> +			alt = typec_match_altmode(con->port_altmode, -1,
> +						  USB_TYPEC_DP_SID, 1);
> +			ucsi_displayport_remove_partner(alt);
> +		}
>  		typec_unregister_altmode(adev[i]);
>  		adev[i++] = NULL;
>  	}
> diff --git a/drivers/usb/typec/ucsi/ucsi.h b/drivers/usb/typec/ucsi/ucsi.h index
> c416bae4b5ca..036ebf256cdd 100644
> --- a/drivers/usb/typec/ucsi/ucsi.h
> +++ b/drivers/usb/typec/ucsi/ucsi.h
> @@ -406,4 +406,25 @@ int ucsi_send_command(struct ucsi *ucsi, struct
> ucsi_control *ctrl,
> 
>  void ucsi_altmode_update_active(struct ucsi_connector *con);
> 
> +#if IS_ENABLED(CONFIG_TYPEC_DP_ALTMODE)
> +struct typec_altmode *
> +ucsi_register_displayport(struct ucsi_connector *con,
> +			  bool override, int offset,
> +			  struct typec_altmode_desc *desc);
> +
> +void ucsi_displayport_remove_partner(struct typec_altmode *adev);
> +
> +#else
> +static inline struct typec_altmode *
> +ucsi_register_displayport(struct ucsi_connector *con,
> +			  bool override, int offset,
> +			  struct typec_altmode_desc *desc)
> +{
> +	return NULL;
> +}
> +
> +static inline void
> +ucsi_displayport_remove_partner(struct typec_altmode *adev) { } #endif
> +/* CONFIG_TYPEC_DP_ALTMODE */
> +
>  #endif /* __DRIVER_USB_TYPEC_UCSI_H */
> --
> 2.20.1

^ permalink raw reply	[flat|nested] 5+ messages in thread

* [5/5] usb: typec: ucsi: Support for DisplayPort alt mode
@ 2019-02-05  1:03 Ajay Gupta
  0 siblings, 0 replies; 5+ messages in thread
From: Ajay Gupta @ 2019-02-05  1:03 UTC (permalink / raw)
  To: Heikki Krogerus, Greg Kroah-Hartman, Michael Hsu; +Cc: linux-usb

Hi Heikki,

> -----Original Message-----
> From: linux-usb-owner@vger.kernel.org <linux-usb-owner@vger.kernel.org> On
> Behalf Of Heikki Krogerus
> Sent: Friday, February 1, 2019 2:48 AM
> To: Greg Kroah-Hartman <gregkh@linuxfoundation.org>; Ajay Gupta
> <ajayg@nvidia.com>; Michael Hsu <mhsu@nvidia.com>
> Cc: linux-usb@vger.kernel.org
> Subject: [PATCH 5/5] usb: typec: ucsi: Support for DisplayPort alt mode
> 
> This makes it possible to bind a driver to a DisplayPort alt mode adapter devices.
> 
> The driver attempts to cope with the limitations of UCSI by "emulating"
> behaviour and attempting to guess things when ever possible in order to satisfy
> the requirements the standard DisplayPort alt mode driver has.
> 
> Signed-off-by: Heikki Krogerus <heikki.krogerus@linux.intel.com>
> ---
>  drivers/usb/typec/ucsi/Makefile      |  15 +-
>  drivers/usb/typec/ucsi/displayport.c | 301 +++++++++++++++++++++++++++
>  drivers/usb/typec/ucsi/ucsi.c        |  22 +-
>  drivers/usb/typec/ucsi/ucsi.h        |  21 ++
>  4 files changed, 351 insertions(+), 8 deletions(-)  create mode 100644
> drivers/usb/typec/ucsi/displayport.c
> 
> diff --git a/drivers/usb/typec/ucsi/Makefile b/drivers/usb/typec/ucsi/Makefile
> index 2f4900b26210..b35e15a1f02c 100644
> --- a/drivers/usb/typec/ucsi/Makefile
> +++ b/drivers/usb/typec/ucsi/Makefile
> @@ -1,12 +1,15 @@
>  # SPDX-License-Identifier: GPL-2.0
> -CFLAGS_trace.o			:= -I$(src)
> +CFLAGS_trace.o				:= -I$(src)
> 
> -obj-$(CONFIG_TYPEC_UCSI)	+= typec_ucsi.o
> +obj-$(CONFIG_TYPEC_UCSI)		+= typec_ucsi.o
> 
> -typec_ucsi-y			:= ucsi.o
> +typec_ucsi-y				:= ucsi.o
> 
> -typec_ucsi-$(CONFIG_TRACING)	+= trace.o
> +typec_ucsi-$(CONFIG_TRACING)		+= trace.o
> 
> -obj-$(CONFIG_UCSI_ACPI)		+= ucsi_acpi.o
> +ifneq ($(CONFIG_TYPEC_DP_ALTMODE),)
> +	typec_ucsi-y			+= displayport.o
> +endif
> 
> -obj-$(CONFIG_UCSI_CCG)		+= ucsi_ccg.o
> +obj-$(CONFIG_UCSI_ACPI)			+= ucsi_acpi.o
> +obj-$(CONFIG_UCSI_CCG)			+= ucsi_ccg.o
> diff --git a/drivers/usb/typec/ucsi/displayport.c
> b/drivers/usb/typec/ucsi/displayport.c
> new file mode 100644
> index 000000000000..3c5312cc7130
> --- /dev/null
> +++ b/drivers/usb/typec/ucsi/displayport.c
> @@ -0,0 +1,301 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * UCSI DisplayPort Alternate Mode Support
> + *
> + * Copyright (C) 2018, Intel Corporation
> + * Author: Heikki Krogerus <heikki.krogerus@linux.intel.com>  */
> +
> +#include <linux/usb/typec_dp.h>
> +#include <linux/usb/pd_vdo.h>
> +
> +#include "ucsi.h"
> +
> +#define UCSI_CMD_SET_NEW_CAM(_con_num_, _enter_, _cam_, _am_)
> 		\
> +	 (UCSI_SET_NEW_CAM | ((_con_num_) << 16) | ((_enter_) << 23) |
> 	\
> +	  ((_cam_) << 24) | ((u64)(_am_) << 32))
> +
> +struct ucsi_dp {
> +	struct typec_displayport_data data;
> +	struct ucsi_connector *con;
> +	struct typec_altmode *alt;
> +	struct work_struct work;
> +	int offset;
> +
> +	bool override;
> +	bool initialized;
> +
> +	u32 header;
> +	u32 *vdo_data;
> +	u8 vdo_size;
> +};
> +
> +/*
> + * Note. Alternate mode control is optional feature in UCSI. It means
> +that even
> + * if the system supports alternate modes, the OS may not be aware of them.
> + *
> + * In most cases however, the OS will be able to see the supported
> +alternate
> + * modes, but it may still not be able to configure them, not even
> +enter or exit
> + * them. That is because UCSI defines alt mode details and alt mode
> "overriding"
> + * as separate options.
> + *
> + * In case alt mode details are supported, but overriding is not, the
> +driver
> + * will still display the supported pin assignments and configuration,
> +but any
> + * changes the user attempts to do will lead into failure with return
> +value of
> + * -EOPNOTSUPP.
> + */
> +
> +static int ucsi_displayport_enter(struct typec_altmode *alt) {
> +	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	if (!dp->override && dp->initialized) {
> +		const struct typec_altmode *p =
> typec_altmode_get_partner(alt);
> +
> +		dev_warn(&p->dev,
> +			 "firmware doesn't support alternate mode
> overriding\n");
> +		mutex_unlock(&dp->con->lock);
> +		return -EOPNOTSUPP;
> +	}
> +
> +	/*
> +	 * We can't send the New CAM command yet to the PPM as it needs the
> +	 * configuration value as well. Pretending that we have now entered the
> +	 * mode, and letting the alt mode driver continue.
> +	 */
> +
> +	dp->header = VDO(USB_TYPEC_DP_SID, 1, CMD_ENTER_MODE);
> +	dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
> +	dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +
> +	dp->vdo_data = NULL;
> +	dp->vdo_size = 1;
> +
> +	schedule_work(&dp->work);
> +
> +	mutex_unlock(&dp->con->lock);
> +
> +	return 0;
> +}
> +
> +static int ucsi_displayport_exit(struct typec_altmode *alt) {
> +	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
> +	struct ucsi_control ctrl;
> +	int ret = 0;
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	if (!dp->override) {
> +		const struct typec_altmode *p =
> typec_altmode_get_partner(alt);
> +
> +		dev_warn(&p->dev,
> +			 "firmware doesn't support alternate mode
> overriding\n");
> +		ret = -EOPNOTSUPP;
> +		goto out_unlock;
> +	}
> +
> +	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 0, dp-
> >offset, 0);
> +	ret = ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0);
> +	if (ret < 0)
> +		goto out_unlock;
> +
> +	dp->header = VDO(USB_TYPEC_DP_SID, 1, CMD_EXIT_MODE);
> +	dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
> +	dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +
> +	dp->vdo_data = NULL;
> +	dp->vdo_size = 1;
> +
> +	schedule_work(&dp->work);
> +
> +out_unlock:
> +	mutex_unlock(&dp->con->lock);
> +
> +	return ret;
> +}
> +
> +/*
> + * We do not actually have access to the Status Update VDO, so we have
> +to guess
> + * things.
> + */
> +static int ucsi_displayport_status_update(struct ucsi_dp *dp) {
> +	u32 cap = dp->alt->vdo;
> +
> +	dp->data.status = DP_STATUS_ENABLED;
> +
> +	/*
> +	 * If pin assignement D is supported, claiming always
> +	 * that Multi-function is preferred.
> +	 */
> +	if (DP_CAP_CAPABILITY(cap) & DP_CAP_UFP_D) {
> +		dp->data.status |= DP_STATUS_CON_UFP_D;
> +
> +		if (DP_CAP_UFP_D_PIN_ASSIGN(cap) & BIT(DP_PIN_ASSIGN_D))
> +			dp->data.status |= DP_STATUS_PREFER_MULTI_FUNC;
> +	} else {
> +		dp->data.status |= DP_STATUS_CON_DFP_D;
> +
> +		if (DP_CAP_DFP_D_PIN_ASSIGN(cap) & BIT(DP_PIN_ASSIGN_D))
> +			dp->data.status |= DP_STATUS_PREFER_MULTI_FUNC;
> +	}
> +
> +	dp->vdo_data = &dp->data.status;
> +	dp->vdo_size = 2;
> +
> +	return 0;
> +}
> +
> +static int ucsi_displayport_configure(struct ucsi_dp *dp) {
> +	u32 pins = DP_CONF_GET_PIN_ASSIGN(dp->data.conf);
> +	struct ucsi_control ctrl;
> +
> +	if (!dp->override)
> +		return 0;
> +
> +	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 1, dp-
> >offset,
> +pins);
> +
> +	return ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0); }
> +
> +static int ucsi_displayport_vdm(struct typec_altmode *alt,
> +				u32 header, const u32 *data, int count) {
> +	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
> +	int cmd_type = PD_VDO_CMDT(header);
> +	int cmd = PD_VDO_CMD(header);
> +	struct typec_altmode *pdev;
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	if (!dp->override && dp->initialized) {
> +		const struct typec_altmode *p =
> typec_altmode_get_partner(alt);
> +
> +		dev_warn(&p->dev,
> +			 "firmware doesn't support alternate mode
> overriding\n");
> +		mutex_unlock(&dp->con->lock);
> +		return -EOPNOTSUPP;
> +	}
> +
> +	pdev = typec_match_altmode(dp->con->partner_altmode, -1,
> +				   alt->svid, alt->mode);
> +
> +	switch (cmd_type) {
> +	case CMDT_INIT:
> +		dp->header = VDO(USB_TYPEC_DP_SID, 1, cmd);
> +		dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
> +
> +		switch (cmd) {
> +		case DP_CMD_STATUS_UPDATE:
> +			if (ucsi_displayport_status_update(dp))
> +				dp->header |= VDO_CMDT(CMDT_RSP_NAK);
> +			else
> +				dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +			break;
> +		case DP_CMD_CONFIGURE:
> +			dp->data.conf = *data;
> +			if (ucsi_displayport_configure(dp)) {
> +				dp->header |= VDO_CMDT(CMDT_RSP_NAK);
> +			} else {
> +				dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +				if (dp->initialized)
> +					ucsi_altmode_update_active(dp->con);
> +				else
> +					dp->initialized = true;
> +			}
> +			break;
> +		default:
> +			dp->header |= VDO_CMDT(CMDT_RSP_ACK);
> +			break;
> +		}
> +
> +		schedule_work(&dp->work);
> +		break;
> +	default:
> +		break;
> +	}
> +
> +	mutex_unlock(&dp->con->lock);
> +
> +	return 0;
> +}
> +
> +static const struct typec_altmode_ops ucsi_displayport_ops = {
> +	.enter = ucsi_displayport_enter,
> +	.exit = ucsi_displayport_exit,
> +	.vdm = ucsi_displayport_vdm,
> +};
> +
> +static void ucsi_displayport_work(struct work_struct *work) {
> +	struct ucsi_dp *dp = container_of(work, struct ucsi_dp, work);
> +	int ret;
> +
> +	mutex_lock(&dp->con->lock);
> +
> +	ret = typec_altmode_vdm(dp->alt, dp->header,
> +				dp->vdo_data, dp->vdo_size);
> +	if (ret)
> +		dev_err(&dp->alt->dev, "VDM 0x%x failed\n", dp->header);
> +
> +	dp->vdo_data = NULL;
> +	dp->vdo_size = 0;
> +	dp->header = 0;
> +
> +	mutex_unlock(&dp->con->lock);
> +}
> +
> +void ucsi_displayport_remove_partner(struct typec_altmode *alt) {
> +	struct ucsi_dp *dp;
> +
> +	if (!alt)
> +		return;
> +
> +	dp = typec_altmode_get_drvdata(alt);
> +	dp->data.conf = 0;
> +	dp->data.status = 0;
> +	dp->initialized = false;
> +}
> +
> +struct typec_altmode *ucsi_register_displayport(struct ucsi_connector *con,
> +						bool override, int offset,
> +						struct typec_altmode_desc
> *desc)
> +{
> +	u8 all_assignments = BIT(DP_PIN_ASSIGN_C) | BIT(DP_PIN_ASSIGN_D) |
> +			     BIT(DP_PIN_ASSIGN_E);
> +	struct typec_altmode *alt;
> +	struct ucsi_dp *dp;
> +
> +	/* We can't rely on the firmware with the capabilities. */
> +	desc->vdo |= DP_CAP_DP_SIGNALING | DP_CAP_RECEPTACLE;
> +
> +	/* Claiming that we support all pin assignments */
> +	desc->vdo |= all_assignments << 8;
> +	desc->vdo |= all_assignments << 16;
> +
> +	alt = typec_port_register_altmode(con->port, desc);
> +	if (IS_ERR(alt))
> +		return alt;
> +
> +	dp = devm_kzalloc(&alt->dev, sizeof(*dp), GFP_KERNEL);
> +	if (!dp) {
> +		typec_unregister_altmode(alt);
> +		return ERR_PTR(-ENOMEM);
> +	}
> +
> +	INIT_WORK(&dp->work, ucsi_displayport_work);
> +	dp->override = override;
> +	dp->offset = offset;
> +	dp->con = con;
> +	dp->alt = alt;
> +
> +	alt->ops = &ucsi_displayport_ops;
> +	typec_altmode_set_drvdata(alt, dp);
> +
> +	return alt;
> +}
> diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index
> 5190f8dd4548..760d69eaa029 100644
> --- a/drivers/usb/typec/ucsi/ucsi.c
> +++ b/drivers/usb/typec/ucsi/ucsi.c
> @@ -12,7 +12,7 @@
>  #include <linux/module.h>
>  #include <linux/delay.h>
>  #include <linux/slab.h>
> -#include <linux/usb/typec_altmode.h>
> +#include <linux/usb/typec_dp.h>
> 
>  #include "ucsi.h"
>  #include "trace.h"
> @@ -288,9 +288,12 @@ static int ucsi_register_altmode(struct ucsi_connector
> *con,
>  				 u8 recipient)
>  {
>  	struct typec_altmode *alt;
> +	bool override;
>  	int ret;
>  	int i;
> 
> +	override = !!(con->ucsi->cap.features &
> UCSI_CAP_ALT_MODE_OVERRIDE);
> +
>  	switch (recipient) {
>  	case UCSI_RECIPIENT_CON:
>  		i = ucsi_next_altmode(con->port_altmode);
> @@ -302,7 +305,15 @@ static int ucsi_register_altmode(struct ucsi_connector
> *con,
>  		desc->mode = ucsi_altmode_next_mode(con->port_altmode,
>  						    desc->svid);
> 
> -		alt = typec_port_register_altmode(con->port, desc);
> +		switch (desc->svid) {
> +		case USB_TYPEC_DP_SID:
> +			alt = ucsi_register_displayport(con, override, i, desc);
> +			break;
> +		default:
> +			alt = typec_port_register_altmode(con->port, desc);
> +			break;
> +		}
> +
>  		if (IS_ERR(alt)) {
>  			ret = PTR_ERR(alt);
>  			goto err;
> @@ -398,6 +409,7 @@ static int ucsi_register_altmodes(struct ucsi_connector
> *con, u8 recipient)  static void ucsi_unregister_altmodes(struct ucsi_connector
> *con, u8 recipient)  {
>  	struct typec_altmode **adev;
> +	struct typec_altmode *alt;
>  	int i = 0;
> 
>  	switch (recipient) {
> @@ -412,6 +424,12 @@ static void ucsi_unregister_altmodes(struct
> ucsi_connector *con, u8 recipient)
>  	}
> 
>  	while (adev[i]) {
> +		if (recipient == UCSI_RECIPIENT_SOP &&
> +		    adev[i]->svid == USB_TYPEC_DP_SID) {
> +			alt = typec_match_altmode(con->port_altmode, -1,
> +						  USB_TYPEC_DP_SID, 1);
> +			ucsi_displayport_remove_partner(alt);
"alt" may be null here in cases where attached type-C device has DP alt mode which is not supported
by connector. Please change as
			If (alt)
				ucsi_displayport_remove_partner(alt);

Thanks
> nvpublic
> +		}
>  		typec_unregister_altmode(adev[i]);
>  		adev[i++] = NULL;
>  	}
> diff --git a/drivers/usb/typec/ucsi/ucsi.h b/drivers/usb/typec/ucsi/ucsi.h index
> c416bae4b5ca..036ebf256cdd 100644
> --- a/drivers/usb/typec/ucsi/ucsi.h
> +++ b/drivers/usb/typec/ucsi/ucsi.h
> @@ -406,4 +406,25 @@ int ucsi_send_command(struct ucsi *ucsi, struct
> ucsi_control *ctrl,
> 
>  void ucsi_altmode_update_active(struct ucsi_connector *con);
> 
> +#if IS_ENABLED(CONFIG_TYPEC_DP_ALTMODE)
> +struct typec_altmode *
> +ucsi_register_displayport(struct ucsi_connector *con,
> +			  bool override, int offset,
> +			  struct typec_altmode_desc *desc);
> +
> +void ucsi_displayport_remove_partner(struct typec_altmode *adev);
> +
> +#else
> +static inline struct typec_altmode *
> +ucsi_register_displayport(struct ucsi_connector *con,
> +			  bool override, int offset,
> +			  struct typec_altmode_desc *desc)
> +{
> +	return NULL;
> +}
> +
> +static inline void
> +ucsi_displayport_remove_partner(struct typec_altmode *adev) { } #endif
> +/* CONFIG_TYPEC_DP_ALTMODE */
> +
>  #endif /* __DRIVER_USB_TYPEC_UCSI_H */
> --
> 2.20.1

^ permalink raw reply	[flat|nested] 5+ messages in thread

* [5/5] usb: typec: ucsi: Support for DisplayPort alt mode
@ 2019-02-01 10:47 Heikki Krogerus
  0 siblings, 0 replies; 5+ messages in thread
From: Heikki Krogerus @ 2019-02-01 10:47 UTC (permalink / raw)
  To: Greg Kroah-Hartman, Ajay Gupta, Michael Hsu; +Cc: linux-usb

This makes it possible to bind a driver to a DisplayPort
alt mode adapter devices.

The driver attempts to cope with the limitations of UCSI by
"emulating" behaviour and attempting to guess things when
ever possible in order to satisfy the requirements the
standard DisplayPort alt mode driver has.

Signed-off-by: Heikki Krogerus <heikki.krogerus@linux.intel.com>
---
 drivers/usb/typec/ucsi/Makefile      |  15 +-
 drivers/usb/typec/ucsi/displayport.c | 301 +++++++++++++++++++++++++++
 drivers/usb/typec/ucsi/ucsi.c        |  22 +-
 drivers/usb/typec/ucsi/ucsi.h        |  21 ++
 4 files changed, 351 insertions(+), 8 deletions(-)
 create mode 100644 drivers/usb/typec/ucsi/displayport.c

diff --git a/drivers/usb/typec/ucsi/Makefile b/drivers/usb/typec/ucsi/Makefile
index 2f4900b26210..b35e15a1f02c 100644
--- a/drivers/usb/typec/ucsi/Makefile
+++ b/drivers/usb/typec/ucsi/Makefile
@@ -1,12 +1,15 @@
 # SPDX-License-Identifier: GPL-2.0
-CFLAGS_trace.o			:= -I$(src)
+CFLAGS_trace.o				:= -I$(src)
 
-obj-$(CONFIG_TYPEC_UCSI)	+= typec_ucsi.o
+obj-$(CONFIG_TYPEC_UCSI)		+= typec_ucsi.o
 
-typec_ucsi-y			:= ucsi.o
+typec_ucsi-y				:= ucsi.o
 
-typec_ucsi-$(CONFIG_TRACING)	+= trace.o
+typec_ucsi-$(CONFIG_TRACING)		+= trace.o
 
-obj-$(CONFIG_UCSI_ACPI)		+= ucsi_acpi.o
+ifneq ($(CONFIG_TYPEC_DP_ALTMODE),)
+	typec_ucsi-y			+= displayport.o
+endif
 
-obj-$(CONFIG_UCSI_CCG)		+= ucsi_ccg.o
+obj-$(CONFIG_UCSI_ACPI)			+= ucsi_acpi.o
+obj-$(CONFIG_UCSI_CCG)			+= ucsi_ccg.o
diff --git a/drivers/usb/typec/ucsi/displayport.c b/drivers/usb/typec/ucsi/displayport.c
new file mode 100644
index 000000000000..3c5312cc7130
--- /dev/null
+++ b/drivers/usb/typec/ucsi/displayport.c
@@ -0,0 +1,301 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * UCSI DisplayPort Alternate Mode Support
+ *
+ * Copyright (C) 2018, Intel Corporation
+ * Author: Heikki Krogerus <heikki.krogerus@linux.intel.com>
+ */
+
+#include <linux/usb/typec_dp.h>
+#include <linux/usb/pd_vdo.h>
+
+#include "ucsi.h"
+
+#define UCSI_CMD_SET_NEW_CAM(_con_num_, _enter_, _cam_, _am_)		\
+	 (UCSI_SET_NEW_CAM | ((_con_num_) << 16) | ((_enter_) << 23) |	\
+	  ((_cam_) << 24) | ((u64)(_am_) << 32))
+
+struct ucsi_dp {
+	struct typec_displayport_data data;
+	struct ucsi_connector *con;
+	struct typec_altmode *alt;
+	struct work_struct work;
+	int offset;
+
+	bool override;
+	bool initialized;
+
+	u32 header;
+	u32 *vdo_data;
+	u8 vdo_size;
+};
+
+/*
+ * Note. Alternate mode control is optional feature in UCSI. It means that even
+ * if the system supports alternate modes, the OS may not be aware of them.
+ *
+ * In most cases however, the OS will be able to see the supported alternate
+ * modes, but it may still not be able to configure them, not even enter or exit
+ * them. That is because UCSI defines alt mode details and alt mode "overriding"
+ * as separate options.
+ *
+ * In case alt mode details are supported, but overriding is not, the driver
+ * will still display the supported pin assignments and configuration, but any
+ * changes the user attempts to do will lead into failure with return value of
+ * -EOPNOTSUPP.
+ */
+
+static int ucsi_displayport_enter(struct typec_altmode *alt)
+{
+	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
+
+	mutex_lock(&dp->con->lock);
+
+	if (!dp->override && dp->initialized) {
+		const struct typec_altmode *p = typec_altmode_get_partner(alt);
+
+		dev_warn(&p->dev,
+			 "firmware doesn't support alternate mode overriding\n");
+		mutex_unlock(&dp->con->lock);
+		return -EOPNOTSUPP;
+	}
+
+	/*
+	 * We can't send the New CAM command yet to the PPM as it needs the
+	 * configuration value as well. Pretending that we have now entered the
+	 * mode, and letting the alt mode driver continue.
+	 */
+
+	dp->header = VDO(USB_TYPEC_DP_SID, 1, CMD_ENTER_MODE);
+	dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
+	dp->header |= VDO_CMDT(CMDT_RSP_ACK);
+
+	dp->vdo_data = NULL;
+	dp->vdo_size = 1;
+
+	schedule_work(&dp->work);
+
+	mutex_unlock(&dp->con->lock);
+
+	return 0;
+}
+
+static int ucsi_displayport_exit(struct typec_altmode *alt)
+{
+	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
+	struct ucsi_control ctrl;
+	int ret = 0;
+
+	mutex_lock(&dp->con->lock);
+
+	if (!dp->override) {
+		const struct typec_altmode *p = typec_altmode_get_partner(alt);
+
+		dev_warn(&p->dev,
+			 "firmware doesn't support alternate mode overriding\n");
+		ret = -EOPNOTSUPP;
+		goto out_unlock;
+	}
+
+	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 0, dp->offset, 0);
+	ret = ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0);
+	if (ret < 0)
+		goto out_unlock;
+
+	dp->header = VDO(USB_TYPEC_DP_SID, 1, CMD_EXIT_MODE);
+	dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
+	dp->header |= VDO_CMDT(CMDT_RSP_ACK);
+
+	dp->vdo_data = NULL;
+	dp->vdo_size = 1;
+
+	schedule_work(&dp->work);
+
+out_unlock:
+	mutex_unlock(&dp->con->lock);
+
+	return ret;
+}
+
+/*
+ * We do not actually have access to the Status Update VDO, so we have to guess
+ * things.
+ */
+static int ucsi_displayport_status_update(struct ucsi_dp *dp)
+{
+	u32 cap = dp->alt->vdo;
+
+	dp->data.status = DP_STATUS_ENABLED;
+
+	/*
+	 * If pin assignement D is supported, claiming always
+	 * that Multi-function is preferred.
+	 */
+	if (DP_CAP_CAPABILITY(cap) & DP_CAP_UFP_D) {
+		dp->data.status |= DP_STATUS_CON_UFP_D;
+
+		if (DP_CAP_UFP_D_PIN_ASSIGN(cap) & BIT(DP_PIN_ASSIGN_D))
+			dp->data.status |= DP_STATUS_PREFER_MULTI_FUNC;
+	} else {
+		dp->data.status |= DP_STATUS_CON_DFP_D;
+
+		if (DP_CAP_DFP_D_PIN_ASSIGN(cap) & BIT(DP_PIN_ASSIGN_D))
+			dp->data.status |= DP_STATUS_PREFER_MULTI_FUNC;
+	}
+
+	dp->vdo_data = &dp->data.status;
+	dp->vdo_size = 2;
+
+	return 0;
+}
+
+static int ucsi_displayport_configure(struct ucsi_dp *dp)
+{
+	u32 pins = DP_CONF_GET_PIN_ASSIGN(dp->data.conf);
+	struct ucsi_control ctrl;
+
+	if (!dp->override)
+		return 0;
+
+	ctrl.raw_cmd = UCSI_CMD_SET_NEW_CAM(dp->con->num, 1, dp->offset, pins);
+
+	return ucsi_send_command(dp->con->ucsi, &ctrl, NULL, 0);
+}
+
+static int ucsi_displayport_vdm(struct typec_altmode *alt,
+				u32 header, const u32 *data, int count)
+{
+	struct ucsi_dp *dp = typec_altmode_get_drvdata(alt);
+	int cmd_type = PD_VDO_CMDT(header);
+	int cmd = PD_VDO_CMD(header);
+	struct typec_altmode *pdev;
+
+	mutex_lock(&dp->con->lock);
+
+	if (!dp->override && dp->initialized) {
+		const struct typec_altmode *p = typec_altmode_get_partner(alt);
+
+		dev_warn(&p->dev,
+			 "firmware doesn't support alternate mode overriding\n");
+		mutex_unlock(&dp->con->lock);
+		return -EOPNOTSUPP;
+	}
+
+	pdev = typec_match_altmode(dp->con->partner_altmode, -1,
+				   alt->svid, alt->mode);
+
+	switch (cmd_type) {
+	case CMDT_INIT:
+		dp->header = VDO(USB_TYPEC_DP_SID, 1, cmd);
+		dp->header |= VDO_OPOS(USB_TYPEC_DP_MODE);
+
+		switch (cmd) {
+		case DP_CMD_STATUS_UPDATE:
+			if (ucsi_displayport_status_update(dp))
+				dp->header |= VDO_CMDT(CMDT_RSP_NAK);
+			else
+				dp->header |= VDO_CMDT(CMDT_RSP_ACK);
+			break;
+		case DP_CMD_CONFIGURE:
+			dp->data.conf = *data;
+			if (ucsi_displayport_configure(dp)) {
+				dp->header |= VDO_CMDT(CMDT_RSP_NAK);
+			} else {
+				dp->header |= VDO_CMDT(CMDT_RSP_ACK);
+				if (dp->initialized)
+					ucsi_altmode_update_active(dp->con);
+				else
+					dp->initialized = true;
+			}
+			break;
+		default:
+			dp->header |= VDO_CMDT(CMDT_RSP_ACK);
+			break;
+		}
+
+		schedule_work(&dp->work);
+		break;
+	default:
+		break;
+	}
+
+	mutex_unlock(&dp->con->lock);
+
+	return 0;
+}
+
+static const struct typec_altmode_ops ucsi_displayport_ops = {
+	.enter = ucsi_displayport_enter,
+	.exit = ucsi_displayport_exit,
+	.vdm = ucsi_displayport_vdm,
+};
+
+static void ucsi_displayport_work(struct work_struct *work)
+{
+	struct ucsi_dp *dp = container_of(work, struct ucsi_dp, work);
+	int ret;
+
+	mutex_lock(&dp->con->lock);
+
+	ret = typec_altmode_vdm(dp->alt, dp->header,
+				dp->vdo_data, dp->vdo_size);
+	if (ret)
+		dev_err(&dp->alt->dev, "VDM 0x%x failed\n", dp->header);
+
+	dp->vdo_data = NULL;
+	dp->vdo_size = 0;
+	dp->header = 0;
+
+	mutex_unlock(&dp->con->lock);
+}
+
+void ucsi_displayport_remove_partner(struct typec_altmode *alt)
+{
+	struct ucsi_dp *dp;
+
+	if (!alt)
+		return;
+
+	dp = typec_altmode_get_drvdata(alt);
+	dp->data.conf = 0;
+	dp->data.status = 0;
+	dp->initialized = false;
+}
+
+struct typec_altmode *ucsi_register_displayport(struct ucsi_connector *con,
+						bool override, int offset,
+						struct typec_altmode_desc *desc)
+{
+	u8 all_assignments = BIT(DP_PIN_ASSIGN_C) | BIT(DP_PIN_ASSIGN_D) |
+			     BIT(DP_PIN_ASSIGN_E);
+	struct typec_altmode *alt;
+	struct ucsi_dp *dp;
+
+	/* We can't rely on the firmware with the capabilities. */
+	desc->vdo |= DP_CAP_DP_SIGNALING | DP_CAP_RECEPTACLE;
+
+	/* Claiming that we support all pin assignments */
+	desc->vdo |= all_assignments << 8;
+	desc->vdo |= all_assignments << 16;
+
+	alt = typec_port_register_altmode(con->port, desc);
+	if (IS_ERR(alt))
+		return alt;
+
+	dp = devm_kzalloc(&alt->dev, sizeof(*dp), GFP_KERNEL);
+	if (!dp) {
+		typec_unregister_altmode(alt);
+		return ERR_PTR(-ENOMEM);
+	}
+
+	INIT_WORK(&dp->work, ucsi_displayport_work);
+	dp->override = override;
+	dp->offset = offset;
+	dp->con = con;
+	dp->alt = alt;
+
+	alt->ops = &ucsi_displayport_ops;
+	typec_altmode_set_drvdata(alt, dp);
+
+	return alt;
+}
diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c
index 5190f8dd4548..760d69eaa029 100644
--- a/drivers/usb/typec/ucsi/ucsi.c
+++ b/drivers/usb/typec/ucsi/ucsi.c
@@ -12,7 +12,7 @@
 #include <linux/module.h>
 #include <linux/delay.h>
 #include <linux/slab.h>
-#include <linux/usb/typec_altmode.h>
+#include <linux/usb/typec_dp.h>
 
 #include "ucsi.h"
 #include "trace.h"
@@ -288,9 +288,12 @@ static int ucsi_register_altmode(struct ucsi_connector *con,
 				 u8 recipient)
 {
 	struct typec_altmode *alt;
+	bool override;
 	int ret;
 	int i;
 
+	override = !!(con->ucsi->cap.features & UCSI_CAP_ALT_MODE_OVERRIDE);
+
 	switch (recipient) {
 	case UCSI_RECIPIENT_CON:
 		i = ucsi_next_altmode(con->port_altmode);
@@ -302,7 +305,15 @@ static int ucsi_register_altmode(struct ucsi_connector *con,
 		desc->mode = ucsi_altmode_next_mode(con->port_altmode,
 						    desc->svid);
 
-		alt = typec_port_register_altmode(con->port, desc);
+		switch (desc->svid) {
+		case USB_TYPEC_DP_SID:
+			alt = ucsi_register_displayport(con, override, i, desc);
+			break;
+		default:
+			alt = typec_port_register_altmode(con->port, desc);
+			break;
+		}
+
 		if (IS_ERR(alt)) {
 			ret = PTR_ERR(alt);
 			goto err;
@@ -398,6 +409,7 @@ static int ucsi_register_altmodes(struct ucsi_connector *con, u8 recipient)
 static void ucsi_unregister_altmodes(struct ucsi_connector *con, u8 recipient)
 {
 	struct typec_altmode **adev;
+	struct typec_altmode *alt;
 	int i = 0;
 
 	switch (recipient) {
@@ -412,6 +424,12 @@ static void ucsi_unregister_altmodes(struct ucsi_connector *con, u8 recipient)
 	}
 
 	while (adev[i]) {
+		if (recipient == UCSI_RECIPIENT_SOP &&
+		    adev[i]->svid == USB_TYPEC_DP_SID) {
+			alt = typec_match_altmode(con->port_altmode, -1,
+						  USB_TYPEC_DP_SID, 1);
+			ucsi_displayport_remove_partner(alt);
+		}
 		typec_unregister_altmode(adev[i]);
 		adev[i++] = NULL;
 	}
diff --git a/drivers/usb/typec/ucsi/ucsi.h b/drivers/usb/typec/ucsi/ucsi.h
index c416bae4b5ca..036ebf256cdd 100644
--- a/drivers/usb/typec/ucsi/ucsi.h
+++ b/drivers/usb/typec/ucsi/ucsi.h
@@ -406,4 +406,25 @@ int ucsi_send_command(struct ucsi *ucsi, struct ucsi_control *ctrl,
 
 void ucsi_altmode_update_active(struct ucsi_connector *con);
 
+#if IS_ENABLED(CONFIG_TYPEC_DP_ALTMODE)
+struct typec_altmode *
+ucsi_register_displayport(struct ucsi_connector *con,
+			  bool override, int offset,
+			  struct typec_altmode_desc *desc);
+
+void ucsi_displayport_remove_partner(struct typec_altmode *adev);
+
+#else
+static inline struct typec_altmode *
+ucsi_register_displayport(struct ucsi_connector *con,
+			  bool override, int offset,
+			  struct typec_altmode_desc *desc)
+{
+	return NULL;
+}
+
+static inline void
+ucsi_displayport_remove_partner(struct typec_altmode *adev) { }
+#endif /* CONFIG_TYPEC_DP_ALTMODE */
+
 #endif /* __DRIVER_USB_TYPEC_UCSI_H */

^ permalink raw reply related	[flat|nested] 5+ messages in thread

end of thread, other threads:[~2019-02-06  8:46 UTC | newest]

Thread overview: 5+ messages (download: mbox.gz / follow: Atom feed)
-- links below jump to the message on this page --
2019-02-06  8:32 [5/5] usb: typec: ucsi: Support for DisplayPort alt mode Heikki Krogerus
  -- strict thread matches above, loose matches on Subject: below --
2019-02-06  8:46 Heikki Krogerus
2019-02-05 19:24 Ajay Gupta
2019-02-05  1:03 Ajay Gupta
2019-02-01 10:47 Heikki Krogerus

This is an external index of several public inboxes,
see mirroring instructions on how to clone and mirror
all data and code used by this external index.