mirror of
https://github.com/torvalds/linux.git
synced 2026-06-07 22:14:04 +02:00
usb: typec: tcpm: Address incorrect values of tcpm psy for pps supply
commite3a0720224upstream. tcpm_pd_select_pps_apdo overwrites port->pps_data.min_volt, port->pps_data.max_volt, port->pps_data.max_curr even before port partner accepts the requests. This leaves incorrect values in current_limit and supply_voltage that get exported by "tcpm-source-psy-". Solving this problem by caching the request values in req_min_volt, req_max_volt, req_max_curr, req_out_volt, req_op_curr. min_volt, max_volt, max_curr gets updated once the partner accepts the request. current_limit, supply_voltage gets updated once local port's tcpm enters SNK_TRANSITION_SINK when the accepted current_limit and supply_voltage is enforced. Fixes:f2a8aa053c("typec: tcpm: Represent source supply through power_supply") Signed-off-by: Badhri Jagan Sridharan <badhri@google.com> Cc: stable <stable@vger.kernel.org> Reviewed-by: Adam Thomson <Adam.Thomson.Opensource@diasemi.com> Reviewed-by: Heikki Krogerus <heikki.krogerus@linux.intel.com> Link: https://lore.kernel.org/r/20210407200723.1914388-2-badhri@google.com Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
79cae796db
commit
61a4b925aa
|
|
@ -218,12 +218,27 @@ struct pd_mode_data {
|
||||||
struct typec_altmode_desc altmode_desc[ALTMODE_DISCOVERY_MAX];
|
struct typec_altmode_desc altmode_desc[ALTMODE_DISCOVERY_MAX];
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* @min_volt: Actual min voltage at the local port
|
||||||
|
* @req_min_volt: Requested min voltage to the port partner
|
||||||
|
* @max_volt: Actual max voltage at the local port
|
||||||
|
* @req_max_volt: Requested max voltage to the port partner
|
||||||
|
* @max_curr: Actual max current at the local port
|
||||||
|
* @req_max_curr: Requested max current of the port partner
|
||||||
|
* @req_out_volt: Requested output voltage to the port partner
|
||||||
|
* @req_op_curr: Requested operating current to the port partner
|
||||||
|
* @supported: Parter has atleast one APDO hence supports PPS
|
||||||
|
* @active: PPS mode is active
|
||||||
|
*/
|
||||||
struct pd_pps_data {
|
struct pd_pps_data {
|
||||||
u32 min_volt;
|
u32 min_volt;
|
||||||
|
u32 req_min_volt;
|
||||||
u32 max_volt;
|
u32 max_volt;
|
||||||
|
u32 req_max_volt;
|
||||||
u32 max_curr;
|
u32 max_curr;
|
||||||
u32 out_volt;
|
u32 req_max_curr;
|
||||||
u32 op_curr;
|
u32 req_out_volt;
|
||||||
|
u32 req_op_curr;
|
||||||
bool supported;
|
bool supported;
|
||||||
bool active;
|
bool active;
|
||||||
};
|
};
|
||||||
|
|
@ -1919,8 +1934,8 @@ static void tcpm_pd_ctrl_request(struct tcpm_port *port,
|
||||||
break;
|
break;
|
||||||
case SNK_NEGOTIATE_PPS_CAPABILITIES:
|
case SNK_NEGOTIATE_PPS_CAPABILITIES:
|
||||||
/* Revert data back from any requested PPS updates */
|
/* Revert data back from any requested PPS updates */
|
||||||
port->pps_data.out_volt = port->supply_voltage;
|
port->pps_data.req_out_volt = port->supply_voltage;
|
||||||
port->pps_data.op_curr = port->current_limit;
|
port->pps_data.req_op_curr = port->current_limit;
|
||||||
port->pps_status = (type == PD_CTRL_WAIT ?
|
port->pps_status = (type == PD_CTRL_WAIT ?
|
||||||
-EAGAIN : -EOPNOTSUPP);
|
-EAGAIN : -EOPNOTSUPP);
|
||||||
tcpm_set_state(port, SNK_READY, 0);
|
tcpm_set_state(port, SNK_READY, 0);
|
||||||
|
|
@ -1959,8 +1974,11 @@ static void tcpm_pd_ctrl_request(struct tcpm_port *port,
|
||||||
break;
|
break;
|
||||||
case SNK_NEGOTIATE_PPS_CAPABILITIES:
|
case SNK_NEGOTIATE_PPS_CAPABILITIES:
|
||||||
port->pps_data.active = true;
|
port->pps_data.active = true;
|
||||||
port->req_supply_voltage = port->pps_data.out_volt;
|
port->pps_data.min_volt = port->pps_data.req_min_volt;
|
||||||
port->req_current_limit = port->pps_data.op_curr;
|
port->pps_data.max_volt = port->pps_data.req_max_volt;
|
||||||
|
port->pps_data.max_curr = port->pps_data.req_max_curr;
|
||||||
|
port->req_supply_voltage = port->pps_data.req_out_volt;
|
||||||
|
port->req_current_limit = port->pps_data.req_op_curr;
|
||||||
tcpm_set_state(port, SNK_TRANSITION_SINK, 0);
|
tcpm_set_state(port, SNK_TRANSITION_SINK, 0);
|
||||||
break;
|
break;
|
||||||
case SOFT_RESET_SEND:
|
case SOFT_RESET_SEND:
|
||||||
|
|
@ -2477,16 +2495,16 @@ static unsigned int tcpm_pd_select_pps_apdo(struct tcpm_port *port)
|
||||||
src = port->source_caps[src_pdo];
|
src = port->source_caps[src_pdo];
|
||||||
snk = port->snk_pdo[snk_pdo];
|
snk = port->snk_pdo[snk_pdo];
|
||||||
|
|
||||||
port->pps_data.min_volt = max(pdo_pps_apdo_min_voltage(src),
|
port->pps_data.req_min_volt = max(pdo_pps_apdo_min_voltage(src),
|
||||||
pdo_pps_apdo_min_voltage(snk));
|
pdo_pps_apdo_min_voltage(snk));
|
||||||
port->pps_data.max_volt = min(pdo_pps_apdo_max_voltage(src),
|
port->pps_data.req_max_volt = min(pdo_pps_apdo_max_voltage(src),
|
||||||
pdo_pps_apdo_max_voltage(snk));
|
pdo_pps_apdo_max_voltage(snk));
|
||||||
port->pps_data.max_curr = min_pps_apdo_current(src, snk);
|
port->pps_data.req_max_curr = min_pps_apdo_current(src, snk);
|
||||||
port->pps_data.out_volt = min(port->pps_data.max_volt,
|
port->pps_data.req_out_volt = min(port->pps_data.max_volt,
|
||||||
max(port->pps_data.min_volt,
|
max(port->pps_data.min_volt,
|
||||||
port->pps_data.out_volt));
|
port->pps_data.req_out_volt));
|
||||||
port->pps_data.op_curr = min(port->pps_data.max_curr,
|
port->pps_data.req_op_curr = min(port->pps_data.max_curr,
|
||||||
port->pps_data.op_curr);
|
port->pps_data.req_op_curr);
|
||||||
power_supply_changed(port->psy);
|
power_supply_changed(port->psy);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -2614,10 +2632,10 @@ static int tcpm_pd_build_pps_request(struct tcpm_port *port, u32 *rdo)
|
||||||
tcpm_log(port, "Invalid APDO selected!");
|
tcpm_log(port, "Invalid APDO selected!");
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
max_mv = port->pps_data.max_volt;
|
max_mv = port->pps_data.req_max_volt;
|
||||||
max_ma = port->pps_data.max_curr;
|
max_ma = port->pps_data.req_max_curr;
|
||||||
out_mv = port->pps_data.out_volt;
|
out_mv = port->pps_data.req_out_volt;
|
||||||
op_ma = port->pps_data.op_curr;
|
op_ma = port->pps_data.req_op_curr;
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
tcpm_log(port, "Invalid PDO selected!");
|
tcpm_log(port, "Invalid PDO selected!");
|
||||||
|
|
@ -2664,8 +2682,8 @@ static int tcpm_pd_build_pps_request(struct tcpm_port *port, u32 *rdo)
|
||||||
tcpm_log(port, "Requesting APDO %d: %u mV, %u mA",
|
tcpm_log(port, "Requesting APDO %d: %u mV, %u mA",
|
||||||
src_pdo_index, out_mv, op_ma);
|
src_pdo_index, out_mv, op_ma);
|
||||||
|
|
||||||
port->pps_data.op_curr = op_ma;
|
port->pps_data.req_op_curr = op_ma;
|
||||||
port->pps_data.out_volt = out_mv;
|
port->pps_data.req_out_volt = out_mv;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
@ -4506,7 +4524,7 @@ static int tcpm_try_role(struct typec_port *p, int role)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int tcpm_pps_set_op_curr(struct tcpm_port *port, u16 op_curr)
|
static int tcpm_pps_set_op_curr(struct tcpm_port *port, u16 req_op_curr)
|
||||||
{
|
{
|
||||||
unsigned int target_mw;
|
unsigned int target_mw;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
@ -4524,22 +4542,22 @@ static int tcpm_pps_set_op_curr(struct tcpm_port *port, u16 op_curr)
|
||||||
goto port_unlock;
|
goto port_unlock;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (op_curr > port->pps_data.max_curr) {
|
if (req_op_curr > port->pps_data.max_curr) {
|
||||||
ret = -EINVAL;
|
ret = -EINVAL;
|
||||||
goto port_unlock;
|
goto port_unlock;
|
||||||
}
|
}
|
||||||
|
|
||||||
target_mw = (op_curr * port->pps_data.out_volt) / 1000;
|
target_mw = (req_op_curr * port->supply_voltage) / 1000;
|
||||||
if (target_mw < port->operating_snk_mw) {
|
if (target_mw < port->operating_snk_mw) {
|
||||||
ret = -EINVAL;
|
ret = -EINVAL;
|
||||||
goto port_unlock;
|
goto port_unlock;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Round down operating current to align with PPS valid steps */
|
/* Round down operating current to align with PPS valid steps */
|
||||||
op_curr = op_curr - (op_curr % RDO_PROG_CURR_MA_STEP);
|
req_op_curr = req_op_curr - (req_op_curr % RDO_PROG_CURR_MA_STEP);
|
||||||
|
|
||||||
reinit_completion(&port->pps_complete);
|
reinit_completion(&port->pps_complete);
|
||||||
port->pps_data.op_curr = op_curr;
|
port->pps_data.req_op_curr = req_op_curr;
|
||||||
port->pps_status = 0;
|
port->pps_status = 0;
|
||||||
port->pps_pending = true;
|
port->pps_pending = true;
|
||||||
tcpm_set_state(port, SNK_NEGOTIATE_PPS_CAPABILITIES, 0);
|
tcpm_set_state(port, SNK_NEGOTIATE_PPS_CAPABILITIES, 0);
|
||||||
|
|
@ -4561,7 +4579,7 @@ static int tcpm_pps_set_op_curr(struct tcpm_port *port, u16 op_curr)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int tcpm_pps_set_out_volt(struct tcpm_port *port, u16 out_volt)
|
static int tcpm_pps_set_out_volt(struct tcpm_port *port, u16 req_out_volt)
|
||||||
{
|
{
|
||||||
unsigned int target_mw;
|
unsigned int target_mw;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
@ -4579,23 +4597,23 @@ static int tcpm_pps_set_out_volt(struct tcpm_port *port, u16 out_volt)
|
||||||
goto port_unlock;
|
goto port_unlock;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (out_volt < port->pps_data.min_volt ||
|
if (req_out_volt < port->pps_data.min_volt ||
|
||||||
out_volt > port->pps_data.max_volt) {
|
req_out_volt > port->pps_data.max_volt) {
|
||||||
ret = -EINVAL;
|
ret = -EINVAL;
|
||||||
goto port_unlock;
|
goto port_unlock;
|
||||||
}
|
}
|
||||||
|
|
||||||
target_mw = (port->pps_data.op_curr * out_volt) / 1000;
|
target_mw = (port->current_limit * req_out_volt) / 1000;
|
||||||
if (target_mw < port->operating_snk_mw) {
|
if (target_mw < port->operating_snk_mw) {
|
||||||
ret = -EINVAL;
|
ret = -EINVAL;
|
||||||
goto port_unlock;
|
goto port_unlock;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Round down output voltage to align with PPS valid steps */
|
/* Round down output voltage to align with PPS valid steps */
|
||||||
out_volt = out_volt - (out_volt % RDO_PROG_VOLT_MV_STEP);
|
req_out_volt = req_out_volt - (req_out_volt % RDO_PROG_VOLT_MV_STEP);
|
||||||
|
|
||||||
reinit_completion(&port->pps_complete);
|
reinit_completion(&port->pps_complete);
|
||||||
port->pps_data.out_volt = out_volt;
|
port->pps_data.req_out_volt = req_out_volt;
|
||||||
port->pps_status = 0;
|
port->pps_status = 0;
|
||||||
port->pps_pending = true;
|
port->pps_pending = true;
|
||||||
tcpm_set_state(port, SNK_NEGOTIATE_PPS_CAPABILITIES, 0);
|
tcpm_set_state(port, SNK_NEGOTIATE_PPS_CAPABILITIES, 0);
|
||||||
|
|
@ -4644,8 +4662,8 @@ static int tcpm_pps_activate(struct tcpm_port *port, bool activate)
|
||||||
|
|
||||||
/* Trigger PPS request or move back to standard PDO contract */
|
/* Trigger PPS request or move back to standard PDO contract */
|
||||||
if (activate) {
|
if (activate) {
|
||||||
port->pps_data.out_volt = port->supply_voltage;
|
port->pps_data.req_out_volt = port->supply_voltage;
|
||||||
port->pps_data.op_curr = port->current_limit;
|
port->pps_data.req_op_curr = port->current_limit;
|
||||||
tcpm_set_state(port, SNK_NEGOTIATE_PPS_CAPABILITIES, 0);
|
tcpm_set_state(port, SNK_NEGOTIATE_PPS_CAPABILITIES, 0);
|
||||||
} else {
|
} else {
|
||||||
tcpm_set_state(port, SNK_NEGOTIATE_CAPABILITIES, 0);
|
tcpm_set_state(port, SNK_NEGOTIATE_CAPABILITIES, 0);
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue
Block a user