By default the driver sets the retry count to 3 (Default for PD 2.0).
Update this to 2, if the negotiated rev is PD 3.0.

Signed-off-by: Badhri Jagan Sridharan <[email protected]>
---
 drivers/usb/typec/tcpm/tcpci.c | 12 +++++++-----
 1 file changed, 7 insertions(+), 5 deletions(-)

diff --git a/drivers/usb/typec/tcpm/tcpci.c b/drivers/usb/typec/tcpm/tcpci.c
index 12d983a75510..98a2455f779f 100644
--- a/drivers/usb/typec/tcpm/tcpci.c
+++ b/drivers/usb/typec/tcpm/tcpci.c
@@ -18,7 +18,8 @@
 
 #include "tcpci.h"
 
-#define        PD_RETRY_COUNT                          3
+#define        PD_RETRY_COUNT_DEFAULT                  3
+#define        PD_RETRY_COUNT_3_0_OR_HIGHER            2
 #define        AUTO_DISCHARGE_DEFAULT_THRESHOLD_MV     3500
 #define        AUTO_DISCHARGE_PD_HEADROOM_MV           850
 #define        AUTO_DISCHARGE_PPS_HEADROOM_MV          1250
@@ -447,9 +448,8 @@ static int tcpci_set_vbus(struct tcpc_dev *tcpc, bool 
source, bool sink)
        return 0;
 }
 
-static int tcpci_pd_transmit(struct tcpc_dev *tcpc,
-                            enum tcpm_transmit_type type,
-                            const struct pd_message *msg)
+static int tcpci_pd_transmit(struct tcpc_dev *tcpc, enum tcpm_transmit_type 
type,
+                            const struct pd_message *msg, unsigned int 
negotiated_rev)
 {
        struct tcpci *tcpci = tcpc_to_tcpci(tcpc);
        u16 header = msg ? le16_to_cpu(msg->header) : 0;
@@ -497,7 +497,9 @@ static int tcpci_pd_transmit(struct tcpc_dev *tcpc,
                }
        }
 
-       reg = (PD_RETRY_COUNT << TCPC_TRANSMIT_RETRY_SHIFT) | (type << 
TCPC_TRANSMIT_TYPE_SHIFT);
+       /* nRetryCount is 3 in PD2.0 spec where 2 in PD3.0 spec */
+       reg = ((negotiated_rev > PD_REV20 ? PD_RETRY_COUNT_3_0_OR_HIGHER : 
PD_RETRY_COUNT_DEFAULT)
+              << TCPC_TRANSMIT_RETRY_SHIFT) | (type << 
TCPC_TRANSMIT_TYPE_SHIFT);
        ret = regmap_write(tcpci->regmap, TCPC_TRANSMIT, reg);
        if (ret < 0)
                return ret;
-- 
2.29.2.454.gaff20da3a2-goog

Reply via email to