From patchwork Thu Feb 3 14:46:55 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Heikki Krogerus X-Patchwork-Id: 539826 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id CB18CC433EF for ; Thu, 3 Feb 2022 14:46:53 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1351342AbiBCOqw (ORCPT ); Thu, 3 Feb 2022 09:46:52 -0500 Received: from mga06.intel.com ([134.134.136.31]:37909 "EHLO mga06.intel.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1351337AbiBCOqt (ORCPT ); Thu, 3 Feb 2022 09:46:49 -0500 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=intel.com; i=@intel.com; q=dns/txt; s=Intel; t=1643899609; x=1675435609; h=from:to:cc:subject:date:message-id:in-reply-to: references:mime-version:content-transfer-encoding; bh=xmPUnvWYY95aUtqvJ3oWJMhLqj0UrqBApxDxiNKGOl8=; b=KlgT7AIt7D4f7X/JVVLoTClqLXjDU/0dVV5seQvJ26WKXaGxaqO8rpGv zPzPZIOcImA7/VLe3cXDuRtNPAUABgJ0QCHoSWN3T808PMRFIefxqeheE Yz5giP1gyfJUIFI/lm2NxsPcKQ1C9uW+TNp41GLoAQy7+gG6p1R5EtXaq BHIj/uqCVO0vkhIn6okScxt94QTv67YGHh+1y/aTQC4/KeNO0bfGhcYPQ 0ra0kZaYAT2yZ0IlF/N3AwF//q3GrUwjcYbK68wrH0+mMBH8npJLx0A4A AtrwoyQqJ1zFo/7okOzPDCcPMH63+gA3ZkQ+c7bZ8bjxP0wjlbIlFaJIA w==; X-IronPort-AV: E=McAfee;i="6200,9189,10246"; a="308883006" X-IronPort-AV: E=Sophos;i="5.88,340,1635231600"; d="scan'208";a="308883006" Received: from fmsmga001.fm.intel.com ([10.253.24.23]) by orsmga104.jf.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 03 Feb 2022 06:46:48 -0800 X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="5.88,340,1635231600"; d="scan'208";a="676788147" Received: from black.fi.intel.com (HELO black.fi.intel.com.) ([10.237.72.28]) by fmsmga001.fm.intel.com with ESMTP; 03 Feb 2022 06:46:45 -0800 From: Heikki Krogerus To: Greg Kroah-Hartman Cc: Guenter Roeck , Benson Leung , Prashant Malani , Jameson Thies , "Regupathy, Rajaram" , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH v1 1/3] usb: typec: Separate USB Power Delivery from USB Type-C Date: Thu, 3 Feb 2022 17:46:55 +0300 Message-Id: <20220203144657.16527-2-heikki.krogerus@linux.intel.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: <20220203144657.16527-1-heikki.krogerus@linux.intel.com> References: <20220203144657.16527-1-heikki.krogerus@linux.intel.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-usb@vger.kernel.org Introducing a separate sysfs directory "usb_power_delivery" for the devices. This directory should be used to expose all the USB Power Delivery (USB PD) objects and other details a device supports from now on. Initially only USB Type-C devices can expose their USB Power Delivery capabilities, but later any device attached to the USB bus may potentially be able to expose them too. That is already possible with devices that support the USB Type-C Bridge standard. The API that is introduced here that can be used to register the USB PD support does not depend on USB Type-C devices, but it is made part of USB Type-C Connector Class for now. First adding support for registration of the Power Data Objects (PDO) that are part of the Source_Capabilities and Sink_Capabilities Messages. The content of the Request Message will likely follow soon. Signed-off-by: Heikki Krogerus --- .../testing/sysfs-devices-usb_power_delivery | 273 ++++++++ drivers/usb/typec/Makefile | 2 +- drivers/usb/typec/pd.c | 651 ++++++++++++++++++ drivers/usb/typec/pd.h | 39 ++ include/linux/usb/pd.h | 30 + include/linux/usb/typec.h | 10 + 6 files changed, 1004 insertions(+), 1 deletion(-) create mode 100644 Documentation/ABI/testing/sysfs-devices-usb_power_delivery create mode 100644 drivers/usb/typec/pd.c create mode 100644 drivers/usb/typec/pd.h diff --git a/Documentation/ABI/testing/sysfs-devices-usb_power_delivery b/Documentation/ABI/testing/sysfs-devices-usb_power_delivery new file mode 100644 index 0000000000000..10b005e8e315a --- /dev/null +++ b/Documentation/ABI/testing/sysfs-devices-usb_power_delivery @@ -0,0 +1,273 @@ +What: /sys/devices/.../usb_power_delivery +Date: February 2022 +Contact: Heikki Krogerus +Description: + Directory containing details about the USB Power Delivery + support of given device. + + When representing the USB Power Delivery Messages, if the + message can contain multiple objects (like the capabilities + messages - Source_Capabilities and Sink_Capabilities), each + message will have its own sub-directory and that sub-directory + will then have a separate folder for each object. + + usb_power_delivery/// + + Otherwise the sub-directory will be for the object itself (for + example the Battery Status Message can only contain a single + Battery Status Data Object). + + usb_power_delivery// + +What: /sys/devices/.../usb_power_delivery/revision +Date: February 2022 +Contact: Heikki Krogerus +Description: + File showing the USB Power Delivery Specification Revision used + in communication. + +What: /sys/devices/.../usb_power_delivery/version +Date: February 2022 +Contact: Heikki Krogerus +Description: + This is an optional attribute file showing the version of the + specific revision of the USB Power Delivery Specification that + the device supports. In most cases the specification version is + not known and the file is not available. + +What: /sys/devices/.../usb_power_delivery/source_capabilities +Date: February 2022 +Contact: Heikki Krogerus +Description: + Directory containing the source capabilities for a given USB + Power Delivery capable device. Ports on a system can have + multiple sets of source capabilities defined for them. The first + directory is always named "source_capabilities" (index 0), but + starting from the second capabilities set the index number is + added to the directory name ("source_capabilities", + "source-capabillities1", ...). + + The source capabilities message "Source_Capabilities" contains a + set of Power Data Objects (PDO), each representing a type of + power supply the device supports. The order of the PDO objects + is defined in USB Power Delivery Specification. Each object in + this directory will have the object position number as the first + character followed by the object type name (":" as delimiter). + + /sys/devices/.../usb_power_delivery//: + +What: /sys/devices/.../usb_power_delivery/sink_capabilities +Date: February 2022 +Contact: Heikki Krogerus +Description: + Directory containing the sink capabilities of a given USB Power + Delivery capable device. Ports on a system can have multiple + sets of sink capabilities defined for them. The first directory + is always named "sink_capabilities" (index 0), but starting from + the second set the index number is added to the directory name + ("sink_capabilities", "sink_capabilities1", ...). + + The sink capability message "Sink_Capabilities" contains a set + of Power Data Objects (PDO) just like with source capabilities, + but instead of describing the power capabilities, these objects + describe the power requirements the device has for each type of + object. + + The order of the objects in the sink capability message is the + same as it's in the source capabilities message. + +Fixed Supply Data Objects + +What: /sys/devices/.../usb_power_delivery//:fixed_supply +Date: February 2022 +Contact: Heikki Krogerus +Description: + Directory containing the attributes (the bit fields) defined for + Fixed Supply PDO. + + The directory "1:fixed_supply" is special. USB Power Delivery + Specification dictates that the first PDO (at object position + 1), and the only mandatory PDO, is always the vSafe5V Fixed + Supply Object. vSafe5V Object has additional fields defined for + it that the other Fixed Supply Objects do not have and that are + related to the USB capabilities rather than power capabilities. + +What: /sys/devices/.../usb_power_delivery//1:fixed_supply/dual_role_power +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file contains boolean value that tells does the device + support both source and sink power roles. + +What: /sys/devices/.../usb_power_delivery//1:fixed_supply/usb_suspend_supported +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file shows the value of the USB Suspend Supported bit in + vSafe5V Fixed Supply Object. If the bit is set then the device + will follow the USB 2.0 and USB 3.2 rules for suspend and + resume. + +What: /sys/devices/.../usb_power_delivery//1:fixed_supply/unconstrained_power +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file shows the value of the Unconstrained Power bit in + vSafe5V Fixed Supply Object. The bit is set when an external + source of power, powerful enough to power the entire system on + its own, is available for the device. + +What: /sys/devices/.../usb_power_delivery//1:fixed_supply/usb_communication_capable +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file shows the value of the USB Communication Capable bit in + vSafe5V Fixed Supply Object. + +What: /sys/devices/.../usb_power_delivery//1:fixed_supply/dual_role_data +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file shows the value of the Dual-Role Data bit in vSafe5V + Fixed Supply Object. Dual role data means ability act as both + USB host and USB device. + +What: /sys/devices/.../usb_power_delivery//1:fixed_supply/unchunked_extended_messages_supported +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file shows the value of the Unchunked Extended Messages + Supported bit in vSafe5V Fixed Supply Object. + +What: /sys/devices/.../usb_power_delivery//:fixed_supply/voltage +Date: February 2022 +Contact: Heikki Krogerus +Description: + The voltage the supply supports in millivolts. + +What: /sys/devices/.../usb_power_delivery/source_capabilities/:fixed_supply/maximum_current +Date: February 2022 +Contact: Heikki Krogerus +Description: + Maximum current of the fixed source supply in milliamperes. + +What: /sys/devices/.../usb_power_delivery/sink_capabilities/:fixed_supply/operational_current +Date: February 2022 +Contact: Heikki Krogerus +Description: + Operational current of the sink in milliamperes. + +What: /sys/devices/.../usb_power_delivery/sink_capabilities/:fixed_supply/fast_role_swap_current +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file contains the value of the "Fast Role Swap USB Type-C + Current" field that tells the current level the sink requires + after a Fast Role Swap. + 0 - Fast Swap not supported" + 1 - Default USB Power" + 2 - 1.5A@5V" + 3 - 3.0A@5V" + +Variable Supply Data Objects + +What: /sys/devices/.../usb_power_delivery//:variable_supply +Date: February 2022 +Contact: Heikki Krogerus +Description: + Directory containing the attributes (the bit fields) defined for + Variable Supply PDO. + +What: /sys/devices/.../usb_power_delivery//:variable_supply/maximum_voltage +Date: February 2022 +Contact: Heikki Krogerus +Description: + Maximum Voltage in millivolts. + +What: /sys/devices/.../usb_power_delivery//:variable_supply/minimum_voltage +Date: February 2022 +Contact: Heikki Krogerus +Description: + Minimum Voltage in millivolts. + +What: /sys/devices/.../usb_power_delivery/source_capabilities/:variable_supply/maximum_current +Date: February 2022 +Contact: Heikki Krogerus +Description: + The maximum current in milliamperes that the source can supply + at the given Voltage range. + +What: /sys/devices/.../usb_power_delivery/sink_capabilities/:variable_supply/operational_current +Date: February 2022 +Contact: Heikki Krogerus +Description: + The operational current in milliamperes that the sink requires + at the given Voltage range. + +Battery Supply Data Objects + +What: /sys/devices/.../usb_power_delivery//:battery +Date: February 2022 +Contact: Heikki Krogerus +Description: + Directory containing the attributes (the bit fields) defined for + Battery PDO. + +What: /sys/devices/.../usb_power_delivery//:battery/maximum_voltage +Date: February 2022 +Contact: Heikki Krogerus +Description: + Maximum Voltage in millivolts. + +What: /sys/devices/.../usb_power_delivery//:battery/minimum_voltage +Date: February 2022 +Contact: Heikki Krogerus +Description: + Minimum Voltage in millivolts. + +What: /sys/devices/.../usb_power_delivery/source_capabilities/:battery/maximum_power +Date: February 2022 +Contact: Heikki Krogerus +Description: + Maximum allowable Power in milliwatts. + +What: /sys/devices/.../usb_power_delivery/sink_capabilities/:battery/operational_power +Date: February 2022 +Contact: Heikki Krogerus +Description: + The operational power that the sink requires at the given + voltage range. + +Standard Power Range (SPR) Programmable Power Supply Objects + +What: /sys/devices/.../usb_power_delivery//:programmable_supply +Date: February 2022 +Contact: Heikki Krogerus +Description: + Directory containing the attributes (the bit fields) defined for + Programmable Power Supply (PPS) Augmented PDO (APDO). + +What: /sys/devices/.../usb_power_delivery//:programmable_supply/maximum_voltage +Date: February 2022 +Contact: Heikki Krogerus +Description: + Maximum Voltage in millivolts. + +What: /sys/devices/.../usb_power_delivery//:programmable_supply/minimum_voltage +Date: February 2022 +Contact: Heikki Krogerus +Description: + Minimum Voltage in millivolts. + +What: /sys/devices/.../usb_power_delivery//:programmable_supply/maximum_current +Date: February 2022 +Contact: Heikki Krogerus +Description: + Maximum Current in milliamperes. + +What: /sys/devices/.../usb_power_delivery/source_capabilities/:programmable_supply/pps_power_limited +Date: February 2022 +Contact: Heikki Krogerus +Description: + The PPS Power Limited bit indicates whether or not the source + supply will exceed the rated output power if requested. diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile index 57870a2bd7873..4b71a1f5c7e87 100644 --- a/drivers/usb/typec/Makefile +++ b/drivers/usb/typec/Makefile @@ -1,6 +1,6 @@ # SPDX-License-Identifier: GPL-2.0 obj-$(CONFIG_TYPEC) += typec.o -typec-y := class.o mux.o bus.o +typec-y := class.o mux.o bus.o pd.o typec-$(CONFIG_ACPI) += port-mapper.o obj-$(CONFIG_TYPEC) += altmodes/ obj-$(CONFIG_TYPEC_TCPM) += tcpm/ diff --git a/drivers/usb/typec/pd.c b/drivers/usb/typec/pd.c new file mode 100644 index 0000000000000..b2f0d677a6bce --- /dev/null +++ b/drivers/usb/typec/pd.c @@ -0,0 +1,651 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * USB Power Delivery sysfs entries + * + * Copyright (C) 2022, Intel Corporation + * Author: Heikki Krogerus + */ + +#include +#include +#include + +#include "pd.h" + +#define to_pdo(o) container_of(o, struct pdo, kobj) + +struct pdo { + struct kobject kobj; + int object_position; + u32 pdo; + struct list_head node; +}; + +static void pdo_release(struct kobject *kobj) +{ + kfree(to_pdo(kobj)); +} + +/* -------------------------------------------------------------------------- */ +/* Fixed Supply */ + +static ssize_t +dual_role_power_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", !!(to_pdo(kobj)->pdo & PDO_FIXED_DUAL_ROLE)); +} + +static ssize_t +usb_suspend_supported_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", !!(to_pdo(kobj)->pdo & PDO_FIXED_SUSPEND)); +} + +static ssize_t +unconstrained_power_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", !!(to_pdo(kobj)->pdo & PDO_FIXED_EXTPOWER)); +} + +static ssize_t +usb_communication_capable_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", !!(to_pdo(kobj)->pdo & PDO_FIXED_USB_COMM)); +} + +static ssize_t +dual_role_data_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", !!(to_pdo(kobj)->pdo & PDO_FIXED_DATA_SWAP)); +} + +static ssize_t +unchunked_extended_messages_supported_show(struct kobject *kobj, + struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", !!(to_pdo(kobj)->pdo & PDO_FIXED_UNCHUNK_EXT)); +} + +/* + * REVISIT: Peak Current requires access also to the RDO. +static ssize_t +peak_current_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + ... +} +*/ + +static ssize_t +fast_role_swap_current_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", to_pdo(kobj)->pdo >> PDO_FIXED_FRS_CURR_SHIFT) & 3; +} + +static ssize_t +voltage_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umV\n", pdo_fixed_voltage(to_pdo(kobj)->pdo)); +} + +/* Shared with Variable supplies, both source and sink */ +static ssize_t current_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umA\n", pdo_max_current(to_pdo(kobj)->pdo)); +} + +/* These additional details are only available with vSafe5V supplies */ +static struct kobj_attribute dual_role_power_attr = __ATTR_RO(dual_role_power); +static struct kobj_attribute usb_suspend_supported_attr = __ATTR_RO(usb_suspend_supported); +static struct kobj_attribute unconstrained_power_attr = __ATTR_RO(unconstrained_power); +static struct kobj_attribute usb_communication_capable_attr = __ATTR_RO(usb_communication_capable); +static struct kobj_attribute dual_role_data_attr = __ATTR_RO(dual_role_data); +static struct kobj_attribute +unchunked_extended_messages_supported_attr = __ATTR_RO(unchunked_extended_messages_supported); + +/* Visible on all Fixed type source supplies */ +/*static struct kobj_attribute peak_current_attr = __ATTR_RO(peak_current);*/ +/* Visible on Fixed type sink supplies */ +static struct kobj_attribute fast_role_swap_current_attr = __ATTR_RO(fast_role_swap_current); + +/* Shared with Variable type supplies */ +static struct kobj_attribute maximum_current_attr = { + .attr = { + .name = "maximum_current", + .mode = 0444, + }, + .show = current_show, +}; + +static struct kobj_attribute operational_current_attr = { + .attr = { + .name = "operational_current", + .mode = 0444, + }, + .show = current_show, +}; + +/* Visible on all Fixed type supplies */ +static struct kobj_attribute voltage_attr = __ATTR_RO(voltage); + +static struct attribute *source_fixed_supply_attrs[] = { + &dual_role_power_attr.attr, + &usb_suspend_supported_attr.attr, + &unconstrained_power_attr.attr, + &usb_communication_capable_attr.attr, + &dual_role_data_attr.attr, + &unchunked_extended_messages_supported_attr.attr, + /*&peak_current_attr.attr,*/ + &voltage_attr.attr, + &maximum_current_attr.attr, + NULL +}; + +static umode_t fixed_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n) +{ + if (to_pdo(kobj)->object_position && + /*attr != &peak_current_attr.attr &&*/ + attr != &voltage_attr.attr && + attr != &maximum_current_attr.attr && + attr != &operational_current_attr.attr) + return 0; + + return attr->mode; +} + +static const struct attribute_group source_fixed_supply_group = { + .is_visible = fixed_attr_is_visible, + .attrs = source_fixed_supply_attrs, +}; +__ATTRIBUTE_GROUPS(source_fixed_supply); + +static struct kobj_type source_fixed_supply_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = source_fixed_supply_groups, +}; + +static struct attribute *sink_fixed_supply_attrs[] = { + &dual_role_power_attr.attr, + &usb_suspend_supported_attr.attr, + &unconstrained_power_attr.attr, + &usb_communication_capable_attr.attr, + &dual_role_data_attr.attr, + &unchunked_extended_messages_supported_attr.attr, + &fast_role_swap_current_attr.attr, + &voltage_attr.attr, + &operational_current_attr.attr, + NULL +}; + +static const struct attribute_group sink_fixed_supply_group = { + .is_visible = fixed_attr_is_visible, + .attrs = sink_fixed_supply_attrs, +}; +__ATTRIBUTE_GROUPS(sink_fixed_supply); + +static struct kobj_type sink_fixed_supply_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = sink_fixed_supply_groups, +}; + +/* -------------------------------------------------------------------------- */ +/* Variable Supply */ + +static ssize_t +maximum_voltage_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umV\n", pdo_max_voltage(to_pdo(kobj)->pdo)); +} + +static ssize_t +minimum_voltage_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umV\n", pdo_min_voltage(to_pdo(kobj)->pdo)); +} + +/* Shared with Battery */ +static struct kobj_attribute maximum_voltage_attr = __ATTR_RO(maximum_voltage); +static struct kobj_attribute minimum_voltage_attr = __ATTR_RO(minimum_voltage); + +static struct attribute *source_variable_supply_attrs[] = { + &maximum_voltage_attr.attr, + &minimum_voltage_attr.attr, + &maximum_current_attr.attr, + NULL +}; +ATTRIBUTE_GROUPS(source_variable_supply); + +static struct kobj_type source_variable_supply_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = source_variable_supply_groups, +}; + +static struct attribute *sink_variable_supply_attrs[] = { + &maximum_voltage_attr.attr, + &minimum_voltage_attr.attr, + &operational_current_attr.attr, + NULL +}; +ATTRIBUTE_GROUPS(sink_variable_supply); + +static struct kobj_type sink_variable_supply_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = sink_variable_supply_groups, +}; + +/* -------------------------------------------------------------------------- */ +/* Battery */ + +static ssize_t +maximum_power_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umW\n", pdo_max_power(to_pdo(kobj)->pdo)); +} + +static ssize_t +operational_power_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umW\n", pdo_max_power(to_pdo(kobj)->pdo)); +} + +static struct kobj_attribute maximum_power_attr = __ATTR_RO(maximum_power); +static struct kobj_attribute operational_power_attr = __ATTR_RO(operational_power); + +static struct attribute *source_battery_attrs[] = { + &maximum_voltage_attr.attr, + &minimum_voltage_attr.attr, + &maximum_power_attr.attr, + NULL +}; +ATTRIBUTE_GROUPS(source_battery); + +static struct kobj_type source_battery_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = source_battery_groups, +}; + +static struct attribute *sink_battery_attrs[] = { + &maximum_voltage_attr.attr, + &minimum_voltage_attr.attr, + &operational_power_attr.attr, + NULL +}; +ATTRIBUTE_GROUPS(sink_battery); + +static struct kobj_type sink_battery_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = sink_battery_groups, +}; + +/* -------------------------------------------------------------------------- */ +/* Standard Power Range (SPR) Programmable Power Supply (PPS) */ + +static ssize_t +pps_power_limited_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%u\n", !!(to_pdo(kobj)->pdo & BIT(27))); +} + +static ssize_t +pps_max_voltage_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umV\n", pdo_pps_apdo_max_voltage(to_pdo(kobj)->pdo)); +} + +static ssize_t +pps_min_voltage_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umV\n", pdo_pps_apdo_min_voltage(to_pdo(kobj)->pdo)); +} + +static ssize_t +pps_max_current_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + return sysfs_emit(buf, "%umA\n", pdo_pps_apdo_max_current(to_pdo(kobj)->pdo)); +} + +static struct kobj_attribute pps_power_limited_attr = __ATTR_RO(pps_power_limited); + +static struct kobj_attribute pps_max_voltage_attr = { + .attr = { + .name = "maximum_voltage", + .mode = 0444, + }, + .show = pps_max_voltage_show, +}; + +static struct kobj_attribute pps_min_voltage_attr = { + .attr = { + .name = "minimum_voltage", + .mode = 0444, + }, + .show = pps_min_voltage_show, +}; + +static struct kobj_attribute pps_max_current_attr = { + .attr = { + .name = "maximum_current", + .mode = 0444, + }, + .show = pps_max_current_show, +}; + +static struct attribute *source_pps_attrs[] = { + &pps_power_limited_attr.attr, + &pps_max_voltage_attr.attr, + &pps_min_voltage_attr.attr, + &pps_max_current_attr.attr, + NULL +}; +ATTRIBUTE_GROUPS(source_pps); + +static struct kobj_type source_pps_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = source_pps_groups, +}; + +static struct attribute *sink_pps_attrs[] = { + &pps_max_voltage_attr.attr, + &pps_min_voltage_attr.attr, + &pps_max_current_attr.attr, + NULL +}; +ATTRIBUTE_GROUPS(sink_pps); + +static struct kobj_type sink_pps_type = { + .release = pdo_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = sink_pps_groups, +}; + +/* -------------------------------------------------------------------------- */ + +static const char * const supply_name[] = { + [PDO_TYPE_FIXED] = "fixed_supply", + [PDO_TYPE_BATT] = "battery", + [PDO_TYPE_VAR] = "variable_supply", +}; + +static const char * const apdo_supply_name[] = { + [APDO_TYPE_PPS] = "programmable_supply", +}; + +static struct kobj_type *source_type[] = { + [PDO_TYPE_FIXED] = &source_fixed_supply_type, + [PDO_TYPE_BATT] = &source_battery_type, + [PDO_TYPE_VAR] = &source_variable_supply_type, +}; + +static struct kobj_type *source_apdo_type[] = { + [APDO_TYPE_PPS] = &source_pps_type, +}; + +static struct kobj_type *sink_type[] = { + [PDO_TYPE_FIXED] = &sink_fixed_supply_type, + [PDO_TYPE_BATT] = &sink_battery_type, + [PDO_TYPE_VAR] = &sink_variable_supply_type, +}; + +static struct kobj_type *sink_apdo_type[] = { + [APDO_TYPE_PPS] = &sink_pps_type, +}; + +/* REVISIT: Export when EPR_*_Capabilities need to be supported. */ +static int add_pdo(struct pd_capabilities *cap, u32 pdo, int position) +{ + struct kobj_type *type; + const char *name; + struct pdo *p; + int ret; + + p = kzalloc(sizeof(*p), GFP_KERNEL); + if (!p) + return -ENOMEM; + + p->pdo = pdo; + p->object_position = position; + + if (pdo_type(pdo) == PDO_TYPE_APDO) { + /* FIXME: Only PPS supported for now! Skipping others. */ + if (pdo_apdo_type(pdo) > APDO_TYPE_PPS) { + dev_warn(kobj_to_dev(cap->kobj.parent->parent), + "%s: Unknown APDO type. PDO 0x%08x\n", + kobject_name(&cap->kobj), pdo); + kfree(p); + return 0; + } + + if (is_source(cap->role)) + type = source_apdo_type[pdo_apdo_type(pdo)]; + else + type = sink_apdo_type[pdo_apdo_type(pdo)]; + + name = apdo_supply_name[pdo_apdo_type(pdo)]; + } else { + if (is_source(cap->role)) + type = source_type[pdo_type(pdo)]; + else + type = sink_type[pdo_type(pdo)]; + + name = supply_name[pdo_type(pdo)]; + } + + ret = kobject_init_and_add(&p->kobj, type, &cap->kobj, "%u:%s", position + 1, name); + if (ret) { + kobject_put(&p->kobj); + return ret; + } + + list_add_tail(&p->node, &cap->pdos); + + return 0; +} + +/* -------------------------------------------------------------------------- */ + +static const char * const cap_name[] = { + [TYPEC_SINK] = "sink_capabilities", + [TYPEC_SOURCE] = "source_capabilities", +}; + +static void pd_capabilities_release(struct kobject *kobj) +{ + struct pd_capabilities *cap = to_pd_capabilities(kobj); + + if (is_source(cap->role)) + ida_simple_remove(&cap->pd->source_cap_ids, cap->id); + else + ida_simple_remove(&cap->pd->sink_cap_ids, cap->id); + + kfree(cap); +} + +static struct kobj_type pd_capabilities_type = { + .release = pd_capabilities_release, + .sysfs_ops = &kobj_sysfs_ops, +}; + +/** + * pd_register_capabilities - Register a set of capabilities + * @pd: The USB PD instance that the capabilities belong to + * @desc: Description of the capablities message + * + * This function registers a Capability Message described in @desc. The + * capabilities will have their own sub-directory under @pd in sysfs. @pd can + * have multiple sets of capabilities defined for it. + * + * The function returns pointer to struct pd_capabilities, or ERR_PRT(errno). + */ +struct pd_capabilities *pd_register_capabilities(struct pd *pd, struct pd_caps_desc *desc) +{ + struct pd_capabilities *cap; + struct pdo *pdo, *tmp; + int ret; + int i; + + cap = kzalloc(sizeof(*cap), GFP_KERNEL); + if (!cap) + return ERR_PTR(-ENOMEM); + + ret = ida_simple_get(is_source(desc->role) ? &pd->source_cap_ids : + &pd->sink_cap_ids, 0, 0, GFP_KERNEL); + if (ret < 0) { + kfree(cap); + return ERR_PTR(ret); + } + + cap->id = ret; + cap->pd = pd; + cap->role = desc->role; + INIT_LIST_HEAD(&cap->pdos); + + if (cap->id) + ret = kobject_init_and_add(&cap->kobj, &pd_capabilities_type, &pd->kobj, + "%s%u", cap_name[cap->role], cap->id); + else + ret = kobject_init_and_add(&cap->kobj, &pd_capabilities_type, &pd->kobj, + "%s", cap_name[cap->role]); + if (ret) + goto err_remove_capability; + + for (i = 0; i < PDO_MAX_OBJECTS && desc->pdo[i]; i++) { + ret = add_pdo(cap, desc->pdo[i], i); + if (ret) + goto err_remove_pdos; + } + + if (is_source(cap->role)) + list_add_tail(&cap->node, &pd->source_capabilities); + else + list_add_tail(&cap->node, &pd->sink_capabilities); + + return cap; + +err_remove_pdos: + list_for_each_entry_safe(pdo, tmp, &cap->pdos, node) { + list_del(&pdo->node); + kobject_put(&pdo->kobj); + } + +err_remove_capability: + kobject_put(&cap->kobj); + + return ERR_PTR(ret); +} +EXPORT_SYMBOL_GPL(pd_register_capabilities); + +/** + * pd_unregister_capabilities - Unregister a set of capabilities + * @cap: The capabilities + */ +void pd_unregister_capabilities(struct pd_capabilities *cap) +{ + struct pdo *pdo, *tmp; + + if (!cap) + return; + + list_for_each_entry_safe(pdo, tmp, &cap->pdos, node) { + list_del(&pdo->node); + kobject_put(&pdo->kobj); + } + + list_del(&cap->node); + kobject_put(&cap->kobj); +} +EXPORT_SYMBOL_GPL(pd_unregister_capabilities); + +/* -------------------------------------------------------------------------- */ + +static ssize_t revision_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + struct pd *pd = to_pd(kobj); + + return sysfs_emit(buf, "%u.%u\n", (pd->revision >> 8) & 0xff, (pd->revision >> 4) & 0xf); +} + +static ssize_t version_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf) +{ + struct pd *pd = to_pd(kobj); + + return sysfs_emit(buf, "%u.%u\n", (pd->version >> 8) & 0xff, (pd->version >> 4) & 0xf); +} + +static struct kobj_attribute revision_attr = __ATTR_RO(revision); +static struct kobj_attribute version_attr = __ATTR_RO(version); + +static struct attribute *pd_attrs[] = { + &revision_attr.attr, + &version_attr.attr, + NULL +}; + +static umode_t pd_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n) +{ + struct pd *pd = to_pd(kobj); + + if (attr == &version_attr.attr && !pd->version) + return 0; + + return attr->mode; +} + +static const struct attribute_group pd_group = { + .is_visible = pd_attr_is_visible, + .attrs = pd_attrs, +}; +__ATTRIBUTE_GROUPS(pd); + +static void pd_release(struct kobject *kobj) +{ + struct pd *pd = to_pd(kobj); + + ida_destroy(&pd->source_cap_ids); + ida_destroy(&pd->sink_cap_ids); + put_device(pd->dev); + kfree(pd); +} + +static struct kobj_type pd_type = { + .release = pd_release, + .sysfs_ops = &kobj_sysfs_ops, + .default_groups = pd_groups, +}; + +struct pd *pd_register(struct device *dev, struct pd_desc *desc) +{ + struct pd *pd; + int ret; + + pd = kzalloc(sizeof(*pd), GFP_KERNEL); + if (!pd) + return ERR_PTR(-ENOMEM); + + ida_init(&pd->sink_cap_ids); + ida_init(&pd->source_cap_ids); + INIT_LIST_HEAD(&pd->sink_capabilities); + INIT_LIST_HEAD(&pd->source_capabilities); + + pd->dev = get_device(dev); + pd->revision = desc->revision; + pd->version = desc->version; + + ret = kobject_init_and_add(&pd->kobj, &pd_type, &dev->kobj, "usb_power_delivery"); + if (ret) { + kobject_put(&pd->kobj); + return ERR_PTR(ret); + } + + return pd; +} + +void pd_unregister(struct pd *pd) +{ + kobject_put(&pd->kobj); +} diff --git a/drivers/usb/typec/pd.h b/drivers/usb/typec/pd.h new file mode 100644 index 0000000000000..a24416e05a3c2 --- /dev/null +++ b/drivers/usb/typec/pd.h @@ -0,0 +1,39 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __USB_POWER_DELIVERY__ +#define __USB_POWER_DELIVERY__ + +#include + +struct pd_capabilities { + struct kobject kobj; + unsigned int id; + struct pd *pd; + enum typec_role role; + struct list_head pdos; + struct list_head node; +}; + +struct pd { + struct kobject kobj; + struct device *dev; + + u16 revision; /* 0300H = "3.0" */ + u16 version; + + struct ida source_cap_ids; + struct ida sink_cap_ids; + struct list_head source_capabilities; + struct list_head sink_capabilities; +}; + +#define to_pd_capabilities(o) container_of(o, struct pd_capabilities, kobj) +#define to_pd(o) container_of(o, struct pd, kobj) + +struct pd *pd_register(struct device *dev, struct pd_desc *desc); +void pd_unregister(struct pd *pd); + +int pd_init(void); +void pd_exit(void); + +#endif /* __USB_POWER_DELIVERY__ */ diff --git a/include/linux/usb/pd.h b/include/linux/usb/pd.h index 96b7ff66f074b..9cf78fa32623d 100644 --- a/include/linux/usb/pd.h +++ b/include/linux/usb/pd.h @@ -495,4 +495,34 @@ static inline unsigned int rdo_max_power(u32 rdo) #define PD_P_SNK_STDBY_MW 2500 /* 2500 mW */ +#if IS_ENABLED(CONFIG_TYPEC) + +/** + * pd_desc - USB Power Delivery Descriptor + * @revision: USB Power Delivery Specification Revision + * @version: USB Power Delivery Specicication Version - optional + */ +struct pd_desc { + u16 revision; + u16 version; +}; + +/** + * pd_caps_desc - Description of USB Power Delivery Capabilities Message + * @pdo: The Power Data Objects in the Capability Message + * @role: Power role of the capabilities + */ +struct pd_caps_desc { + u32 pdo[PDO_MAX_OBJECTS]; + enum typec_role role; +}; + +struct pd_capabilities *pd_register_capabilities(struct pd *pd, struct pd_caps_desc *desc); +void pd_unregister_capabilities(struct pd_capabilities *cap); + +struct pd *pd_register(struct device *dev, struct pd_desc *desc); +void pd_unregister(struct pd *pd); + +#endif /* CONFIG_TYPEC */ + #endif /* __LINUX_USB_PD_H */ diff --git a/include/linux/usb/typec.h b/include/linux/usb/typec.h index 7ba45a97eeae3..a7525b9931b69 100644 --- a/include/linux/usb/typec.h +++ b/include/linux/usb/typec.h @@ -52,6 +52,16 @@ enum typec_role { TYPEC_SOURCE, }; +static inline int is_sink(enum typec_role role) +{ + return role == TYPEC_SINK; +} + +static inline int is_source(enum typec_role role) +{ + return role == TYPEC_SOURCE; +} + enum typec_pwr_opmode { TYPEC_PWR_MODE_USB, TYPEC_PWR_MODE_1_5A, From patchwork Thu Feb 3 14:46:56 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Heikki Krogerus X-Patchwork-Id: 540028 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 036C6C433F5 for ; Thu, 3 Feb 2022 14:47:01 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1351375AbiBCOrA (ORCPT ); Thu, 3 Feb 2022 09:47:00 -0500 Received: from mga06.intel.com ([134.134.136.31]:37909 "EHLO mga06.intel.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1351338AbiBCOqv (ORCPT ); Thu, 3 Feb 2022 09:46:51 -0500 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=intel.com; i=@intel.com; q=dns/txt; s=Intel; t=1643899611; x=1675435611; h=from:to:cc:subject:date:message-id:in-reply-to: references:mime-version:content-transfer-encoding; bh=ytp1ZbjWgyqpIz/beyPJzZFya/E0iLt3aeSshDMKWFY=; b=broMoIX2YWxiPuVOSGpA6NtdilPfxDYUzsNp1px6FjYidGAxMIPso0T3 juCZzw5673XsnFdcaBjrd0xAR8cGyLcTMsb0OrJd1NBtuqcRcyfvcg9pf PvigG+HNA82tN8ivKs2BMh/gvsKQR9zp70eOODnclyl0XK+EfVZFiJPUK IWE2jys+rx+EDUFI1Nz2gtev2fLUpVaE5mfy99LZ5bbShqNaTgddyquGn 2nQP/O1sXQATXKwwU4pHbIy1IRwQd9RRi/3LOXswAR/joXU+m8G5RNB1L WtwTs9tbYFqcrg48VhKh6n5lGcFgbT5OvPUFgOLjGEG8ciAVMU2OAqfdA g==; X-IronPort-AV: E=McAfee;i="6200,9189,10246"; a="308883017" X-IronPort-AV: E=Sophos;i="5.88,340,1635231600"; d="scan'208";a="308883017" Received: from fmsmga001.fm.intel.com ([10.253.24.23]) by orsmga104.jf.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 03 Feb 2022 06:46:51 -0800 X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="5.88,340,1635231600"; d="scan'208";a="676788156" Received: from black.fi.intel.com (HELO black.fi.intel.com.) ([10.237.72.28]) by fmsmga001.fm.intel.com with ESMTP; 03 Feb 2022 06:46:48 -0800 From: Heikki Krogerus To: Greg Kroah-Hartman Cc: Guenter Roeck , Benson Leung , Prashant Malani , Jameson Thies , "Regupathy, Rajaram" , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH v1 2/3] usb: typec: Functions for USB PD capabilities registration Date: Thu, 3 Feb 2022 17:46:56 +0300 Message-Id: <20220203144657.16527-3-heikki.krogerus@linux.intel.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: <20220203144657.16527-1-heikki.krogerus@linux.intel.com> References: <20220203144657.16527-1-heikki.krogerus@linux.intel.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-usb@vger.kernel.org This adds functions that can be used to register and assign USB Power Delivery Capabilities Messages so they are exposed to the user via sysfs. By assigning the capabilities the driver will create a symlink pointing to those capabilities named "source_capabilities" and (or) "sink_capabilities" depending on the role of the message (Source_Capablities or Sink_Capabilities Message). Ports can support multiple sets of capabilities but only one that is advertised to the partner can be active at any given time. Separate sysfs attribute files are added that can be used to select the currently active capabilities message. Signed-off-by: Heikki Krogerus --- Documentation/ABI/testing/sysfs-class-typec | 22 ++ drivers/usb/typec/class.c | 328 ++++++++++++++++++++ drivers/usb/typec/class.h | 8 + include/linux/usb/typec.h | 15 + 4 files changed, 373 insertions(+) diff --git a/Documentation/ABI/testing/sysfs-class-typec b/Documentation/ABI/testing/sysfs-class-typec index 75088ecad2029..d60720befeeb3 100644 --- a/Documentation/ABI/testing/sysfs-class-typec +++ b/Documentation/ABI/testing/sysfs-class-typec @@ -141,6 +141,28 @@ Description: - "reverse": CC2 orientation - "unknown": Orientation cannot be determined. +What: /sys/class/typec//select_sink_capabilities +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file lists the available USB Power Delivery + Sink_Capabilities Messages, the same that can be read from the + "usb_power_delivery" sub-directory under the port device's sysfs + directory. The active message, the one that is advertised to the + partner, is in brackets. The active message can be changed by + writing to this file. + +What: /sys/class/typec//select_source_capabilities +Date: February 2022 +Contact: Heikki Krogerus +Description: + This file lists the available USB Power Delivery + Source_Capabilities Messages, the same that can be read from the + "usb_power_delivery" sub-directory under the port device's sysfs + directory. The active message, the one that is advertised to the + partner, is in brackets. The active message can be changed by + writing to this file. + USB Type-C partner devices (eg. /sys/class/typec/port0-partner/) What: /sys/class/typec/-partner/accessory_mode diff --git a/drivers/usb/typec/class.c b/drivers/usb/typec/class.c index 45a6f0c807cb5..eef0b59209331 100644 --- a/drivers/usb/typec/class.c +++ b/drivers/usb/typec/class.c @@ -15,6 +15,7 @@ #include "bus.h" #include "class.h" +#include "pd.h" static DEFINE_IDA(typec_index_ida); @@ -26,6 +27,11 @@ struct class typec_class = { /* ------------------------------------------------------------------------- */ /* Common attributes */ +static const char * const cap_name[] = { + [TYPEC_SINK] = "sink_capabilities", + [TYPEC_SOURCE] = "source_capabilities", +}; + static const char * const typec_accessory_modes[] = { [TYPEC_ACCESSORY_NONE] = "none", [TYPEC_ACCESSORY_AUDIO] = "analog_audio", @@ -589,6 +595,100 @@ EXPORT_SYMBOL_GPL(typec_unregister_altmode); /* ------------------------------------------------------------------------- */ /* Type-C Partners */ +/** + * typec_partner_set_pd_capabilities - Create link to the USB PD capabilities + * @partner: USB Type-C partner + * @cap: USB Power Delivery capabilities + * + * The link will be named "source_capabilities" or "sink_capabilities" depending + * on the role of @cap. + */ +int typec_partner_set_pd_capabilities(struct typec_partner *partner, struct pd_capabilities *cap) +{ + int ret; + + if (!cap) + return -EINVAL; + + if ((is_source(cap->role) && partner->source_caps) || partner->sink_caps) + return -EEXIST; + + ret = sysfs_create_link(&partner->dev.kobj, &cap->kobj, cap_name[cap->role]); + if (ret) + return ret; + + if (is_source(cap->role)) + partner->source_caps = cap; + else + partner->sink_caps = cap; + + kobject_get(&cap->kobj); + + return 0; +} +EXPORT_SYMBOL_GPL(typec_partner_set_pd_capabilities); + +/** + * typec_partner_unset_pd_capabilities - Remove link to the USB PD capabilities + * @port: USB Type-C partner + * @cap: USB Power Delivery capabilities + */ +void typec_partner_unset_pd_capabilities(struct typec_partner *partner, enum typec_role role) +{ + struct pd_capabilities *cap; + + if (is_source(role)) { + cap = partner->source_caps; + partner->source_caps = NULL; + } else { + cap = partner->sink_caps; + partner->sink_caps = NULL; + } + + if (!cap) + return; + + sysfs_remove_link(&partner->dev.kobj, cap_name[role]); + kobject_put(&cap->kobj); +} +EXPORT_SYMBOL_GPL(typec_partner_unset_pd_capabilities); + +/** + * typec_partner_register_pd - Register USB Power Delivery support + * @partner: The partner device that support USB Power Delivery + * @desc: Description of the USB Power Delivery support + * + * The function returns pointer to struct pd, or errno on failure. + */ +struct pd *typec_partner_register_pd(struct typec_partner *partner, struct pd_desc *desc) +{ + struct pd *pd; + + if (partner->pd) + return ERR_PTR(-EEXIST); + + pd = pd_register(&partner->dev, desc); + if (!IS_ERR(pd)) + partner->pd = pd; + + return pd; +} +EXPORT_SYMBOL_GPL(typec_partner_register_pd); + +/** + * typec_partner_unregister_pd - Unregister USB Power Delivery sysfs directory + * @partner: The partner device + */ +void typec_partner_unregister_pd(struct typec_partner *partner) +{ + if (!partner->pd) + return; + + pd_unregister(partner->pd); + partner->pd = NULL; +} +EXPORT_SYMBOL_GPL(typec_partner_unregister_pd); + static ssize_t accessory_mode_show(struct device *dev, struct device_attribute *attr, char *buf) @@ -1170,6 +1270,234 @@ EXPORT_SYMBOL_GPL(typec_unregister_cable); /* ------------------------------------------------------------------------- */ /* USB Type-C ports */ +/** + * typec_port_set_pd_capabilities - Create link to the USB PD capabilities + * @port: USB Type-C port + * @cap: Active USB Power Delivery capabilities + * + * Creates a link to the currently active capabilities @cap for @port, i.e. + * capabilities that are advertised to the partner. Both roles have their own + * active capabilities, so the link will be "source_capabilities" or + * "sink_capabilities" depending on the role of @cap. + */ +int typec_port_set_pd_capabilities(struct typec_port *port, struct pd_capabilities *cap) +{ + int ret; + + if (!cap) + return -EINVAL; + + if (is_source(cap->role) && port->source_caps) + kobject_put(&port->source_caps->kobj); + else if (port->sink_caps) + kobject_put(&port->sink_caps->kobj); + + sysfs_remove_link(&port->dev.kobj, cap_name[cap->role]); + + ret = sysfs_create_link(&port->dev.kobj, &cap->kobj, cap_name[cap->role]); + if (ret) + return ret; + + if (is_source(cap->role)) + port->source_caps = cap; + else + port->sink_caps = cap; + + kobject_get(&cap->kobj); + + return 0; +} +EXPORT_SYMBOL_GPL(typec_port_set_pd_capabilities); + +/** + * typec_port_unset_pd_capabilities - Remove link to the USB PD capabilities + * @port: USB Type-C port + * @cap: Active USB Power Delivery capabilities + */ +int typec_port_unset_pd_capabilities(struct typec_port *port, struct pd_capabilities *cap) +{ + if (is_source(cap->role)) { + if (port->source_caps != cap) + return -EINVAL; + port->source_caps = NULL; + } else { + if (port->sink_caps != cap) + return -EINVAL; + port->sink_caps = NULL; + } + + sysfs_remove_link(&port->dev.kobj, cap_name[cap->role]); + kobject_put(&cap->kobj); + + return 0; +} +EXPORT_SYMBOL_GPL(typec_port_unset_pd_capabilities); + +static ssize_t select_source_capabilities_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t size) +{ + struct typec_port *port = to_typec_port(dev); + struct pd_capabilities *cap; + int ret; + int i; + + if (!port->ops || !port->ops->capabilities_set) + return -EOPNOTSUPP; + + if (sscanf(buf, "source_capabilities%d", &i) != 1) + return -EINVAL; + + list_for_each_entry(cap, &port->pd->source_capabilities, node) { + if (cap->id == i) { + ret = port->ops->capabilities_set(port, cap); + if (ret) + return ret; + return size; + } + } + + return -EINVAL; +} + +static ssize_t select_source_capabilities_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct typec_port *port = to_typec_port(dev); + const char *name = cap_name[TYPEC_SOURCE]; + struct pd_capabilities *cap; + ssize_t ret = 0; + + list_for_each_entry(cap, &port->pd->source_capabilities, node) { + if (cap == port->source_caps) + ret += sysfs_emit(buf + ret, "[%s%d] ", name, cap->id); + else + ret += sysfs_emit(buf + ret, "%s%d ", name, cap->id); + } + + buf[ret - 1] = '\n'; + + return ret; +} +static DEVICE_ATTR_RW(select_source_capabilities); + +static ssize_t select_sink_capabilities_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t size) +{ + struct typec_port *port = to_typec_port(dev); + struct pd_capabilities *cap; + int ret; + int i; + + if (!port->ops || !port->ops->capabilities_set) + return -EOPNOTSUPP; + + if (sscanf(buf, "sink_capabilities%d", &i) != 1) + return -EINVAL; + + list_for_each_entry(cap, &port->pd->sink_capabilities, node) { + if (cap->id == i) { + ret = port->ops->capabilities_set(port, cap); + if (ret) + return ret; + return size; + } + } + + return -EINVAL; +} + +static ssize_t select_sink_capabilities_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct typec_port *port = to_typec_port(dev); + const char *name = cap_name[TYPEC_SINK]; + struct pd_capabilities *cap; + ssize_t ret = 0; + + list_for_each_entry(cap, &port->pd->sink_capabilities, node) { + if (cap == port->sink_caps) + ret += sysfs_emit(buf + ret, "[%s%d] ", name, cap->id); + else + ret += sysfs_emit(buf + ret, "%s%d ", name, cap->id); + } + + buf[ret - 1] = '\n'; + + return ret; +} +static DEVICE_ATTR_RW(select_sink_capabilities); + +static struct attribute *port_attrs[] = { + &dev_attr_select_source_capabilities.attr, + &dev_attr_select_sink_capabilities.attr, + NULL +}; + +static umode_t port_attr_is_visible(struct kobject *kobj, struct attribute *attr, int n) +{ + struct typec_port *port = to_typec_port(kobj_to_dev(kobj)); + + if (!port->ops || !port->ops->capabilities_set) + return 0; + + return attr->mode; +} + +static const struct attribute_group port_group = { + .is_visible = port_attr_is_visible, + .attrs = port_attrs, +}; + +/** + * typec_port_register_pd - Register USB Power Delivery support + * @port: The port that support USB Power Delivery + * @desc: Description of the USB Power Delivery support + * + * This directory will house all the USB Power Delivery objects of @port that + * the operating system can access. The function returns pointer to struct + * pd, or errno on failure. + */ +struct pd *typec_port_register_pd(struct typec_port *port, struct pd_desc *desc) +{ + struct pd *pd; + int ret; + + if (port->pd) + return ERR_PTR(-EEXIST); + + pd = pd_register(&port->dev, desc); + if (IS_ERR(pd)) + return pd; + + port->pd = pd; + + ret = sysfs_create_group(&port->dev.kobj, &port_group); + if (ret) { + pd_unregister(pd); + return ERR_PTR(ret); + } + + return pd; +} +EXPORT_SYMBOL_GPL(typec_port_register_pd); + +/** + * typec_port_unregister_pd - Unregister USB Power Delivery sysfs directory + * @port: The port device + */ +void typec_port_unregister_pd(struct typec_port *port) +{ + if (!port->pd) + return; + + sysfs_remove_group(&port->dev.kobj, &port_group); + pd_unregister(port->pd); + port->pd = NULL; +} +EXPORT_SYMBOL_GPL(typec_port_unregister_pd); + static const char * const typec_orientations[] = { [TYPEC_ORIENTATION_NONE] = "unknown", [TYPEC_ORIENTATION_NORMAL] = "normal", diff --git a/drivers/usb/typec/class.h b/drivers/usb/typec/class.h index 0f1bd6d19d67e..db1b6bbd4c779 100644 --- a/drivers/usb/typec/class.h +++ b/drivers/usb/typec/class.h @@ -33,6 +33,10 @@ struct typec_partner { int num_altmodes; u16 pd_revision; /* 0300H = "3.0" */ enum usb_pd_svdm_ver svdm_version; + + struct pd *pd; + struct pd_capabilities *source_caps; + struct pd_capabilities *sink_caps; }; struct typec_port { @@ -40,6 +44,10 @@ struct typec_port { struct device dev; struct ida mode_ids; + struct pd *pd; + struct pd_capabilities *source_caps; + struct pd_capabilities *sink_caps; + int prefer_role; enum typec_data_role data_role; enum typec_role pwr_role; diff --git a/include/linux/usb/typec.h b/include/linux/usb/typec.h index a7525b9931b69..a315802b50039 100644 --- a/include/linux/usb/typec.h +++ b/include/linux/usb/typec.h @@ -22,6 +22,10 @@ struct typec_altmode_ops; struct fwnode_handle; struct device; +struct pd_capabilities; +struct pd_desc; +struct pd; + enum typec_port_type { TYPEC_PORT_SRC, TYPEC_PORT_SNK, @@ -231,6 +235,7 @@ struct typec_operations { int (*vconn_set)(struct typec_port *port, enum typec_role role); int (*port_type_set)(struct typec_port *port, enum typec_port_type type); + int (*capabilities_set)(struct typec_port *port, struct pd_capabilities *cap); }; enum usb_pd_svdm_ver { @@ -315,4 +320,14 @@ void typec_partner_set_svdm_version(struct typec_partner *partner, enum usb_pd_svdm_ver svdm_version); int typec_get_negotiated_svdm_version(struct typec_port *port); +struct pd *typec_partner_register_pd(struct typec_partner *partner, struct pd_desc *desc); +void typec_partner_unregister_pd(struct typec_partner *partner); +int typec_partner_set_pd_capabilities(struct typec_partner *partner, struct pd_capabilities *cap); +void typec_partner_unset_pd_capabilities(struct typec_partner *partner, enum typec_role role); + +struct pd *typec_port_register_pd(struct typec_port *port, struct pd_desc *desc); +void typec_port_unregister_pd(struct typec_port *port); +int typec_port_set_pd_capabilities(struct typec_port *port, struct pd_capabilities *cap); +int typec_port_unset_pd_capabilities(struct typec_port *port, struct pd_capabilities *cap); + #endif /* __LINUX_USB_TYPEC_H */ From patchwork Thu Feb 3 14:46:57 2022 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Heikki Krogerus X-Patchwork-Id: 539825 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id DCF54C433EF for ; Thu, 3 Feb 2022 14:47:01 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1351389AbiBCOrA (ORCPT ); Thu, 3 Feb 2022 09:47:00 -0500 Received: from mga06.intel.com ([134.134.136.31]:37941 "EHLO mga06.intel.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1351337AbiBCOqy (ORCPT ); Thu, 3 Feb 2022 09:46:54 -0500 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=intel.com; i=@intel.com; q=dns/txt; s=Intel; t=1643899614; x=1675435614; h=from:to:cc:subject:date:message-id:in-reply-to: references:mime-version:content-transfer-encoding; bh=vQNgw02nO8wh7Ms6v2zOlYLS2xcPK0QefbK3K3pecNo=; b=eP6Ul204YQ0drPirwdXxnJxSDaDRayiwCveob3eNMd6UDDHIgURAr48E eXvBWNzMy7BY5V5LCgPuaSCwvpnyT3NgFT+O39Hkohgz9hbilva/zi3UX 55j18K8ntLpm+V3HakMJtyr9hOTojeXQxONOB0/up45lJ38Q7amKfm3Lz x3MfEOJ5wXkWX5XnlXX5P2il67ok8OWMmi8uz3Q9Z8aDXaTCpZt9sD9IM mJzBn0QNZy0Bi6w8usrdpW+/KSW2DVXm0ktjsoTwzeXJX5k+Xd/YXNw8B YO59rkI4bFCRGLqFnvlnu/B0LdwzvB6mcz+z+s3L3TP9zUEVQ3ptQu/7E w==; X-IronPort-AV: E=McAfee;i="6200,9189,10246"; a="308883026" X-IronPort-AV: E=Sophos;i="5.88,340,1635231600"; d="scan'208";a="308883026" Received: from fmsmga001.fm.intel.com ([10.253.24.23]) by orsmga104.jf.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 03 Feb 2022 06:46:54 -0800 X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="5.88,340,1635231600"; d="scan'208";a="676788169" Received: from black.fi.intel.com (HELO black.fi.intel.com.) ([10.237.72.28]) by fmsmga001.fm.intel.com with ESMTP; 03 Feb 2022 06:46:51 -0800 From: Heikki Krogerus To: Greg Kroah-Hartman Cc: Guenter Roeck , Benson Leung , Prashant Malani , Jameson Thies , "Regupathy, Rajaram" , linux-usb@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH v1 3/3] usb: typec: ucsi: Register USB Power Delivery Capabilities Date: Thu, 3 Feb 2022 17:46:57 +0300 Message-Id: <20220203144657.16527-4-heikki.krogerus@linux.intel.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: <20220203144657.16527-1-heikki.krogerus@linux.intel.com> References: <20220203144657.16527-1-heikki.krogerus@linux.intel.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-usb@vger.kernel.org UCSI allows the USB PD capabilities to be read with the GET_PDO command. This will register those capabilities, and that way make them visible to the user space. Signed-off-by: Heikki Krogerus --- drivers/usb/typec/ucsi/ucsi.c | 128 +++++++++++++++++++++++++++++++--- drivers/usb/typec/ucsi/ucsi.h | 8 +++ 2 files changed, 125 insertions(+), 11 deletions(-) diff --git a/drivers/usb/typec/ucsi/ucsi.c b/drivers/usb/typec/ucsi/ucsi.c index f0c2fa19f3e0f..5149001093c7f 100644 --- a/drivers/usb/typec/ucsi/ucsi.c +++ b/drivers/usb/typec/ucsi/ucsi.c @@ -568,8 +568,8 @@ static void ucsi_unregister_altmodes(struct ucsi_connector *con, u8 recipient) } } -static int ucsi_get_pdos(struct ucsi_connector *con, int is_partner, - u32 *pdos, int offset, int num_pdos) +static int ucsi_read_pdos(struct ucsi_connector *con, enum typec_role role, int is_partner, + u32 *pdos, int offset, int num_pdos) { struct ucsi *ucsi = con->ucsi; u64 command; @@ -579,7 +579,7 @@ static int ucsi_get_pdos(struct ucsi_connector *con, int is_partner, command |= UCSI_GET_PDOS_PARTNER_PDO(is_partner); command |= UCSI_GET_PDOS_PDO_OFFSET(offset); command |= UCSI_GET_PDOS_NUM_PDOS(num_pdos - 1); - command |= UCSI_GET_PDOS_SRC_PDOS; + command |= is_source(role) ? UCSI_GET_PDOS_SRC_PDOS : 0; ret = ucsi_send_command(ucsi, command, pdos + offset, num_pdos * sizeof(u32)); if (ret < 0 && ret != -ETIMEDOUT) @@ -590,26 +590,39 @@ static int ucsi_get_pdos(struct ucsi_connector *con, int is_partner, return ret; } -static int ucsi_get_src_pdos(struct ucsi_connector *con) +static int ucsi_get_pdos(struct ucsi_connector *con, enum typec_role role, + int is_partner, u32 *pdos) { + u8 num_pdos; int ret; /* UCSI max payload means only getting at most 4 PDOs at a time */ - ret = ucsi_get_pdos(con, 1, con->src_pdos, 0, UCSI_MAX_PDOS); + ret = ucsi_read_pdos(con, role, is_partner, pdos, 0, UCSI_MAX_PDOS); if (ret < 0) return ret; - con->num_pdos = ret / sizeof(u32); /* number of bytes to 32-bit PDOs */ - if (con->num_pdos < UCSI_MAX_PDOS) - return 0; + num_pdos = ret / sizeof(u32); /* number of bytes to 32-bit PDOs */ + if (num_pdos < UCSI_MAX_PDOS) + return num_pdos; /* get the remaining PDOs, if any */ - ret = ucsi_get_pdos(con, 1, con->src_pdos, UCSI_MAX_PDOS, - PDO_MAX_OBJECTS - UCSI_MAX_PDOS); + ret = ucsi_read_pdos(con, role, is_partner, pdos, UCSI_MAX_PDOS, + PDO_MAX_OBJECTS - UCSI_MAX_PDOS); + if (ret < 0) + return ret; + + return ret / sizeof(u32) + num_pdos; +} + +static int ucsi_get_src_pdos(struct ucsi_connector *con) +{ + int ret; + + ret = ucsi_get_pdos(con, TYPEC_SOURCE, 1, con->src_pdos); if (ret < 0) return ret; - con->num_pdos += ret / sizeof(u32); + con->num_pdos += ret; ucsi_port_psy_changed(con); @@ -638,6 +651,60 @@ static int ucsi_check_altmodes(struct ucsi_connector *con) return ret; } +static int ucsi_register_partner_pdos(struct ucsi_connector *con) +{ + struct pd_desc desc = { con->ucsi->cap.pd_version }; + struct pd_capabilities *cap; + struct pd_caps_desc caps; + int ret; + + con->partner_pd = typec_partner_register_pd(con->partner, &desc); + if (IS_ERR(con->partner_pd)) + return PTR_ERR(con->partner_pd); + + ret = ucsi_get_pdos(con, TYPEC_SOURCE, 1, caps.pdo); + if (ret < 0) + return ret; + + if (ret < PDO_MAX_OBJECTS) + caps.pdo[ret] = 0; + caps.role = TYPEC_SOURCE; + + cap = pd_register_capabilities(con->partner_pd, &caps); + if (IS_ERR(cap)) + return PTR_ERR(cap); + + ret = typec_partner_set_pd_capabilities(con->partner, cap); + if (ret) { + pd_unregister_capabilities(cap); + return ret; + } + + con->partner_source_caps = cap; + + ret = ucsi_get_pdos(con, TYPEC_SINK, 1, caps.pdo); + if (ret <= 0) + return ret; + + if (ret < PDO_MAX_OBJECTS) + caps.pdo[ret] = 0; + caps.role = TYPEC_SINK; + + cap = pd_register_capabilities(con->partner_pd, &caps); + if (IS_ERR(cap)) + return PTR_ERR(cap); + + ret = typec_partner_set_pd_capabilities(con->partner, cap); + if (ret) { + pd_unregister_capabilities(cap); + return ret; + } + + con->partner_sink_caps = cap; + + return 0; +} + static void ucsi_pwr_opmode_change(struct ucsi_connector *con) { switch (UCSI_CONSTAT_PWR_OPMODE(con->status.flags)) { @@ -646,6 +713,7 @@ static void ucsi_pwr_opmode_change(struct ucsi_connector *con) typec_set_pwr_opmode(con->port, TYPEC_PWR_MODE_PD); ucsi_partner_task(con, ucsi_get_src_pdos, 30, 0); ucsi_partner_task(con, ucsi_check_altmodes, 30, 0); + ucsi_partner_task(con, ucsi_register_partner_pdos, 1, HZ); break; case UCSI_CONSTAT_PWR_OPMODE_TYPEC1_5: con->rdo = 0; @@ -704,6 +772,17 @@ static void ucsi_unregister_partner(struct ucsi_connector *con) if (!con->partner) return; + typec_partner_unset_pd_capabilities(con->partner, TYPEC_SINK); + pd_unregister_capabilities(con->partner_sink_caps); + con->partner_sink_caps = NULL; + + typec_partner_unset_pd_capabilities(con->partner, TYPEC_SOURCE); + pd_unregister_capabilities(con->partner_source_caps); + con->partner_source_caps = NULL; + + typec_partner_unregister_pd(con->partner); + con->partner_pd = NULL; + ucsi_unregister_altmodes(con, UCSI_RECIPIENT_SOP); typec_unregister_partner(con->partner); con->partner = NULL; @@ -1037,6 +1116,8 @@ static int ucsi_register_port(struct ucsi *ucsi, int index) u64 command; char *name; int ret; + struct pd_desc desc = { ucsi->cap.pd_version }; + struct pd_caps_desc caps; name = kasprintf(GFP_KERNEL, "%s-con%d", dev_name(ucsi->dev), con->num); if (!name) @@ -1103,6 +1184,24 @@ static int ucsi_register_port(struct ucsi *ucsi, int index) goto out; } + con->pd = typec_port_register_pd(con->port, &desc); + + ret = ucsi_get_pdos(con, TYPEC_SOURCE, 0, caps.pdo); + if (ret > 0) { + caps.pdo[ret] = 0; + caps.role = TYPEC_SOURCE; + con->source_caps = pd_register_capabilities(con->pd, &caps); + typec_port_set_pd_capabilities(con->port, con->source_caps); + } + + ret = ucsi_get_pdos(con, TYPEC_SINK, 0, caps.pdo); + if (ret > 0) { + caps.pdo[ret] = 0; + caps.role = TYPEC_SINK; + con->sink_caps = pd_register_capabilities(con->pd, &caps); + typec_port_set_pd_capabilities(con->port, con->sink_caps); + } + /* Alternate modes */ ret = ucsi_register_altmodes(con, UCSI_RECIPIENT_CON); if (ret) { @@ -1169,6 +1268,7 @@ static int ucsi_register_port(struct ucsi *ucsi, int index) UCSI_CONSTAT_PWR_OPMODE_PD) { ucsi_get_src_pdos(con); ucsi_check_altmodes(con); + ucsi_register_partner_pdos(con); } trace_ucsi_register_port(con->num, &con->status); @@ -1379,6 +1479,12 @@ void ucsi_unregister(struct ucsi *ucsi) ucsi_unregister_port_psy(&ucsi->connector[i]); if (ucsi->connector[i].wq) destroy_workqueue(ucsi->connector[i].wq); + typec_port_unset_pd_capabilities(ucsi->connector[i].port, + ucsi->connector[i].source_caps); + pd_unregister_capabilities(ucsi->connector[i].source_caps); + typec_port_unset_pd_capabilities(ucsi->connector[i].port, + ucsi->connector[i].sink_caps); + pd_unregister_capabilities(ucsi->connector[i].sink_caps); typec_unregister_port(ucsi->connector[i].port); } diff --git a/drivers/usb/typec/ucsi/ucsi.h b/drivers/usb/typec/ucsi/ucsi.h index 280f1e1bda2c9..aa23df98b7730 100644 --- a/drivers/usb/typec/ucsi/ucsi.h +++ b/drivers/usb/typec/ucsi/ucsi.h @@ -335,6 +335,14 @@ struct ucsi_connector { int num_pdos; struct usb_role_switch *usb_role_sw; + + struct pd *pd; + struct pd_capabilities *source_caps; + struct pd_capabilities *sink_caps; + + struct pd *partner_pd; + struct pd_capabilities *partner_source_caps; + struct pd_capabilities *partner_sink_caps; }; int ucsi_send_command(struct ucsi *ucsi, u64 command,