diff options
| -rw-r--r-- | driver/tcpm/fusb302.c | 17 |
1 files changed, 17 insertions, 0 deletions
diff --git a/driver/tcpm/fusb302.c b/driver/tcpm/fusb302.c index 728c1deb09..3e650b8df5 100644 --- a/driver/tcpm/fusb302.c +++ b/driver/tcpm/fusb302.c @@ -668,6 +668,11 @@ static int fusb302_tcpm_set_rx_enable(int port, int enable) } tcpc_write(port, TCPC_REG_SWITCHES0, reg); + /* Disable BC_LVL interrupt when enabling PD comm */ + if (!tcpc_read(port, TCPC_REG_MASK, ®)) + tcpc_write(port, TCPC_REG_MASK, + reg | TCPC_REG_MASK_BC_LVL); + /* flush rx fifo in case messages have been coming our way */ fusb302_flush_rx_fifo(port); @@ -686,6 +691,11 @@ static int fusb302_tcpm_set_rx_enable(int port, int enable) tcpm_set_cc(port, state[port].previous_pull); tcpc_write(port, TCPC_REG_SWITCHES0, reg); + + /* Enable BC_LVL interrupt when disabling PD comm */ + if (!tcpc_read(port, TCPC_REG_MASK, ®)) + tcpc_write(port, TCPC_REG_MASK, + reg & ~TCPC_REG_MASK_BC_LVL); } fusb302_auto_goodcrc_enable(port, enable); @@ -836,6 +846,13 @@ void fusb302_tcpc_alert(int port) tcpc_read(port, TCPC_REG_INTERRUPTA, &interrupta); tcpc_read(port, TCPC_REG_INTERRUPTB, &interruptb); + /* + * Ignore BC_LVL changes when transmitting / receiving PD, + * since CC level will constantly change. + */ + if (state[port].rx_enable) + interrupt &= ~TCPC_REG_INTERRUPT_BC_LVL; + if (interrupt & TCPC_REG_INTERRUPT_BC_LVL) { /* CC Status change */ task_set_event(PD_PORT_TO_TASK_ID(port), PD_EVENT_CC, 0); |