diff options
Diffstat (limited to 'src/ec/google/chromeec/ec.c')
| -rw-r--r-- | src/ec/google/chromeec/ec.c | 48 |
1 files changed, 48 insertions, 0 deletions
diff --git a/src/ec/google/chromeec/ec.c b/src/ec/google/chromeec/ec.c index 4bb7bb38cf..7fc360af64 100644 --- a/src/ec/google/chromeec/ec.c +++ b/src/ec/google/chromeec/ec.c @@ -936,3 +936,51 @@ int google_ec_running_ro(void) #endif /* ! __SMM__ */ #endif /* ! __PRE_RAM__ */ + +/** + * Check if EC/TCPM is in an alternate mode or not. + * + * @param svid SVID of the alternate mode to check + * @return 0: Not in the mode. -1: Error. 1: Yes. + */ +int google_chromeec_pd_get_amode(uint16_t svid) +{ + struct ec_response_usb_pd_ports r; + struct chromeec_command cmd; + int i; + + cmd.cmd_code = EC_CMD_USB_PD_PORTS; + cmd.cmd_version = 0; + cmd.cmd_data_in = NULL; + cmd.cmd_size_in = 0; + cmd.cmd_data_out = &r; + cmd.cmd_size_out = sizeof(r); + cmd.cmd_dev_index = 0; + if (google_chromeec_command(&cmd) < 0) + return -1; + + for (i = 0; i < r.num_ports; i++) { + struct ec_params_usb_pd_get_mode_request p; + struct ec_params_usb_pd_get_mode_response res; + + p.port = i; + p.svid_idx = 0; + cmd.cmd_code = EC_CMD_USB_PD_GET_AMODE; + cmd.cmd_version = 0; + cmd.cmd_data_in = &p; + cmd.cmd_size_in = sizeof(p); + cmd.cmd_data_out = &res; + cmd.cmd_size_out = sizeof(res); + cmd.cmd_dev_index = 0; + + do { + if (google_chromeec_command(&cmd) < 0) + return -1; + if (res.svid == svid) + return 1; + p.svid_idx++; + } while (res.svid); + } + + return 0; +} |