summaryrefslogtreecommitdiff
path: root/common/dps.c
diff options
context:
space:
mode:
authorJack Rosenthal <jrosenth@chromium.org>2021-11-04 12:11:58 -0600
committerCommit Bot <commit-bot@chromium.org>2021-11-05 04:22:34 +0000
commit252457d4b21f46889eebad61d4c0a65331919cec (patch)
tree01856c4d31d710b20e85a74c8d7b5836e35c3b98 /common/dps.c
parent08f5a1e6fc2c9467230444ac9b582dcf4d9f0068 (diff)
downloadchrome-ec-252457d4b21f46889eebad61d4c0a65331919cec.tar.gz
In the interest of making long-term branch maintenance incur as little technical debt on us as possible, we should not maintain any files on the branch we are not actually using. This has the added effect of making it extremely clear when merging CLs from the main branch when changes have the possibility to affect us. The follow-on CL adds a convenience script to actually pull updates from the main branch and generate a CL for the update. BUG=b:204206272 BRANCH=ish TEST=make BOARD=arcada_ish && make BOARD=drallion_ish Signed-off-by: Jack Rosenthal <jrosenth@chromium.org> Change-Id: I17e4694c38219b5a0823e0a3e55a28d1348f4b18 Reviewed-on: https://chromium-review.googlesource.com/c/chromiumos/platform/ec/+/3262038 Reviewed-by: Jett Rink <jettrink@chromium.org> Reviewed-by: Tom Hughes <tomhughes@chromium.org>
Diffstat (limited to 'common/dps.c')
-rw-r--r--common/dps.c639
1 files changed, 0 insertions, 639 deletions
diff --git a/common/dps.c b/common/dps.c
deleted file mode 100644
index 235f4d4e08..0000000000
--- a/common/dps.c
+++ /dev/null
@@ -1,639 +0,0 @@
-/* Copyright 2021 The Chromium OS Authors. All rights reserved.
- * Use of this source code is governed by a BSD-style license that can be
- * found in the LICENSE file.
- *
- * Dynamic PDO Selection.
- */
-
-#include <stdint.h>
-
-#include "adc.h"
-#include "dps.h"
-#include "atomic.h"
-#include "battery.h"
-#include "console.h"
-#include "charger.h"
-#include "charge_manager.h"
-#include "charge_state.h"
-#include "charge_state_v2.h"
-#include "math_util.h"
-#include "task.h"
-#include "timer.h"
-#include "usb_common.h"
-#include "usb_pd.h"
-#include "util.h"
-#include "usb_pe_sm.h"
-
-
-#define K_MORE_PWR 96
-#define K_LESS_PWR 93
-#define K_SAMPLE 1
-#define K_WINDOW 3
-#define T_REQUEST_STABLE_TIME (10 * SECOND)
-#define T_NEXT_CHECK_TIME (5 * SECOND)
-
-#define DPS_FLAG_DISABLED BIT(0)
-#define DPS_FLAG_NO_SRCCAP BIT(1)
-#define DPS_FLAG_WAITING BIT(2)
-#define DPS_FLAG_SAMPLED BIT(3)
-#define DPS_FLAG_NEED_MORE_PWR BIT(4)
-
-#define DPS_FLAG_STOP_EVENTS (DPS_FLAG_DISABLED | \
- DPS_FLAG_NO_SRCCAP)
-#define DPS_FLAG_ALL GENMASK(31, 0)
-
-#define MAX_MOVING_AVG_WINDOW 5
-
-BUILD_ASSERT(K_MORE_PWR > K_LESS_PWR && 100 >= K_MORE_PWR && 100 >= K_LESS_PWR);
-
-/* lock for updating timeout value */
-static mutex_t dps_lock;
-static timestamp_t timeout;
-static bool is_enabled = true;
-static int debug_level;
-static bool fake_enabled;
-static int fake_mv, fake_ma;
-static int dynamic_mv;
-static int dps_port = CHARGE_PORT_NONE;
-static uint32_t flag;
-
-#define CPRINTF(format, args...) cprintf(CC_USBPD, "DPS " format, ##args)
-#define CPRINTS(format, args...) cprints(CC_USBPD, "DPS " format, ##args)
-
-__overridable struct dps_config_t dps_config = {
- .k_less_pwr = K_LESS_PWR,
- .k_more_pwr = K_MORE_PWR,
- .k_sample = K_SAMPLE,
- .k_window = K_WINDOW,
- .t_stable = T_REQUEST_STABLE_TIME,
- .t_check = T_NEXT_CHECK_TIME,
- .is_more_efficient = NULL,
-};
-
-int dps_get_dynamic_voltage(void)
-{
- return dynamic_mv;
-}
-
-int dps_get_charge_port(void)
-{
- return dps_port;
-}
-
-bool dps_is_enabled(void)
-{
- return is_enabled;
-}
-
-static void dps_enable(bool en)
-{
- bool prev_en = is_enabled;
-
- is_enabled = en;
-
- if (is_enabled && !prev_en)
- task_wake(TASK_ID_DPS);
-}
-
-static void update_timeout(int us)
-{
- timestamp_t new_timeout;
-
- new_timeout.val = get_time().val + us;
-
- mutex_lock(&dps_lock);
- if (new_timeout.val > timeout.val)
- timeout = new_timeout;
- mutex_unlock(&dps_lock);
-}
-
-/*
- * DPS reset.
- */
-static void dps_reset(void)
-{
- dynamic_mv = PD_MAX_VOLTAGE_MV;
- dps_port = CHARGE_PORT_NONE;
-}
-
-/*
- * DPS initialization.
- */
-static void dps_init(void)
-{
- dps_reset();
-
- if (dps_config.k_window > MAX_MOVING_AVG_WINDOW) {
- dps_config.k_window = MAX_MOVING_AVG_WINDOW;
- CPRINTS("ERR:WIN");
- }
-
- if (dps_config.k_less_pwr > 100 ||
- dps_config.k_more_pwr > 100 ||
- dps_config.k_more_pwr <= dps_config.k_less_pwr) {
- dps_config.k_less_pwr = K_LESS_PWR;
- dps_config.k_more_pwr = K_MORE_PWR;
- CPRINTS("ERR:COEF");
- }
-}
-
-static bool is_near_limit(int val, int limit)
-{
- return val >= (limit * dps_config.k_more_pwr / 100);
-}
-
-bool is_more_efficient(int curr_mv, int prev_mv, int batt_mv, int batt_mw,
- int input_mw)
-{
- if (dps_config.is_more_efficient)
- return dps_config.is_more_efficient(curr_mv, prev_mv, batt_mv,
- batt_mw, input_mw);
-
- return ABS(curr_mv - batt_mv) < ABS(prev_mv - batt_mv);
-}
-
-/*
- * Get the input power of the active port.
- *
- * input_power = vbus * input_current
- *
- * @param vbus: VBUS in mV
- * @param input_curr: input current in mA
- *
- * @return input_power of the result of vbus * input_curr in mW
- */
-static int get_desired_input_power(int *vbus, int *input_current)
-{
- int active_port;
- int charger_id;
- enum ec_error_list rv;
-
- active_port = charge_manager_get_active_charge_port();
-
- if (active_port == CHARGE_PORT_NONE)
- return 0;
-
- charger_id = charge_get_active_chg_chip();
-
- if (fake_enabled) {
- *vbus = fake_mv;
- *input_current = fake_ma;
- return fake_mv * fake_ma / 1000;
- }
-
- rv = charger_get_input_current(charger_id, input_current);
- if (rv)
- return 0;
-
- *vbus = charge_manager_get_vbus_voltage(active_port);
-
- return (*vbus) * (*input_current) / 1000;
-}
-
-/*
- * Get the most efficient PDO voltage for the battery of the charging port
- *
- * | W\Batt | 1S(3.7V) | 2S(7.4V) | 3S(11.1V) | 4S(14.8V) |
- * --------------------------------------------------------
- * | 0-15W | 5V | 9V | 12V | 15V |
- * | 15-27W | 9V | 9V | 12V | 15V |
- * | 27-36W | 12V | 12V | 12V | 15V |
- * | 36-45W | 15V | 15V | 15V | 15V |
- * | 45-60W | 20V | 20V | 20V | 20V |
- *
- *
- * @return 0 if error occurs, else battery efficient voltage in mV
- */
-int get_efficient_voltage(void)
-{
- int eff_mv = 0;
- int batt_mv;
- int batt_pwr;
- int input_pwr, vbus, input_curr;
- const struct batt_params *batt = charger_current_battery_params();
-
- input_pwr = get_desired_input_power(&vbus, &input_curr);
-
- if (!input_pwr)
- return 0;
-
- if (battery_design_voltage(&batt_mv))
- return 0;
-
- batt_pwr = batt->current * batt->voltage / 1000;
-
- for (int i = 0; i < board_get_usb_pd_port_count(); ++i) {
- const int cnt = pd_get_src_cap_cnt(i);
- const uint32_t *src_caps = pd_get_src_caps(i);
-
- for (int j = 0; j < cnt; ++j) {
- int ma, mv, unused;
-
- pd_extract_pdo_power(src_caps[j], &ma, &mv, &unused);
- /*
- * If the eff_mv is not picked, or we have more
- * efficient voltage (less voltage diff)
- */
- if (eff_mv == 0 ||
- is_more_efficient(mv, eff_mv, batt_mv, batt_pwr,
- input_pwr))
- eff_mv = mv;
- }
- }
-
- return eff_mv;
-}
-
-struct pdo_candidate {
- int port;
- int mv;
- int mw;
-};
-
-#define UPDATE_CANDIDATE(new_port, new_mv, new_mw) \
- do { \
- cand->port = new_port; \
- cand->mv = new_mv; \
- cand->mw = new_mw; \
- } while (0)
-
-#define CLEAR_AND_RETURN() \
- do { \
- moving_avg_count = 0; \
- return false; \
- } while (0)
-
-/*
- * Evaluate the system power if a new PD power request is needed.
- *
- * @param struct pdo_candidate: The candidate PDO. (Return value)
- * @return true if a new power request, or false otherwise.
- */
-static bool has_new_power_request(struct pdo_candidate *cand)
-{
- int vbus, input_curr, input_pwr;
- int input_pwr_avg = 0, input_curr_avg = 0;
- int batt_pwr, batt_mv;
- int max_mv = pd_get_max_voltage();
- int req_pwr, req_ma, req_mv;
- int input_curr_limit;
- int active_port = charge_manager_get_active_charge_port();
- int charger_id;
- static int input_pwrs[MAX_MOVING_AVG_WINDOW];
- static int input_currs[MAX_MOVING_AVG_WINDOW];
- static int prev_active_port = CHARGE_PORT_NONE;
- static int prev_req_mv;
- static int moving_avg_count;
- const struct batt_params *batt = charger_current_battery_params();
-
- /* set a default value in case it early returns. */
- UPDATE_CANDIDATE(CHARGE_PORT_NONE, INT32_MAX, 0);
-
- if (active_port == CHARGE_PORT_NONE)
- CLEAR_AND_RETURN();
-
- req_mv = pd_get_requested_voltage(active_port);
- req_ma = pd_get_requested_current(active_port);
-
- if (!req_mv)
- CLEAR_AND_RETURN();
-
- if (battery_design_voltage(&batt_mv))
- CLEAR_AND_RETURN();
-
- /* if last sample is not the same as the current one, reset counting. */
- if (prev_req_mv != req_mv || prev_active_port != active_port)
- moving_avg_count = 0;
- prev_active_port = active_port;
- prev_req_mv = req_mv;
-
- req_pwr = req_mv * req_ma / 1000;
- batt_pwr = batt->current * batt->voltage / 1000;
- input_pwr = get_desired_input_power(&vbus, &input_curr);
-
- if (!input_pwr)
- CLEAR_AND_RETURN();
-
- /* record moving average */
- input_pwrs[moving_avg_count % dps_config.k_window] = input_pwr;
- input_currs[moving_avg_count % dps_config.k_window] = input_curr;
- if (++moving_avg_count < dps_config.k_window)
- return false;
-
- for (int i = 0; i < dps_config.k_window; i++) {
- input_curr_avg += input_currs[i];
- input_pwr_avg += input_pwrs[i];
- }
- input_curr_avg /= dps_config.k_window;
- input_pwr_avg /= dps_config.k_window;
-
- charger_id = charge_get_active_chg_chip();
-
- if (!charger_get_input_current_limit(charger_id, &input_curr_limit))
- /* set as last requested mA if we're unable to get the limit. */
- input_curr_limit = req_ma;
-
- /*
- * input power might be insufficient, force it to negotiate a more
- * powerful PDO.
- */
- if (is_near_limit(input_pwr_avg, req_pwr) ||
- is_near_limit(input_curr_avg, MIN(req_ma, input_curr_limit))) {
- flag |= DPS_FLAG_NEED_MORE_PWR;
- if (!fake_enabled)
- input_pwr_avg = req_pwr + 1;
- } else {
- flag &= ~DPS_FLAG_NEED_MORE_PWR;
- }
-
- if (debug_level)
- CPRINTS("C%d 0x%x last (%dmW %dmV) input (%dmW %dmV %dmA) "
- "avg (%dmW, %dmA)",
- active_port, flag, req_pwr, req_mv, input_pwr, vbus,
- input_curr, input_pwr_avg, input_curr_avg);
-
- for (int i = 0; i < board_get_usb_pd_port_count(); ++i) {
- const uint32_t * const src_caps = pd_get_src_caps(i);
-
- for (int j = 0; j < pd_get_src_cap_cnt(i); ++j) {
- int ma, mv, unused;
- int mw;
- bool efficient;
-
- /* TODO(b:169532537): support augmented PDO. */
- if ((src_caps[j] & PDO_TYPE_MASK) != PDO_TYPE_FIXED)
- continue;
-
- pd_extract_pdo_power(src_caps[j], &ma, &mv, &unused);
-
- if (mv > max_mv)
- continue;
-
- mw = ma * mv / 1000;
- efficient = is_more_efficient(mv, cand->mv, batt_mv,
- batt_pwr, input_pwr_avg);
-
- if (flag & DPS_FLAG_NEED_MORE_PWR) {
- /* the insufficient case.*/
- if (input_pwr_avg > cand->mw &&
- (mw > cand->mw ||
- (mw == cand->mw && efficient))) {
- UPDATE_CANDIDATE(i, mv, mw);
- } else if (input_pwr_avg <= mw && efficient) {
- UPDATE_CANDIDATE(i, mv, mw);
- }
- } else {
- int adjust_pwr =
- mw * dps_config.k_less_pwr / 100;
- int adjust_cand_mw =
- cand->mw * dps_config.k_less_pwr / 100;
-
- /* Pick if we don't have a candidate yet. */
- if (!cand->mw) {
- UPDATE_CANDIDATE(i, mv, mw);
- /*
- * if the candidate is insufficient, and
- * we get one provides more.
- */
- } else if ((adjust_cand_mw < input_pwr_avg &&
- cand->mw < mw) ||
- /*
- * if the candidate is sufficient,
- * and we pick a more efficient one.
- */
- (adjust_cand_mw >= input_pwr_avg &&
- adjust_pwr >= input_pwr_avg &&
- efficient)) {
- UPDATE_CANDIDATE(i, mv, mw);
- }
- }
-
-
- /*
- * if the candidate is the same as the current one, pick
- * the one at active charge port.
- */
- if (mw == cand->mw && mv == cand->mv &&
- i == active_port)
- UPDATE_CANDIDATE(i, mv, mw);
- }
- }
-
- if (!cand->mv)
- CPRINTS("ERR:CNDMV");
-
- return (cand->mv != req_mv);
-}
-
-static bool has_srccap(void)
-{
- for (int i = 0; i < board_get_usb_pd_port_count(); ++i) {
- if (pd_is_connected(i) &&
- pd_get_power_role(i) == PD_ROLE_SINK &&
- pd_get_src_cap_cnt(i) > 0)
- return true;
- }
- return false;
-}
-
-void dps_update_stabilized_time(int port)
-{
- update_timeout(dps_config.t_stable);
-}
-
-void dps_task(void *u)
-{
- struct pdo_candidate last_cand = {CHARGE_PORT_NONE, 0, 0};
- int sample_count = 0;
-
- dps_init();
- update_timeout(dps_config.t_check);
-
- while (1) {
- struct pdo_candidate curr_cand = {CHARGE_PORT_NONE, 0, 0};
- timestamp_t now;
-
- now = get_time();
- if (flag & DPS_FLAG_STOP_EVENTS) {
- dps_reset();
- task_wait_event(-1);
- /* clear flags after wake up. */
- flag = 0;
- update_timeout(dps_config.t_check);
- continue;
- } else if (now.val < timeout.val) {
- flag |= DPS_FLAG_WAITING;
- task_wait_event(timeout.val - now.val);
- flag &= ~DPS_FLAG_WAITING;
- }
-
- if (!is_enabled) {
- flag |= DPS_FLAG_DISABLED;
- continue;
- }
-
- if (!has_srccap()) {
- flag |= DPS_FLAG_NO_SRCCAP;
- continue;
- }
-
- if (!has_new_power_request(&curr_cand)) {
- sample_count = 0;
- flag &= ~DPS_FLAG_SAMPLED;
- } else {
- if (last_cand.port == curr_cand.port &&
- last_cand.mv == curr_cand.mv &&
- last_cand.mw == curr_cand.mw)
- sample_count++;
- else
- sample_count = 1;
- flag |= DPS_FLAG_SAMPLED;
- }
-
- if (sample_count == dps_config.k_sample) {
- dynamic_mv = curr_cand.mv;
- dps_port = curr_cand.port;
- pd_dpm_request(dps_port,
- DPM_REQUEST_NEW_POWER_LEVEL);
- sample_count = 0;
- flag &= ~(DPS_FLAG_SAMPLED | DPS_FLAG_NEED_MORE_PWR);
- }
-
- last_cand.port = curr_cand.port;
- last_cand.mv = curr_cand.mv;
- last_cand.mw = curr_cand.mw;
-
- update_timeout(dps_config.t_check);
- }
-}
-
-static int command_dps(int argc, char **argv)
-{
- int port = charge_manager_get_active_charge_port();
- int input_pwr, vbus, input_curr;
- int holder;
-
- if (argc == 1) {
- uint32_t last_ma = 0, last_mv = 0;
- int batt_mv;
-
- ccprintf("flag=0x%x k_more=%d k_less=%d k_sample=%d k_win=%d\n",
- flag, dps_config.k_more_pwr, dps_config.k_less_pwr,
- dps_config.k_sample, dps_config.k_window);
- ccprintf("t_stable=%d t_check=%d\n",
- dps_config.t_stable / SECOND,
- dps_config.t_check / SECOND);
- if (!is_enabled) {
- ccprintf("DPS Disabled\n");
- return EC_SUCCESS;
- }
-
- if (port == CHARGE_PORT_NONE) {
- ccprintf("No charger attached\n");
- return EC_SUCCESS;
- }
-
- battery_design_voltage(&batt_mv);
- input_pwr = get_desired_input_power(&vbus, &input_curr);
- if (!(flag & DPS_FLAG_NO_SRCCAP)) {
- last_mv = pd_get_requested_voltage(port);
- last_ma = pd_get_requested_current(port);
- }
- ccprintf("C%d DPS Enabled\n"
- "Requested: %dmV/%dmA\n"
- "Measured: %dmV/%dmA/%dmW\n"
- "Efficient: %dmV\n"
- "Batt: %dmv\n"
- "PDMaxMV: %dmV\n",
- port, last_mv, last_ma,
- vbus, input_curr, input_pwr,
- get_efficient_voltage(),
- batt_mv,
- pd_get_max_voltage());
- return EC_SUCCESS;
- }
-
- if (!strcasecmp(argv[1], "en")) {
- dps_enable(true);
- return EC_SUCCESS;
- } else if (!strcasecmp(argv[1], "dis")) {
- dps_enable(false);
- return EC_SUCCESS;
- } else if (!strcasecmp(argv[1], "fakepwr")) {
- if (argc == 2) {
- ccprintf("%sabled %dmV/%dmA\n",
- fake_enabled ? "en" : "dis", fake_mv, fake_ma);
- return EC_SUCCESS;
- }
-
- if (!strcasecmp(argv[2], "dis")) {
- fake_enabled = false;
- return EC_SUCCESS;
- }
-
- if (argc < 4)
- return EC_ERROR_PARAM_COUNT;
-
- holder = atoi(argv[2]);
- if (holder <= 0)
- return EC_ERROR_PARAM2;
- fake_mv = holder;
-
- holder = atoi(argv[3]);
- if (holder <= 0)
- return EC_ERROR_PARAM3;
- fake_ma = holder;
-
- fake_enabled = true;
- return EC_SUCCESS;
- }
-
- if (argc != 3)
- return EC_ERROR_PARAM2;
-
- if (!strcasecmp(argv[1], "debug")) {
- debug_level = atoi(argv[2]);
- } else if (!strcasecmp(argv[1], "setkmore")) {
- holder = atoi(argv[2]);
- if (holder > 100 || holder <= 0 ||
- holder < dps_config.k_less_pwr)
- return EC_ERROR_PARAM2;
- dps_config.k_more_pwr = holder;
- } else if (!strcasecmp(argv[1], "setkless")) {
- holder = atoi(argv[2]);
- if (holder > 100 || holder <= 0 ||
- holder > dps_config.k_more_pwr)
- return EC_ERROR_PARAM2;
- dps_config.k_less_pwr = holder;
- } else if (!strcasecmp(argv[1], "setksample")) {
- holder = atoi(argv[2]);
- if (holder <= 0)
- return EC_ERROR_PARAM2;
- dps_config.k_sample = holder;
- } else if (!strcasecmp(argv[1], "setkwin")) {
- holder = atoi(argv[2]);
- if (holder <= 0 || holder > MAX_MOVING_AVG_WINDOW)
- return EC_ERROR_PARAM2;
- dps_config.k_window = holder;
- } else if (!strcasecmp(argv[1], "settcheck")) {
- holder = atoi(argv[2]);
- if (holder <= 0)
- return EC_ERROR_PARAM2;
- dps_config.t_check = holder * SECOND;
- } else if (!strcasecmp(argv[1], "settstable")) {
- holder = atoi(argv[2]);
- if (holder <= 0)
- return EC_ERROR_PARAM2;
- dps_config.t_stable = holder * SECOND;
- } else {
- return EC_ERROR_PARAM1;
- }
-
- return EC_SUCCESS;
-}
-DECLARE_CONSOLE_COMMAND(dps, command_dps,
- "en|dis|debug <int>\n"
- "\t\t set(kmore|kless|ksample|kwindow) <int>\n"
- "\t\t set(tstable|tcheck) <int>\n"
- "\t\t fakepwr [dis|<mV> <mA>]",
- "Print/set Dynamic PDO Selection state.");