if (!port->attached)
                return;
 
+       if (port->tcpc->set_bist_data) {
+               tcpm_log(port, "disable BIST MODE TESTDATA");
+               port->tcpc->set_bist_data(port->tcpc, false);
+       }
+
        if (tcpm_port_is_disconnected(port))
                port->hard_reset_count = 0;
 
                case BDO_MODE_CARRIER2:
                        tcpm_pd_transmit(port, TCPC_TX_BIST_MODE_2, NULL);
                        break;
+               case BDO_MODE_TESTDATA:
+                       if (port->tcpc->set_bist_data) {
+                               tcpm_log(port, "Enable BIST MODE TESTDATA");
+                               port->tcpc->set_bist_data(port->tcpc, true);
+                       }
+                       break;
                default:
                        break;
                }
 
  * @try_role:  Optional; called to set a preferred role
  * @pd_transmit:Called to transmit PD message
  * @mux:       Pointer to multiplexer data
+ * @set_bist_data: Turn on/off bist data mode for compliance testing
  */
 struct tcpc_dev {
        struct fwnode_handle *fwnode;
        int (*try_role)(struct tcpc_dev *dev, int role);
        int (*pd_transmit)(struct tcpc_dev *dev, enum tcpm_transmit_type type,
                           const struct pd_message *msg);
+       int (*set_bist_data)(struct tcpc_dev *dev, bool on);
 };
 
 struct tcpm_port;