usb: typec: tcpm: add get max power support

Traverse fixed pdos to calculate the maximum power that the charger
can provide, and it can be get by POWER_SUPPLY_PROP_INPUT_POWER_LIMIT
property.

Signed-off-by: Frank Wang <frank.wang@rock-chips.com>
Change-Id: I3533beaa2eb2482de371c271db3f601d50e1be73
This commit is contained in:
Frank Wang
2022-07-04 11:46:12 +08:00
committed by Tao Huang
parent 0373c12d82
commit 18ef66dbd8

View File

@@ -6294,6 +6294,27 @@ static int tcpm_psy_get_current_now(struct tcpm_port *port,
return 0;
}
static int tcpm_psy_get_input_power_limit(struct tcpm_port *port,
union power_supply_propval *val)
{
unsigned int src_mv, src_ma, max_src_mw = 0;
unsigned int i, tmp;
for (i = 0; i < port->nr_source_caps; i++) {
u32 pdo = port->source_caps[i];
if (pdo_type(pdo) == PDO_TYPE_FIXED) {
src_mv = pdo_fixed_voltage(pdo);
src_ma = pdo_max_current(pdo);
tmp = src_mv * src_ma / 1000;
max_src_mw = tmp > max_src_mw ? tmp : max_src_mw;
}
}
val->intval = max_src_mw;
return 0;
}
static int tcpm_psy_get_prop(struct power_supply *psy,
enum power_supply_property psp,
union power_supply_propval *val)
@@ -6323,6 +6344,9 @@ static int tcpm_psy_get_prop(struct power_supply *psy,
case POWER_SUPPLY_PROP_CURRENT_NOW:
ret = tcpm_psy_get_current_now(port, val);
break;
case POWER_SUPPLY_PROP_INPUT_POWER_LIMIT:
tcpm_psy_get_input_power_limit(port, val);
break;
default:
ret = -EINVAL;
break;