Current TCPM allways assume using PD_MAX_REV for negotiation,
but for some USB controller only support PD 2.0, adding an interface
for passing supported_pd_rev from tcpc_dev.
Signed-off-by: Potin Lai <potin.lai@xxxxxxxxxxxx>
---
drivers/usb/typec/tcpm/tcpm.c | 14 ++++++++++++--
include/linux/usb/tcpm.h | 4 ++++
2 files changed, 16 insertions(+), 2 deletions(-)
diff --git a/drivers/usb/typec/tcpm/tcpm.c b/drivers/usb/typec/tcpm/tcpm.c
index 59d4fa2443f2..22e7d226826e 100644
--- a/drivers/usb/typec/tcpm/tcpm.c
+++ b/drivers/usb/typec/tcpm/tcpm.c
@@ -571,6 +571,16 @@ static bool tcpm_port_is_disconnected(struct tcpm_port *port)
port->cc2 == TYPEC_CC_OPEN)));
}
+static u32 tcpm_pd_supported_rev(struct tcpm_port *port)
+{
+ u32 rev = PD_MAX_REV;
+
+ if (port->tcpc->supported_pd_rev)
+ rev = port->tcpc->supported_pd_rev(port->tcpc);
+
+ return min(rev, PD_MAX_REV);
+}
+
/*
* Logging
*/
@@ -3932,7 +3942,7 @@ static void run_state_machine(struct tcpm_port *port)
typec_set_pwr_opmode(port->typec_port, opmode);
port->pwr_opmode = TYPEC_PWR_MODE_USB;
port->caps_count = 0;
- port->negotiated_rev = PD_MAX_REV;
+ port->negotiated_rev = tcpm_pd_supported_rev(port);
port->message_id = 0;
port->rx_msgid = -1;
port->explicit_contract = false;
@@ -4167,7 +4177,7 @@ static void run_state_machine(struct tcpm_port *port)
port->cc2 : port->cc1);
typec_set_pwr_opmode(port->typec_port, opmode);
port->pwr_opmode = TYPEC_PWR_MODE_USB;
- port->negotiated_rev = PD_MAX_REV;
+ port->negotiated_rev = tcpm_pd_supported_rev(port);
port->message_id = 0;
port->rx_msgid = -1;
port->explicit_contract = false;
diff --git a/include/linux/usb/tcpm.h b/include/linux/usb/tcpm.h
index bffc8d3e14ad..36282b2a9d9c 100644
--- a/include/linux/usb/tcpm.h
+++ b/include/linux/usb/tcpm.h
@@ -114,6 +114,9 @@ enum tcpm_transmit_type {
* Optional; The USB Communications Capable bit indicates if port
* partner is capable of communication over the USB data lines
* (e.g. D+/- or SS Tx/Rx). Called to notify the status of the bit.
+ * @supported_pd_rev:
+ * Optional; TCPM call this function to get supported PD revesion
+ * from lower level driver.
*/
struct tcpc_dev {
struct fwnode_handle *fwnode;
@@ -148,6 +151,7 @@ struct tcpc_dev {
bool pps_active, u32 requested_vbus_voltage);
bool (*is_vbus_vsafe0v)(struct tcpc_dev *dev);
void (*set_partner_usb_comm_capable)(struct tcpc_dev *dev, bool enable);
+ u32 (*supported_pd_rev)(struct tcpc_dev *dev);
};
struct tcpm_port;
--
2.17.1
