diff options
-rw-r--r-- | board/twinkie/usb_pd_config.h | 4 | ||||
-rw-r--r-- | board/twinkie/usb_pd_policy.c | 7 |
2 files changed, 9 insertions, 2 deletions
diff --git a/board/twinkie/usb_pd_config.h b/board/twinkie/usb_pd_config.h index 649b7a802e..e32b29fd67 100644 --- a/board/twinkie/usb_pd_config.h +++ b/board/twinkie/usb_pd_config.h @@ -48,9 +48,9 @@ static inline void spi_enable_clock(int port) STM32_RCC_APB2ENR |= STM32_RCC_PB2_SPI1; } -/* RX is using COMP1 triggering TIM1 CH1 */ +/* RX is using COMP1 or COMp2 triggering TIM1 CH1 */ #define CMP1OUTSEL STM32_COMP_CMP1OUTSEL_TIM1_IC1 -#define CMP2OUTSEL 0 +#define CMP2OUTSEL STM32_COMP_CMP2OUTSEL_TIM1_IC1 #define DMAC_TIM_RX(p) STM32_DMAC_CH2 #define TIM_RX_CCR_IDX(p) TIM_RX_CCR_C0 diff --git a/board/twinkie/usb_pd_policy.c b/board/twinkie/usb_pd_policy.c index acfa5ab4e5..d71770e4ec 100644 --- a/board/twinkie/usb_pd_policy.c +++ b/board/twinkie/usb_pd_policy.c @@ -6,6 +6,7 @@ #include "common.h" #include "config.h" #include "console.h" +#include "gpio.h" #include "hooks.h" #include "registers.h" #include "task.h" @@ -81,6 +82,12 @@ int pd_choose_voltage(int cnt, uint32_t *src_caps, uint32_t *rdo, void pd_set_input_current_limit(int port, uint32_t max_ma, uint32_t supply_voltage) { + int red = supply_voltage == 20000; + int green = supply_voltage == 5000; + int blue = supply_voltage && !(red || green); + gpio_set_level(GPIO_LED_R_L, !red); + gpio_set_level(GPIO_LED_G_L, !green); + gpio_set_level(GPIO_LED_B_L, !blue); } void pd_set_max_voltage(unsigned mv) |