diff mbox series

[v2,2/2] usb: typec: tcpm: Support non-PD mode

Message ID 20210727151307.2178352-3-kyletso@google.com (mailing list archive)
State Superseded
Headers show
Series TCPM non-pd mode | expand

Commit Message

Kyle Tso July 27, 2021, 3:13 p.m. UTC
Even if the Type-C controller supports PD, it is doable to disable PD
capabilities with the current state machine in TCPM. Without enabling RX
in low-level drivers and with skipping the power negotiation, the port
is eligible to be a non-PD Type-C port. Use new flags whose values are
populated from the device tree to decide the port PD capability. Adding
"pd-supported" property in device tree indicates that the port supports
PD. If "pd-supported" is not found, "typec-power-opmode" shall be added
to specify the advertised Rp value if the port supports SRC role.

Signed-off-by: Kyle Tso <kyletso@google.com>
---
changes since v1:
- Revised the patch to use dt properties
- Added back the checks of callbacks set_pd_rx and pd_transmit
- Added src_rp to indicate which Rp value should be used in SRC. This
  variable is derived from dt property "typec-power-opmode"

 drivers/usb/typec/tcpm/tcpm.c | 108 +++++++++++++++++++++++++---------
 1 file changed, 79 insertions(+), 29 deletions(-)

Comments

Guenter Roeck July 27, 2021, 10:46 p.m. UTC | #1
On 7/27/21 8:13 AM, Kyle Tso wrote:
> Even if the Type-C controller supports PD, it is doable to disable PD
> capabilities with the current state machine in TCPM. Without enabling RX
> in low-level drivers and with skipping the power negotiation, the port
> is eligible to be a non-PD Type-C port. Use new flags whose values are
> populated from the device tree to decide the port PD capability. Adding
> "pd-supported" property in device tree indicates that the port supports
> PD. If "pd-supported" is not found, "typec-power-opmode" shall be added
> to specify the advertised Rp value if the port supports SRC role.
> 
> Signed-off-by: Kyle Tso <kyletso@google.com>
> ---
> changes since v1:
> - Revised the patch to use dt properties
> - Added back the checks of callbacks set_pd_rx and pd_transmit
> - Added src_rp to indicate which Rp value should be used in SRC. This
>    variable is derived from dt property "typec-power-opmode"
> 
>   drivers/usb/typec/tcpm/tcpm.c | 108 +++++++++++++++++++++++++---------
>   1 file changed, 79 insertions(+), 29 deletions(-)
> 
> diff --git a/drivers/usb/typec/tcpm/tcpm.c b/drivers/usb/typec/tcpm/tcpm.c
> index 5b22a1c931a9..4cf77c787f54 100644
> --- a/drivers/usb/typec/tcpm/tcpm.c
> +++ b/drivers/usb/typec/tcpm/tcpm.c
> @@ -316,6 +316,7 @@ struct tcpm_port {
>   	struct typec_partner *partner;
>   
>   	enum typec_cc_status cc_req;
> +	enum typec_cc_status src_rp;	/* work only if pd_supported == false */
>   
>   	enum typec_cc_status cc1;
>   	enum typec_cc_status cc2;
> @@ -323,6 +324,7 @@ struct tcpm_port {
>   
>   	bool attached;
>   	bool connected;
> +	bool pd_supported;
>   	enum typec_port_type port_type;
>   
>   	/*
> @@ -804,6 +806,7 @@ static void tcpm_apply_rc(struct tcpm_port *port)
>   	}
>   }
>   
> +
>   /*
>    * Determine RP value to set based on maximum current supported
>    * by a port if configured as source.
> @@ -815,6 +818,9 @@ static enum typec_cc_status tcpm_rp_cc(struct tcpm_port *port)
>   	int nr_pdo = port->nr_src_pdo;
>   	int i;
>   
> +	if (!port->pd_supported)
> +		return port->src_rp;
> +
>   	/*
>   	 * Search for first entry with matching voltage.
>   	 * It should report the maximum supported current.
> @@ -3568,9 +3574,11 @@ static int tcpm_src_attach(struct tcpm_port *port)
>   	if (ret < 0)
>   		return ret;
>   
> -	ret = port->tcpc->set_pd_rx(port->tcpc, true);
> -	if (ret < 0)
> -		goto out_disable_mux;
> +	if (port->pd_supported) {
> +		ret = port->tcpc->set_pd_rx(port->tcpc, true);
> +		if (ret < 0)
> +			goto out_disable_mux;
> +	}
>   
>   	/*
>   	 * USB Type-C specification, version 1.2,
> @@ -3600,7 +3608,8 @@ static int tcpm_src_attach(struct tcpm_port *port)
>   out_disable_vconn:
>   	tcpm_set_vconn(port, false);
>   out_disable_pd:
> -	port->tcpc->set_pd_rx(port->tcpc, false);
> +	if (port->pd_supported)
> +		port->tcpc->set_pd_rx(port->tcpc, false);
>   out_disable_mux:
>   	tcpm_mux_set(port, TYPEC_STATE_SAFE, USB_ROLE_NONE,
>   		     TYPEC_ORIENTATION_NONE);
> @@ -3804,6 +3813,20 @@ static enum typec_pwr_opmode tcpm_get_pwr_opmode(enum typec_cc_status cc)
>   	}
>   }
>   
> +static enum typec_cc_status tcpm_pwr_opmode_to_rp(enum typec_pwr_opmode opmode)
> +{
> +	switch (opmode) {
> +	case TYPEC_PWR_MODE_USB:
> +		return TYPEC_CC_RP_DEF;
> +	case TYPEC_PWR_MODE_1_5A:
> +		return TYPEC_CC_RP_1_5;
> +	case TYPEC_PWR_MODE_3_0A:
> +	case TYPEC_PWR_MODE_PD:
> +	default:
> +		return TYPEC_CC_RP_3_0;
> +	}
> +}
> +
>   static void run_state_machine(struct tcpm_port *port)
>   {
>   	int ret;
> @@ -3914,6 +3937,10 @@ static void run_state_machine(struct tcpm_port *port)
>   		if (port->ams == POWER_ROLE_SWAP ||
>   		    port->ams == FAST_ROLE_SWAP)
>   			tcpm_ams_finish(port);
> +		if (!port->pd_supported) {
> +			tcpm_set_state(port, SRC_READY, 0);
> +			break;
> +		}
>   		port->upcoming_state = SRC_SEND_CAPABILITIES;
>   		tcpm_ams_start(port, POWER_NEGOTIATION);
>   		break;
> @@ -4161,7 +4188,10 @@ static void run_state_machine(struct tcpm_port *port)
>   				current_lim = PD_P_SNK_STDBY_MW / 5;
>   			tcpm_set_current_limit(port, current_lim, 5000);
>   			tcpm_set_charge(port, true);
> -			tcpm_set_state(port, SNK_WAIT_CAPABILITIES, 0);
> +			if (!port->pd_supported)
> +				tcpm_set_state(port, SNK_READY, 0);
> +			else
> +				tcpm_set_state(port, SNK_WAIT_CAPABILITIES, 0);
>   			break;
>   		}
>   		/*
> @@ -4389,7 +4419,8 @@ static void run_state_machine(struct tcpm_port *port)
>   		tcpm_set_vbus(port, true);
>   		if (port->ams == HARD_RESET)
>   			tcpm_ams_finish(port);
> -		port->tcpc->set_pd_rx(port->tcpc, true);
> +		if (port->pd_supported)
> +			port->tcpc->set_pd_rx(port->tcpc, true);
>   		tcpm_set_attached_state(port, true);
>   		tcpm_set_state(port, SRC_UNATTACHED, PD_T_PS_SOURCE_ON);
>   		break;
> @@ -5898,6 +5929,7 @@ EXPORT_SYMBOL_GPL(tcpm_tcpc_reset);
>   static int tcpm_fw_get_caps(struct tcpm_port *port,
>   			    struct fwnode_handle *fwnode)
>   {
> +	const char *opmode_str;
>   	const char *cap_str;
>   	int ret;
>   	u32 mw, frs_current;
> @@ -5932,22 +5964,36 @@ static int tcpm_fw_get_caps(struct tcpm_port *port,
>   		return ret;
>   	port->typec_caps.type = ret;
>   	port->port_type = port->typec_caps.type;
> +	port->pd_supported = fwnode_property_read_bool(fwnode, "pd-supported");
>   

As mentioned in the other patch, I think this needs to be negated.
Not the variable itself, but the meaning of the property.

>   	port->slow_charger_loop = fwnode_property_read_bool(fwnode, "slow-charger-loop");

It might make sense to move the properties needed with !pd_supported to here
and return immediately after they are read. This would reduce the number of
required changes and avoid trying to read irrelevant properties.
Something like

	if (port->port_type != TYPEC_PORT_SRC)
		port->self_powered = fwnode_property_read_bool(fwnode, "self-powered");

	if (!port->pd_supported)
		return 0;

>   	if (port->port_type == TYPEC_PORT_SNK)
>   		goto sink;
>   
>   	/* Get source pdos */
> -	ret = fwnode_property_count_u32(fwnode, "source-pdos");
> -	if (ret <= 0)
> -		return -EINVAL;
> +	if (port->pd_supported) {
> +		ret = fwnode_property_count_u32(fwnode, "source-pdos");
> +		if (ret <= 0)
> +			return -EINVAL;
>   
> -	port->nr_src_pdo = min(ret, PDO_MAX_OBJECTS);
> -	ret = fwnode_property_read_u32_array(fwnode, "source-pdos",
> -					     port->src_pdo, port->nr_src_pdo);
> -	if ((ret < 0) || tcpm_validate_caps(port, port->src_pdo,
> -					    port->nr_src_pdo))
> -		return -EINVAL;
> +		port->nr_src_pdo = min(ret, PDO_MAX_OBJECTS);
> +		ret = fwnode_property_read_u32_array(fwnode, "source-pdos",
> +						     port->src_pdo, port->nr_src_pdo);
> +		if ((ret < 0) || tcpm_validate_caps(port, port->src_pdo,
> +						    port->nr_src_pdo))
> +			return -EINVAL;
> +	} else {
> +		port->nr_src_pdo = 0;
> +		ret = fwnode_property_read_string(fwnode, "typec-power-opmode", &opmode_str);
> +		if (ret == 0) {
> +			ret = typec_find_pwr_opmode(opmode_str);
> +			if (ret < 0)
> +				return ret;
> +			port->src_rp = tcpm_pwr_opmode_to_rp(ret);
> +		} else {
> +			return ret;
> +		}
> +	}
>   
>   	if (port->port_type == TYPEC_PORT_SRC)
>   		return 0;
> @@ -5962,25 +6008,29 @@ static int tcpm_fw_get_caps(struct tcpm_port *port,
>   		return -EINVAL;
>   sink:
>   	/* Get sink pdos */
> -	ret = fwnode_property_count_u32(fwnode, "sink-pdos");
> -	if (ret <= 0)
> -		return -EINVAL;
> +	if (port->pd_supported) {
> +		ret = fwnode_property_count_u32(fwnode, "sink-pdos");
> +		if (ret <= 0)
> +			return -EINVAL;
>   
> -	port->nr_snk_pdo = min(ret, PDO_MAX_OBJECTS);
> -	ret = fwnode_property_read_u32_array(fwnode, "sink-pdos",
> -					     port->snk_pdo, port->nr_snk_pdo);
> -	if ((ret < 0) || tcpm_validate_caps(port, port->snk_pdo,
> -					    port->nr_snk_pdo))
> -		return -EINVAL;
> +		port->nr_snk_pdo = min(ret, PDO_MAX_OBJECTS);
> +		ret = fwnode_property_read_u32_array(fwnode, "sink-pdos",
> +						     port->snk_pdo, port->nr_snk_pdo);
> +		if ((ret < 0) || tcpm_validate_caps(port, port->snk_pdo,
> +						    port->nr_snk_pdo))
> +			return -EINVAL;
>   
> -	if (fwnode_property_read_u32(fwnode, "op-sink-microwatt", &mw) < 0)
> -		return -EINVAL;
> -	port->operating_snk_mw = mw / 1000;
> +		if (fwnode_property_read_u32(fwnode, "op-sink-microwatt", &mw) < 0)
> +			return -EINVAL;
> +		port->operating_snk_mw = mw / 1000;
> +	} else {
> +		port->nr_snk_pdo = 0;
> +	}
>   
>   	port->self_powered = fwnode_property_read_bool(fwnode, "self-powered");
>   
> -	/* FRS can only be supported byb DRP ports */
> -	if (port->port_type == TYPEC_PORT_DRP) {
> +	/* FRS can only be supported by DRP ports */
> +	if (port->port_type == TYPEC_PORT_DRP && port->pd_supported) {
>   		ret = fwnode_property_read_u32(fwnode, "new-source-frs-typec-current",
>   					       &frs_current);
>   		if (ret >= 0 && frs_current <= FRS_5V_3A)
>
Kyle Tso July 28, 2021, 2:11 a.m. UTC | #2
On Wed, Jul 28, 2021 at 6:46 AM Guenter Roeck <linux@roeck-us.net> wrote:
>
> On 7/27/21 8:13 AM, Kyle Tso wrote:
> > Even if the Type-C controller supports PD, it is doable to disable PD
> > capabilities with the current state machine in TCPM. Without enabling RX
> > in low-level drivers and with skipping the power negotiation, the port
> > is eligible to be a non-PD Type-C port. Use new flags whose values are
> > populated from the device tree to decide the port PD capability. Adding
> > "pd-supported" property in device tree indicates that the port supports
> > PD. If "pd-supported" is not found, "typec-power-opmode" shall be added
> > to specify the advertised Rp value if the port supports SRC role.
> >
> > Signed-off-by: Kyle Tso <kyletso@google.com>
> > ---
> > changes since v1:
> > - Revised the patch to use dt properties
> > - Added back the checks of callbacks set_pd_rx and pd_transmit
> > - Added src_rp to indicate which Rp value should be used in SRC. This
> >    variable is derived from dt property "typec-power-opmode"
> >
> >   drivers/usb/typec/tcpm/tcpm.c | 108 +++++++++++++++++++++++++---------
> >   1 file changed, 79 insertions(+), 29 deletions(-)
> >
> > diff --git a/drivers/usb/typec/tcpm/tcpm.c b/drivers/usb/typec/tcpm/tcpm.c
> > index 5b22a1c931a9..4cf77c787f54 100644
> > --- a/drivers/usb/typec/tcpm/tcpm.c
> > +++ b/drivers/usb/typec/tcpm/tcpm.c
> > @@ -316,6 +316,7 @@ struct tcpm_port {
> >       struct typec_partner *partner;
> >
> >       enum typec_cc_status cc_req;
> > +     enum typec_cc_status src_rp;    /* work only if pd_supported == false */
> >
> >       enum typec_cc_status cc1;
> >       enum typec_cc_status cc2;
> > @@ -323,6 +324,7 @@ struct tcpm_port {
> >
> >       bool attached;
> >       bool connected;
> > +     bool pd_supported;
> >       enum typec_port_type port_type;
> >
> >       /*
> > @@ -804,6 +806,7 @@ static void tcpm_apply_rc(struct tcpm_port *port)
> >       }
> >   }
> >
> > +
> >   /*
> >    * Determine RP value to set based on maximum current supported
> >    * by a port if configured as source.
> > @@ -815,6 +818,9 @@ static enum typec_cc_status tcpm_rp_cc(struct tcpm_port *port)
> >       int nr_pdo = port->nr_src_pdo;
> >       int i;
> >
> > +     if (!port->pd_supported)
> > +             return port->src_rp;
> > +
> >       /*
> >        * Search for first entry with matching voltage.
> >        * It should report the maximum supported current.
> > @@ -3568,9 +3574,11 @@ static int tcpm_src_attach(struct tcpm_port *port)
> >       if (ret < 0)
> >               return ret;
> >
> > -     ret = port->tcpc->set_pd_rx(port->tcpc, true);
> > -     if (ret < 0)
> > -             goto out_disable_mux;
> > +     if (port->pd_supported) {
> > +             ret = port->tcpc->set_pd_rx(port->tcpc, true);
> > +             if (ret < 0)
> > +                     goto out_disable_mux;
> > +     }
> >
> >       /*
> >        * USB Type-C specification, version 1.2,
> > @@ -3600,7 +3608,8 @@ static int tcpm_src_attach(struct tcpm_port *port)
> >   out_disable_vconn:
> >       tcpm_set_vconn(port, false);
> >   out_disable_pd:
> > -     port->tcpc->set_pd_rx(port->tcpc, false);
> > +     if (port->pd_supported)
> > +             port->tcpc->set_pd_rx(port->tcpc, false);
> >   out_disable_mux:
> >       tcpm_mux_set(port, TYPEC_STATE_SAFE, USB_ROLE_NONE,
> >                    TYPEC_ORIENTATION_NONE);
> > @@ -3804,6 +3813,20 @@ static enum typec_pwr_opmode tcpm_get_pwr_opmode(enum typec_cc_status cc)
> >       }
> >   }
> >
> > +static enum typec_cc_status tcpm_pwr_opmode_to_rp(enum typec_pwr_opmode opmode)
> > +{
> > +     switch (opmode) {
> > +     case TYPEC_PWR_MODE_USB:
> > +             return TYPEC_CC_RP_DEF;
> > +     case TYPEC_PWR_MODE_1_5A:
> > +             return TYPEC_CC_RP_1_5;
> > +     case TYPEC_PWR_MODE_3_0A:
> > +     case TYPEC_PWR_MODE_PD:
> > +     default:
> > +             return TYPEC_CC_RP_3_0;
> > +     }
> > +}
> > +
> >   static void run_state_machine(struct tcpm_port *port)
> >   {
> >       int ret;
> > @@ -3914,6 +3937,10 @@ static void run_state_machine(struct tcpm_port *port)
> >               if (port->ams == POWER_ROLE_SWAP ||
> >                   port->ams == FAST_ROLE_SWAP)
> >                       tcpm_ams_finish(port);
> > +             if (!port->pd_supported) {
> > +                     tcpm_set_state(port, SRC_READY, 0);
> > +                     break;
> > +             }
> >               port->upcoming_state = SRC_SEND_CAPABILITIES;
> >               tcpm_ams_start(port, POWER_NEGOTIATION);
> >               break;
> > @@ -4161,7 +4188,10 @@ static void run_state_machine(struct tcpm_port *port)
> >                               current_lim = PD_P_SNK_STDBY_MW / 5;
> >                       tcpm_set_current_limit(port, current_lim, 5000);
> >                       tcpm_set_charge(port, true);
> > -                     tcpm_set_state(port, SNK_WAIT_CAPABILITIES, 0);
> > +                     if (!port->pd_supported)
> > +                             tcpm_set_state(port, SNK_READY, 0);
> > +                     else
> > +                             tcpm_set_state(port, SNK_WAIT_CAPABILITIES, 0);
> >                       break;
> >               }
> >               /*
> > @@ -4389,7 +4419,8 @@ static void run_state_machine(struct tcpm_port *port)
> >               tcpm_set_vbus(port, true);
> >               if (port->ams == HARD_RESET)
> >                       tcpm_ams_finish(port);
> > -             port->tcpc->set_pd_rx(port->tcpc, true);
> > +             if (port->pd_supported)
> > +                     port->tcpc->set_pd_rx(port->tcpc, true);
> >               tcpm_set_attached_state(port, true);
> >               tcpm_set_state(port, SRC_UNATTACHED, PD_T_PS_SOURCE_ON);
> >               break;
> > @@ -5898,6 +5929,7 @@ EXPORT_SYMBOL_GPL(tcpm_tcpc_reset);
> >   static int tcpm_fw_get_caps(struct tcpm_port *port,
> >                           struct fwnode_handle *fwnode)
> >   {
> > +     const char *opmode_str;
> >       const char *cap_str;
> >       int ret;
> >       u32 mw, frs_current;
> > @@ -5932,22 +5964,36 @@ static int tcpm_fw_get_caps(struct tcpm_port *port,
> >               return ret;
> >       port->typec_caps.type = ret;
> >       port->port_type = port->typec_caps.type;
> > +     port->pd_supported = fwnode_property_read_bool(fwnode, "pd-supported");
> >
>
> As mentioned in the other patch, I think this needs to be negated.
> Not the variable itself, but the meaning of the property.
>

Makes sense. I will send another patch.

> >       port->slow_charger_loop = fwnode_property_read_bool(fwnode, "slow-charger-loop");
>
> It might make sense to move the properties needed with !pd_supported to here
> and return immediately after they are read. This would reduce the number of
> required changes and avoid trying to read irrelevant properties.
> Something like
>
>         if (port->port_type != TYPEC_PORT_SRC)
>                 port->self_powered = fwnode_property_read_bool(fwnode, "self-powered");
>
>         if (!port->pd_supported)
>                 return 0;
>

I will try to modify the flow control as well.

thanks,
Kyle

> >       if (port->port_type == TYPEC_PORT_SNK)
> >               goto sink;
> >
> >       /* Get source pdos */
> > -     ret = fwnode_property_count_u32(fwnode, "source-pdos");
> > -     if (ret <= 0)
> > -             return -EINVAL;
> > +     if (port->pd_supported) {
> > +             ret = fwnode_property_count_u32(fwnode, "source-pdos");
> > +             if (ret <= 0)
> > +                     return -EINVAL;
> >
> > -     port->nr_src_pdo = min(ret, PDO_MAX_OBJECTS);
> > -     ret = fwnode_property_read_u32_array(fwnode, "source-pdos",
> > -                                          port->src_pdo, port->nr_src_pdo);
> > -     if ((ret < 0) || tcpm_validate_caps(port, port->src_pdo,
> > -                                         port->nr_src_pdo))
> > -             return -EINVAL;
> > +             port->nr_src_pdo = min(ret, PDO_MAX_OBJECTS);
> > +             ret = fwnode_property_read_u32_array(fwnode, "source-pdos",
> > +                                                  port->src_pdo, port->nr_src_pdo);
> > +             if ((ret < 0) || tcpm_validate_caps(port, port->src_pdo,
> > +                                                 port->nr_src_pdo))
> > +                     return -EINVAL;
> > +     } else {
> > +             port->nr_src_pdo = 0;
> > +             ret = fwnode_property_read_string(fwnode, "typec-power-opmode", &opmode_str);
> > +             if (ret == 0) {
> > +                     ret = typec_find_pwr_opmode(opmode_str);
> > +                     if (ret < 0)
> > +                             return ret;
> > +                     port->src_rp = tcpm_pwr_opmode_to_rp(ret);
> > +             } else {
> > +                     return ret;
> > +             }
> > +     }
> >
> >       if (port->port_type == TYPEC_PORT_SRC)
> >               return 0;
> > @@ -5962,25 +6008,29 @@ static int tcpm_fw_get_caps(struct tcpm_port *port,
> >               return -EINVAL;
> >   sink:
> >       /* Get sink pdos */
> > -     ret = fwnode_property_count_u32(fwnode, "sink-pdos");
> > -     if (ret <= 0)
> > -             return -EINVAL;
> > +     if (port->pd_supported) {
> > +             ret = fwnode_property_count_u32(fwnode, "sink-pdos");
> > +             if (ret <= 0)
> > +                     return -EINVAL;
> >
> > -     port->nr_snk_pdo = min(ret, PDO_MAX_OBJECTS);
> > -     ret = fwnode_property_read_u32_array(fwnode, "sink-pdos",
> > -                                          port->snk_pdo, port->nr_snk_pdo);
> > -     if ((ret < 0) || tcpm_validate_caps(port, port->snk_pdo,
> > -                                         port->nr_snk_pdo))
> > -             return -EINVAL;
> > +             port->nr_snk_pdo = min(ret, PDO_MAX_OBJECTS);
> > +             ret = fwnode_property_read_u32_array(fwnode, "sink-pdos",
> > +                                                  port->snk_pdo, port->nr_snk_pdo);
> > +             if ((ret < 0) || tcpm_validate_caps(port, port->snk_pdo,
> > +                                                 port->nr_snk_pdo))
> > +                     return -EINVAL;
> >
> > -     if (fwnode_property_read_u32(fwnode, "op-sink-microwatt", &mw) < 0)
> > -             return -EINVAL;
> > -     port->operating_snk_mw = mw / 1000;
> > +             if (fwnode_property_read_u32(fwnode, "op-sink-microwatt", &mw) < 0)
> > +                     return -EINVAL;
> > +             port->operating_snk_mw = mw / 1000;
> > +     } else {
> > +             port->nr_snk_pdo = 0;
> > +     }
> >
> >       port->self_powered = fwnode_property_read_bool(fwnode, "self-powered");
> >
> > -     /* FRS can only be supported byb DRP ports */
> > -     if (port->port_type == TYPEC_PORT_DRP) {
> > +     /* FRS can only be supported by DRP ports */
> > +     if (port->port_type == TYPEC_PORT_DRP && port->pd_supported) {
> >               ret = fwnode_property_read_u32(fwnode, "new-source-frs-typec-current",
> >                                              &frs_current);
> >               if (ret >= 0 && frs_current <= FRS_5V_3A)
> >
>
diff mbox series

Patch

diff --git a/drivers/usb/typec/tcpm/tcpm.c b/drivers/usb/typec/tcpm/tcpm.c
index 5b22a1c931a9..4cf77c787f54 100644
--- a/drivers/usb/typec/tcpm/tcpm.c
+++ b/drivers/usb/typec/tcpm/tcpm.c
@@ -316,6 +316,7 @@  struct tcpm_port {
 	struct typec_partner *partner;
 
 	enum typec_cc_status cc_req;
+	enum typec_cc_status src_rp;	/* work only if pd_supported == false */
 
 	enum typec_cc_status cc1;
 	enum typec_cc_status cc2;
@@ -323,6 +324,7 @@  struct tcpm_port {
 
 	bool attached;
 	bool connected;
+	bool pd_supported;
 	enum typec_port_type port_type;
 
 	/*
@@ -804,6 +806,7 @@  static void tcpm_apply_rc(struct tcpm_port *port)
 	}
 }
 
+
 /*
  * Determine RP value to set based on maximum current supported
  * by a port if configured as source.
@@ -815,6 +818,9 @@  static enum typec_cc_status tcpm_rp_cc(struct tcpm_port *port)
 	int nr_pdo = port->nr_src_pdo;
 	int i;
 
+	if (!port->pd_supported)
+		return port->src_rp;
+
 	/*
 	 * Search for first entry with matching voltage.
 	 * It should report the maximum supported current.
@@ -3568,9 +3574,11 @@  static int tcpm_src_attach(struct tcpm_port *port)
 	if (ret < 0)
 		return ret;
 
-	ret = port->tcpc->set_pd_rx(port->tcpc, true);
-	if (ret < 0)
-		goto out_disable_mux;
+	if (port->pd_supported) {
+		ret = port->tcpc->set_pd_rx(port->tcpc, true);
+		if (ret < 0)
+			goto out_disable_mux;
+	}
 
 	/*
 	 * USB Type-C specification, version 1.2,
@@ -3600,7 +3608,8 @@  static int tcpm_src_attach(struct tcpm_port *port)
 out_disable_vconn:
 	tcpm_set_vconn(port, false);
 out_disable_pd:
-	port->tcpc->set_pd_rx(port->tcpc, false);
+	if (port->pd_supported)
+		port->tcpc->set_pd_rx(port->tcpc, false);
 out_disable_mux:
 	tcpm_mux_set(port, TYPEC_STATE_SAFE, USB_ROLE_NONE,
 		     TYPEC_ORIENTATION_NONE);
@@ -3804,6 +3813,20 @@  static enum typec_pwr_opmode tcpm_get_pwr_opmode(enum typec_cc_status cc)
 	}
 }
 
+static enum typec_cc_status tcpm_pwr_opmode_to_rp(enum typec_pwr_opmode opmode)
+{
+	switch (opmode) {
+	case TYPEC_PWR_MODE_USB:
+		return TYPEC_CC_RP_DEF;
+	case TYPEC_PWR_MODE_1_5A:
+		return TYPEC_CC_RP_1_5;
+	case TYPEC_PWR_MODE_3_0A:
+	case TYPEC_PWR_MODE_PD:
+	default:
+		return TYPEC_CC_RP_3_0;
+	}
+}
+
 static void run_state_machine(struct tcpm_port *port)
 {
 	int ret;
@@ -3914,6 +3937,10 @@  static void run_state_machine(struct tcpm_port *port)
 		if (port->ams == POWER_ROLE_SWAP ||
 		    port->ams == FAST_ROLE_SWAP)
 			tcpm_ams_finish(port);
+		if (!port->pd_supported) {
+			tcpm_set_state(port, SRC_READY, 0);
+			break;
+		}
 		port->upcoming_state = SRC_SEND_CAPABILITIES;
 		tcpm_ams_start(port, POWER_NEGOTIATION);
 		break;
@@ -4161,7 +4188,10 @@  static void run_state_machine(struct tcpm_port *port)
 				current_lim = PD_P_SNK_STDBY_MW / 5;
 			tcpm_set_current_limit(port, current_lim, 5000);
 			tcpm_set_charge(port, true);
-			tcpm_set_state(port, SNK_WAIT_CAPABILITIES, 0);
+			if (!port->pd_supported)
+				tcpm_set_state(port, SNK_READY, 0);
+			else
+				tcpm_set_state(port, SNK_WAIT_CAPABILITIES, 0);
 			break;
 		}
 		/*
@@ -4389,7 +4419,8 @@  static void run_state_machine(struct tcpm_port *port)
 		tcpm_set_vbus(port, true);
 		if (port->ams == HARD_RESET)
 			tcpm_ams_finish(port);
-		port->tcpc->set_pd_rx(port->tcpc, true);
+		if (port->pd_supported)
+			port->tcpc->set_pd_rx(port->tcpc, true);
 		tcpm_set_attached_state(port, true);
 		tcpm_set_state(port, SRC_UNATTACHED, PD_T_PS_SOURCE_ON);
 		break;
@@ -5898,6 +5929,7 @@  EXPORT_SYMBOL_GPL(tcpm_tcpc_reset);
 static int tcpm_fw_get_caps(struct tcpm_port *port,
 			    struct fwnode_handle *fwnode)
 {
+	const char *opmode_str;
 	const char *cap_str;
 	int ret;
 	u32 mw, frs_current;
@@ -5932,22 +5964,36 @@  static int tcpm_fw_get_caps(struct tcpm_port *port,
 		return ret;
 	port->typec_caps.type = ret;
 	port->port_type = port->typec_caps.type;
+	port->pd_supported = fwnode_property_read_bool(fwnode, "pd-supported");
 
 	port->slow_charger_loop = fwnode_property_read_bool(fwnode, "slow-charger-loop");
 	if (port->port_type == TYPEC_PORT_SNK)
 		goto sink;
 
 	/* Get source pdos */
-	ret = fwnode_property_count_u32(fwnode, "source-pdos");
-	if (ret <= 0)
-		return -EINVAL;
+	if (port->pd_supported) {
+		ret = fwnode_property_count_u32(fwnode, "source-pdos");
+		if (ret <= 0)
+			return -EINVAL;
 
-	port->nr_src_pdo = min(ret, PDO_MAX_OBJECTS);
-	ret = fwnode_property_read_u32_array(fwnode, "source-pdos",
-					     port->src_pdo, port->nr_src_pdo);
-	if ((ret < 0) || tcpm_validate_caps(port, port->src_pdo,
-					    port->nr_src_pdo))
-		return -EINVAL;
+		port->nr_src_pdo = min(ret, PDO_MAX_OBJECTS);
+		ret = fwnode_property_read_u32_array(fwnode, "source-pdos",
+						     port->src_pdo, port->nr_src_pdo);
+		if ((ret < 0) || tcpm_validate_caps(port, port->src_pdo,
+						    port->nr_src_pdo))
+			return -EINVAL;
+	} else {
+		port->nr_src_pdo = 0;
+		ret = fwnode_property_read_string(fwnode, "typec-power-opmode", &opmode_str);
+		if (ret == 0) {
+			ret = typec_find_pwr_opmode(opmode_str);
+			if (ret < 0)
+				return ret;
+			port->src_rp = tcpm_pwr_opmode_to_rp(ret);
+		} else {
+			return ret;
+		}
+	}
 
 	if (port->port_type == TYPEC_PORT_SRC)
 		return 0;
@@ -5962,25 +6008,29 @@  static int tcpm_fw_get_caps(struct tcpm_port *port,
 		return -EINVAL;
 sink:
 	/* Get sink pdos */
-	ret = fwnode_property_count_u32(fwnode, "sink-pdos");
-	if (ret <= 0)
-		return -EINVAL;
+	if (port->pd_supported) {
+		ret = fwnode_property_count_u32(fwnode, "sink-pdos");
+		if (ret <= 0)
+			return -EINVAL;
 
-	port->nr_snk_pdo = min(ret, PDO_MAX_OBJECTS);
-	ret = fwnode_property_read_u32_array(fwnode, "sink-pdos",
-					     port->snk_pdo, port->nr_snk_pdo);
-	if ((ret < 0) || tcpm_validate_caps(port, port->snk_pdo,
-					    port->nr_snk_pdo))
-		return -EINVAL;
+		port->nr_snk_pdo = min(ret, PDO_MAX_OBJECTS);
+		ret = fwnode_property_read_u32_array(fwnode, "sink-pdos",
+						     port->snk_pdo, port->nr_snk_pdo);
+		if ((ret < 0) || tcpm_validate_caps(port, port->snk_pdo,
+						    port->nr_snk_pdo))
+			return -EINVAL;
 
-	if (fwnode_property_read_u32(fwnode, "op-sink-microwatt", &mw) < 0)
-		return -EINVAL;
-	port->operating_snk_mw = mw / 1000;
+		if (fwnode_property_read_u32(fwnode, "op-sink-microwatt", &mw) < 0)
+			return -EINVAL;
+		port->operating_snk_mw = mw / 1000;
+	} else {
+		port->nr_snk_pdo = 0;
+	}
 
 	port->self_powered = fwnode_property_read_bool(fwnode, "self-powered");
 
-	/* FRS can only be supported byb DRP ports */
-	if (port->port_type == TYPEC_PORT_DRP) {
+	/* FRS can only be supported by DRP ports */
+	if (port->port_type == TYPEC_PORT_DRP && port->pd_supported) {
 		ret = fwnode_property_read_u32(fwnode, "new-source-frs-typec-current",
 					       &frs_current);
 		if (ret >= 0 && frs_current <= FRS_5V_3A)