diff options
Diffstat (limited to 'board/yorp/board.c')
-rw-r--r-- | board/yorp/board.c | 68 |
1 files changed, 65 insertions, 3 deletions
diff --git a/board/yorp/board.c b/board/yorp/board.c index 6842221d32..c1b1a9ac27 100644 --- a/board/yorp/board.c +++ b/board/yorp/board.c @@ -8,6 +8,8 @@ #include "adc.h" #include "adc_chip.h" #include "battery.h" +#include "charge_manager.h" +#include "charge_state.h" #include "common.h" #include "driver/accel_kionix.h" #include "driver/accelgyro_lsm6dsm.h" @@ -34,6 +36,9 @@ #include "usbc_ppc.h" #include "util.h" +#define CPRINTSUSB(format, args...) cprints(CC_USBCHARGE, format, ## args) +#define CPRINTFUSB(format, args...) cprintf(CC_USBCHARGE, format, ## args) + #define USB_PD_PORT_ANX7447 0 #define USB_PD_PORT_PS8751 1 @@ -195,19 +200,76 @@ enum adc_channel board_get_vbus_adc(int port) */ void board_reset_pd_mcu(void) { - /* TODO(b/74127309): Flesh out USB code */ + + /* Assert reset to TCPC1 (PS8751) for required delay (1ms) */ + gpio_set_level(GPIO_USB_C1_PD_RST_ODL, 0); + msleep(PS8XXX_RESET_DELAY_MS); + gpio_set_level(GPIO_USB_C1_PD_RST_ODL, 1); + + /* ANX7447 does not have a reset pin. */ } int board_set_active_charge_port(int port) { - /* TODO(b/74127309): Flesh out USB code */ + int is_real_port = (port >= 0 && + port < CONFIG_USB_PD_PORT_COUNT); + int i; + + if (!is_real_port && port != CHARGE_PORT_NONE) + return EC_ERROR_INVAL; + + + if (port == CHARGE_PORT_NONE) { + CPRINTSUSB("Disabling all charger ports"); + + /* Disable all ports. */ + for (i = 0; i < ppc_cnt; i++) { + /* + * Do not return early if one fails otherwise we can + * get into a boot loop assertion failure. + */ + if (ppc_vbus_sink_enable(i, 0)) + CPRINTSUSB("Disabling C%d as sink failed.", i); + } + + return EC_SUCCESS; + } + + CPRINTSUSB("New charge port: C%d", port); + + /* Check if the port is sourcing VBUS. */ + if (ppc_is_sourcing_vbus(port)) { + CPRINTFUSB("Skip enable C%d", port); + return EC_ERROR_INVAL; + } + + /* + * Turn off the other ports' sink path FETs, before enabling the + * requested charge port. + */ + for (i = 0; i < ppc_cnt; i++) { + if (i == port) + continue; + + if (ppc_vbus_sink_enable(i, 0)) + CPRINTSUSB("C%d: sink path disable failed.", i); + } + + /* Enable requested charge port. */ + if (ppc_vbus_sink_enable(port, 1)) { + CPRINTSUSB("C%d: sink path enable failed.", port); + return EC_ERROR_UNKNOWN; + } + return EC_SUCCESS; } void board_set_charge_limit(int port, int supplier, int charge_ma, int max_ma, int charge_mv) { - /* TODO(b/74127309): Flesh out USB code */ + charge_set_input_current_limit(MAX(charge_ma, + CONFIG_CHARGER_INPUT_CURRENT), + charge_mv); } void board_tcpc_init(void) |