On Wed, Oct 07, 2020 at 11:15:55PM -0700, Badhri Jagan Sridharan wrote: > vImplement callbacks for enabling/disabling > POWER_CONTROL.AutoDischargeDisconnect. > > Programs VBUS_SINK_DISCONNECT_THRESHOLD based on the > voltage requested as sink, mode of operation. > > The programmed threshold is based on vSinkDisconnect and > vSinkDisconnectPD values. > > Add auto_discharge_disconnect to tdata to allow TCPC chip > level drivers enable AutoDischargeDisconnect. > > Signed-off-by: Badhri Jagan Sridharan <[email protected]>
Reviewed-by: Heikki Krogerus <[email protected]> > --- > Changes since v1: > - Changing patch version to v6 to fix version number confusion. > > Changes since v6: > - Rebase on usb-next. > > Changes since v7: > Heikki's suggestion: > - Moved the actual write to TCPC_VBUS_SINK_DISCONNECT_THRESH > as it's common to all chip drivers. > - Renaming the tcpci_data callback as > get_auto_vbus_discharge_threshold > > Changes since v8: > - Removed get_auto_vbus_discharge_threshold callback and moved the logic > to program the default threshold for TCPC_VBUS_SINK_DISCONNECT_THRESH > into the TCPCI code. > > Changes since v9: > - none > --- > drivers/usb/typec/tcpm/tcpci.c | 63 +++++++++++++++++++++++++++++++++- > drivers/usb/typec/tcpm/tcpci.h | 14 ++++++-- > 2 files changed, 74 insertions(+), 3 deletions(-) > > diff --git a/drivers/usb/typec/tcpm/tcpci.c b/drivers/usb/typec/tcpm/tcpci.c > index f91688e43991..12d983a75510 100644 > --- a/drivers/usb/typec/tcpm/tcpci.c > +++ b/drivers/usb/typec/tcpm/tcpci.c > @@ -18,7 +18,10 @@ > > #include "tcpci.h" > > -#define PD_RETRY_COUNT 3 > +#define PD_RETRY_COUNT 3 > +#define AUTO_DISCHARGE_DEFAULT_THRESHOLD_MV 3500 > +#define AUTO_DISCHARGE_PD_HEADROOM_MV 850 > +#define AUTO_DISCHARGE_PPS_HEADROOM_MV 1250 > > struct tcpci { > struct device *dev; > @@ -268,6 +271,58 @@ static int tcpci_set_vconn(struct tcpc_dev *tcpc, bool > enable) > enable ? TCPC_POWER_CTRL_VCONN_ENABLE : 0); > } > > +static int tcpci_enable_auto_vbus_discharge(struct tcpc_dev *dev, bool > enable) > +{ > + struct tcpci *tcpci = tcpc_to_tcpci(dev); > + int ret; > + > + ret = regmap_update_bits(tcpci->regmap, TCPC_POWER_CTRL, > TCPC_POWER_CTRL_AUTO_DISCHARGE, > + enable ? TCPC_POWER_CTRL_AUTO_DISCHARGE : 0); > + return ret; > +} > + > +static int tcpci_set_auto_vbus_discharge_threshold(struct tcpc_dev *dev, > enum typec_pwr_opmode mode, > + bool pps_active, u32 > requested_vbus_voltage_mv) > +{ > + struct tcpci *tcpci = tcpc_to_tcpci(dev); > + unsigned int pwr_ctrl, threshold = 0; > + int ret; > + > + /* > + * Indicates that vbus is going to go away due PR_SWAP, hard reset etc. > + * Do not discharge vbus here. > + */ > + if (requested_vbus_voltage_mv == 0) > + goto write_thresh; > + > + ret = regmap_read(tcpci->regmap, TCPC_POWER_CTRL, &pwr_ctrl); > + if (ret < 0) > + return ret; > + > + if (pwr_ctrl & TCPC_FAST_ROLE_SWAP_EN) { > + /* To prevent disconnect when the source is fast role swap is > capable. */ > + threshold = AUTO_DISCHARGE_DEFAULT_THRESHOLD_MV; > + } else if (mode == TYPEC_PWR_MODE_PD) { > + if (pps_active) > + threshold = (95 * requested_vbus_voltage_mv / 100) - > + AUTO_DISCHARGE_PD_HEADROOM_MV; > + else > + threshold = (95 * requested_vbus_voltage_mv / 100) - > + AUTO_DISCHARGE_PPS_HEADROOM_MV; > + } else { > + /* 3.5V for non-pd sink */ > + threshold = AUTO_DISCHARGE_DEFAULT_THRESHOLD_MV; > + } > + > + threshold = threshold / TCPC_VBUS_SINK_DISCONNECT_THRESH_LSB_MV; > + > + if (threshold > TCPC_VBUS_SINK_DISCONNECT_THRESH_MAX) > + return -EINVAL; > + > +write_thresh: > + return tcpci_write16(tcpci, TCPC_VBUS_SINK_DISCONNECT_THRESH, > threshold); > +} > + > static int tcpci_enable_frs(struct tcpc_dev *dev, bool enable) > { > struct tcpci *tcpci = tcpc_to_tcpci(dev); > @@ -638,6 +693,12 @@ struct tcpci *tcpci_register_port(struct device *dev, > struct tcpci_data *data) > tcpci->tcpc.enable_frs = tcpci_enable_frs; > tcpci->tcpc.frs_sourcing_vbus = tcpci_frs_sourcing_vbus; > > + if (tcpci->data->auto_discharge_disconnect) { > + tcpci->tcpc.enable_auto_vbus_discharge = > tcpci_enable_auto_vbus_discharge; > + tcpci->tcpc.set_auto_vbus_discharge_threshold = > + tcpci_set_auto_vbus_discharge_threshold; > + } > + > err = tcpci_parse_config(tcpci); > if (err < 0) > return ERR_PTR(err); > diff --git a/drivers/usb/typec/tcpm/tcpci.h b/drivers/usb/typec/tcpm/tcpci.h > index b418fe11b527..3fe313655f0c 100644 > --- a/drivers/usb/typec/tcpm/tcpci.h > +++ b/drivers/usb/typec/tcpm/tcpci.h > @@ -8,6 +8,8 @@ > #ifndef __LINUX_USB_TCPCI_H > #define __LINUX_USB_TCPCI_H > > +#include <linux/usb/typec.h> > + > #define TCPC_VENDOR_ID 0x0 > #define TCPC_PRODUCT_ID 0x2 > #define TCPC_BCD_DEV 0x4 > @@ -67,6 +69,7 @@ > > #define TCPC_POWER_CTRL 0x1c > #define TCPC_POWER_CTRL_VCONN_ENABLE BIT(0) > +#define TCPC_POWER_CTRL_AUTO_DISCHARGE BIT(4) > #define TCPC_FAST_ROLE_SWAP_EN BIT(7) > > #define TCPC_CC_STATUS 0x1d > @@ -133,6 +136,8 @@ > > #define TCPC_VBUS_VOLTAGE 0x70 > #define TCPC_VBUS_SINK_DISCONNECT_THRESH 0x72 > +#define TCPC_VBUS_SINK_DISCONNECT_THRESH_LSB_MV 25 > +#define TCPC_VBUS_SINK_DISCONNECT_THRESH_MAX 0x3ff > #define TCPC_VBUS_STOP_DISCHARGE_THRESH 0x74 > #define TCPC_VBUS_VOLTAGE_ALARM_HI_CFG 0x76 > #define TCPC_VBUS_VOLTAGE_ALARM_LO_CFG 0x78 > @@ -140,17 +145,22 @@ > /* I2C_WRITE_BYTE_COUNT + 1 when TX_BUF_BYTE_x is only accessible > I2C_WRITE_BYTE_COUNT */ > #define TCPC_TRANSMIT_BUFFER_MAX_LEN 31 > > +struct tcpci; > + > /* > - * @TX_BUF_BYTE_x_hidden > + * @TX_BUF_BYTE_x_hidden: > * optional; Set when TX_BUF_BYTE_x can only be accessed through > I2C_WRITE_BYTE_COUNT. > * @frs_sourcing_vbus: > * Optional; Callback to perform chip specific operations when FRS > * is sourcing vbus. > + * @auto_discharge_disconnect: > + * Optional; Enables TCPC to autonously discharge vbus on > disconnect. > */ > -struct tcpci; > struct tcpci_data { > struct regmap *regmap; > unsigned char TX_BUF_BYTE_x_hidden:1; > + unsigned char auto_discharge_disconnect:1; > + > int (*init)(struct tcpci *tcpci, struct tcpci_data *data); > int (*set_vconn)(struct tcpci *tcpci, struct tcpci_data *data, > bool enable); > -- > 2.28.0.806.g8561365e88-goog -- heikki
