On Thu, Mar 17, 2022 at 04:45:14PM +0100, Sebastian Krzyszkowiak wrote:
> From: Angus Ainslie <angus@xxxxxxxx>
>
> This allows to trace the negotiated contract as sink. It's
> only updated when the contract is actually established.
With the PDOs (and also RDO) I think we'll rely on the sysfs interface
that I mentioned once it's ready, but since this is only trace stuff, I
guess it's okay to take this in the mean time.
I in any case noticed one issue below...
> Co-developed-by: Guido Günther <agx@xxxxxxxxxxx>
> Signed-off-by: Guido Günther <agx@xxxxxxxxxxx>
> Signed-off-by: Angus Ainslie <angus@xxxxxxxx>
> Signed-off-by: Sebastian Krzyszkowiak <sebastian.krzyszkowiak@xxxxxxx>
> ---
> drivers/usb/typec/tipd/core.c | 63 ++++++++++++++++++++++++++++++-
> drivers/usb/typec/tipd/tps6598x.h | 30 +++++++++++++++
> drivers/usb/typec/tipd/trace.h | 38 +++++++++++++++++++
> 3 files changed, 129 insertions(+), 2 deletions(-)
>
> diff --git a/drivers/usb/typec/tipd/core.c b/drivers/usb/typec/tipd/core.c
> index f387786ff95e..80b4a9870caf 100644
> --- a/drivers/usb/typec/tipd/core.c
> +++ b/drivers/usb/typec/tipd/core.c
> @@ -34,6 +34,7 @@
> #define TPS_REG_STATUS 0x1a
> #define TPS_REG_SYSTEM_CONF 0x28
> #define TPS_REG_CTRL_CONF 0x29
> +#define TPS_REG_ACTIVE_CONTRACT 0x34
> #define TPS_REG_POWER_STATUS 0x3f
> #define TPS_REG_RX_IDENTITY_SOP 0x48
> #define TPS_REG_DATA_STATUS 0x5f
> @@ -93,6 +94,7 @@ struct tps6598x {
> struct power_supply *psy;
> struct power_supply_desc psy_desc;
> enum power_supply_usb_type usb_type;
> + struct tps6598x_pdo terms;
>
> u32 data_status;
> u16 pwr_status;
> @@ -528,6 +530,47 @@ static irqreturn_t cd321x_interrupt(int irq, void *data)
> return IRQ_NONE;
> }
>
> +static int tps6598x_get_active_pd_contract(struct tps6598x *tps)
> +{
> + u64 contract;
> + int type;
> + int max_power;
> + int ret = 0;
> +
> + ret = tps6598x_block_read(tps, TPS_REG_ACTIVE_CONTRACT, &contract, 6);
> + if (ret)
> + return ret;
> +
> + contract &= 0xFFFFFFFFFFFF;
> + type = TPS_PDO_CONTRACT_TYPE(contract);
> + memset(&tps->terms, 0, sizeof(struct tps6598x_pdo));
> +
> + /* If there's no PD it decodes to all 0 */
> + switch (type) {
> + case TPS_PDO_CONTRACT_FIXED:
> + tps->terms.max_voltage = TPS_PDO_FIXED_CONTRACT_VOLTAGE(contract);
> + tps->terms.max_current = TPS_PDO_FIXED_CONTRACT_MAX_CURRENT(contract);
> + break;
> + case TPS_PDO_CONTRACT_BATTERY:
> + tps->terms.max_voltage = TPS_PDO_BAT_CONTRACT_MAX_VOLTAGE(contract);
> + max_power = TPS_PDO_BAT_CONTRACT_MAX_POWER(contract);
> + tps->terms.max_current = 1000 * 1000 * max_power / tps->terms.max_voltage;
> + break;
> + case TPS_PDO_CONTRACT_VARIABLE:
> + tps->terms.max_voltage = TPS_PDO_VAR_CONTRACT_MAX_VOLTAGE(contract);
> + tps->terms.max_current = TPS_PDO_VAR_CONTRACT_MAX_CURRENT(contract);
> + break;
> + default:
> + dev_warn(tps->dev, "Unknown contract type: %d\n", type);
> + return -EINVAL;
> + }
> +
> + tps->terms.pdo = contract;
> + trace_tps6598x_pdo(&tps->terms);
> +
> + return 0;
> +}
> +
> static irqreturn_t tps6598x_interrupt(int irq, void *data)
> {
> struct tps6598x *tps = data;
> @@ -563,6 +606,14 @@ static irqreturn_t tps6598x_interrupt(int irq, void *data)
> tps6598x_update_data_status(tps, status);
> }
>
> + if ((event1 | event2) & TPS_REG_INT_NEW_CONTRACT_AS_CONSUMER) {
> + ret = tps6598x_get_active_pd_contract(tps);
> + if (ret) {
> + dev_err(tps->dev, "failed to read pd contract: %d\n", ret);
> + goto err_clear_ints;
> + }
> + }
> +
> /* Handle plug insert or removal */
> if ((event1 | event2) & TPS_REG_INT_PLUG_EVENT)
> tps6598x_handle_plug_event(tps, status);
> @@ -751,10 +802,11 @@ static int tps6598x_probe(struct i2c_client *client)
>
> irq_handler = cd321x_interrupt;
> } else {
> - /* Enable power status, data status and plug event interrupts */
> + /* Enable interrupts used by this driver */
> mask1 = TPS_REG_INT_POWER_STATUS_UPDATE |
> TPS_REG_INT_DATA_STATUS_UPDATE |
> - TPS_REG_INT_PLUG_EVENT;
> + TPS_REG_INT_PLUG_EVENT |
> + TPS_REG_INT_NEW_CONTRACT_AS_CONSUMER;
> }
>
> /* Make sure the controller has application firmware running */
> @@ -847,6 +899,13 @@ static int tps6598x_probe(struct i2c_client *client)
> ret = tps6598x_connect(tps, status);
> if (ret)
> dev_err(&client->dev, "failed to register partner\n");
> +
> + if ((TPS_POWER_STATUS_PWROPMODE(tps->pwr_status) == TYPEC_PWR_MODE_PD) &&
> + (!(status & TPS_STATUS_PORTROLE))) {
> + ret = tps6598x_get_active_pd_contract(tps);
> + if (ret)
> + dev_err(tps->dev, "failed to read pd contract: %d\n", ret);
> + }
> }
>
> ret = devm_request_threaded_irq(&client->dev, client->irq, NULL,
> diff --git a/drivers/usb/typec/tipd/tps6598x.h b/drivers/usb/typec/tipd/tps6598x.h
> index 527857549d69..546cd4881f1f 100644
> --- a/drivers/usb/typec/tipd/tps6598x.h
> +++ b/drivers/usb/typec/tipd/tps6598x.h
> @@ -199,4 +199,34 @@
> #define TPS_DATA_STATUS_DP_SPEC_PIN_ASSIGNMENT_A BIT(2)
> #define TPS_DATA_STATUS_DP_SPEC_PIN_ASSIGNMENT_B (BIT(2) | BIT(1))
>
> +
> +/* PDO decoding as in https://www.ti.com/lit/an/slva842/slva842.pdf */
> +#define TPS_PDO_CONTRACT_TYPE(x) FIELD_GET(GENMASK(31, 30), x)
> +#define TPS_PDO_CONTRACT_FIXED 0
> +#define TPS_PDO_CONTRACT_BATTERY 1
> +#define TPS_PDO_CONTRACT_VARIABLE 2
> +
> +#define TPS_PDO_FIXED_CONTRACT_DETAILS GENMASK(29, 25)
> +#define TPS_PDO_FIXED_CONTRACT_DR_POWER BIT(29)
> +#define TPS_PDO_FIXED_CONTRACT_USB_SUSPEND BIT(28)
> +#define TPS_PDO_FIXED_CONTRACT_EXTERNAL_PWR BIT(27)
> +#define TPS_PDO_FIXED_CONTRACT_USB_COMMS BIT(26)
> +#define TPS_PDO_FIXED_CONTRACT_DR_DATA BIT(25)
Those are already defined in include/linux/usb/pd.h
> +#define TPS_PDO_FIXED_CONTRACT_VOLTAGE(x) (FIELD_GET(GENMASK(19, 10), x) * 50000)
> +#define TPS_PDO_FIXED_CONTRACT_MAX_CURRENT(x) (FIELD_GET(GENMASK(9, 0), x) * 10000)
> +#define TPS_PDO_VAR_CONTRACT_MAX_VOLTAGE(x) (FIELD_GET(GENMASK(29, 20), x) * 50000)
> +#define TPS_PDO_VAR_CONTRACT_MIN_VOLTAGE(x) (FIELD_GET(GENMASK(19, 10), x) * 50000)
> +#define TPS_PDO_VAR_CONTRACT_MAX_CURRENT(x) (FIELD_GET(GENMASK(9, 0), x) * 10000)
> +#define TPS_PDO_BAT_CONTRACT_MAX_VOLTAGE(x) (FIELD_GET(GENMASK(29, 20), x) * 50000)
> +#define TPS_PDO_BAT_CONTRACT_MIN_VOLTAGE(x) (FIELD_GET(GENMASK(19, 10), x) * 50000)
> +#define TPS_PDO_BAT_CONTRACT_MAX_POWER(x) (FIELD_GET(GENMASK(9, 0), x) * 250000)
And I believe the same with these too.
> +struct tps6598x_pdo {
> + u32 pdo;
> + int max_voltage; /* uV */
> + int max_current; /* uA */
> + int max_power; /* uW */
> +};
> +
> #endif /* __TPS6598X_H__ */
> diff --git a/drivers/usb/typec/tipd/trace.h b/drivers/usb/typec/tipd/trace.h
> index 12cad1bde7cc..148e2ef3157b 100644
> --- a/drivers/usb/typec/tipd/trace.h
> +++ b/drivers/usb/typec/tipd/trace.h
> @@ -194,6 +194,20 @@
> (data_status & TPS_DATA_STATUS_DP_CONNECTION ? \
> show_data_status_dp_pin_assignment(data_status) : "")
>
> +#define show_pdo_contract_type(pdo) \
> + __print_symbolic(TPS_PDO_CONTRACT_TYPE(pdo), \
> + { TPS_PDO_CONTRACT_FIXED, "fixed" }, \
> + { TPS_PDO_CONTRACT_BATTERY, "battery" }, \
> + { TPS_PDO_CONTRACT_VARIABLE, "variable" })
> +
> +#define show_pdo_contract_details(pdo) \
> + __print_flags(pdo & TPS_PDO_FIXED_CONTRACT_DETAILS, "|", \
> + { TPS_PDO_FIXED_CONTRACT_DR_POWER, "dr-power" }, \
> + { TPS_PDO_FIXED_CONTRACT_USB_SUSPEND, "usb-suspend" }, \
> + { TPS_PDO_FIXED_CONTRACT_EXTERNAL_PWR, "ext-power" }, \
> + { TPS_PDO_FIXED_CONTRACT_USB_COMMS, "usb-comms" }, \
> + { TPS_PDO_FIXED_CONTRACT_DR_DATA, "dr-data" })
> +
> TRACE_EVENT(tps6598x_irq,
> TP_PROTO(u64 event1,
> u64 event2),
> @@ -296,6 +310,30 @@ TRACE_EVENT(tps6598x_data_status,
> )
> );
>
> +TRACE_EVENT(tps6598x_pdo,
> + TP_PROTO(struct tps6598x_pdo *pdo),
> + TP_ARGS(pdo),
> +
> + TP_STRUCT__entry(
> + __field(u32, pdo)
> + __field(int, max_current)
> + __field(int, max_voltage)
> + ),
> +
> + TP_fast_assign(
> + __entry->pdo = pdo->pdo;
> + __entry->max_current = pdo->max_current;
> + __entry->max_voltage = pdo->max_voltage;
> + ),
> +
> + TP_printk("%s supply, max %duA, %duV, details: %s",
> + show_pdo_contract_type(__entry->pdo),
> + __entry->max_current,
> + __entry->max_voltage,
> + show_pdo_contract_details(__entry->pdo)
> + )
> +);
> +
> #endif /* _TPS6598X_TRACE_H_ */
>
> /* This part must be outside protection */
thanks,
--
heikki
