renegade-project/linux-next
2
0
Fork 0
mirror of https://github.com/edk2-porting/linux-next.git synced 2024-12-16 17:23:55 +08:00
Code

usb: typec: port-mapper: Convert to the component framework

Browse Source 
Instead of trying to keep track of the connections to the
USB Type-C connectors separately, letting the component
framework take care of that.

From now on every USB Type-C connector will register itself
as "aggregate" - component master - and anything that can be
connected to it inside the system can then simply register
itself as a generic component.

The matching of the components and the connector shall rely
on ACPI _PLD initially. Before registering itself as the
aggregate, the connector will find all other ACPI devices
that have matching _PLD crc hash with it (matching value in
the pld_crc member of struct acpi_device), and add a
component match entry for each one of them. Because only
ACPI is supported for now, the driver shall only be build
when ACPI is supported.

This removes the need for the custom API that the driver
exposed. The components and the connector can therefore
exist completely independently of each other. The order in
which they are registered, as well as are they modules or
not, is now irrelevant.

Acked-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
Signed-off-by: Heikki Krogerus <heikki.krogerus@linux.intel.com>
Link: https://lore.kernel.org/r/20211223082422.45637-1-heikki.krogerus@linux.intel.com
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
Heikki Krogerus 2021-12-23 11:24:22 +03:00 committed by Greg Kroah-Hartman
parent 8c67d06f3f
commit 730b49aac4
5 changed files with 56 additions and 270 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
drivers/usb/typec/Makefile
View File

@ -1,6 +1,7 @@
# SPDX-License-Identifier: GPL-2.0
obj-$(CONFIG_TYPEC) += typec.o
typec-y := class.o mux.o bus.o port-mapper.o
typec-y := class.o mux.o bus.o
typec-$(CONFIG_ACPI) += port-mapper.o
obj-$(CONFIG_TYPEC) += altmodes/
obj-$(CONFIG_TYPEC_TCPM) += tcpm/
obj-$(CONFIG_TYPEC_UCSI) += ucsi/

2
drivers/usb/typec/class.c
View File

@ -2039,8 +2039,6 @@ struct typec_port *typec_register_port(struct device *parent,
ida_init(&port->mode_ids);
mutex_init(&port->port_type_lock);
mutex_init(&port->port_list_lock);
INIT_LIST_HEAD(&port->port_list);
port->id = id;
port->ops = cap->ops;

10
drivers/usb/typec/class.h
View File

@ -54,11 +54,6 @@ struct typec_port {
const struct typec_capability *cap;
const struct typec_operations *ops;
struct list_head port_list;
struct mutex port_list_lock; /* Port list lock */
void *pld;
};
#define to_typec_port(_dev_) container_of(_dev_, struct typec_port, dev)
@ -79,7 +74,12 @@ extern const struct device_type typec_port_dev_type;
extern struct class typec_mux_class;
extern struct class typec_class;
#if defined(CONFIG_ACPI)
int typec_link_ports(struct typec_port *connector);
void typec_unlink_ports(struct typec_port *connector);
#else
static inline int typec_link_ports(struct typec_port *connector) { return 0; }
static inline void typec_unlink_ports(struct typec_port *connector) { }
#endif
#endif /* __USB_TYPEC_CLASS__ */

299
drivers/usb/typec/port-mapper.c
View File

@ -7,273 +7,72 @@
*/
#include <linux/acpi.h>
#include <linux/usb.h>
#include <linux/usb/typec.h>
#include <linux/component.h>
#include "class.h"
struct port_node {
struct list_head list;
struct device *dev;
void *pld;
static int typec_aggregate_bind(struct device *dev)
{
return component_bind_all(dev, NULL);
}
static void typec_aggregate_unbind(struct device *dev)
{
component_unbind_all(dev, NULL);
}
static const struct component_master_ops typec_aggregate_ops = {
.bind = typec_aggregate_bind,
.unbind = typec_aggregate_unbind,
};
static int acpi_pld_match(const struct acpi_pld_info *pld1,
const struct acpi_pld_info *pld2)
struct each_port_arg {
struct typec_port *port;
struct component_match *match;
};
static int typec_port_compare(struct device *dev, void *fwnode)
{
if (!pld1 || !pld2)
return device_match_fwnode(dev, fwnode);
}
static int typec_port_match(struct device *dev, void *data)
{
struct acpi_device *adev = to_acpi_device(dev);
struct each_port_arg *arg = data;
struct acpi_device *con_adev;
con_adev = ACPI_COMPANION(&arg->port->dev);
if (con_adev == adev)
return 0;
/*
* To speed things up, first checking only the group_position. It seems
* to often have the first unique value in the _PLD.
*/
if (pld1->group_position == pld2->group_position)
return !memcmp(pld1, pld2, sizeof(struct acpi_pld_info));
return 0;
}
static void *get_pld(struct device *dev)
{
#ifdef CONFIG_ACPI
struct acpi_pld_info *pld;
acpi_status status;
if (!has_acpi_companion(dev))
return NULL;
status = acpi_get_physical_device_location(ACPI_HANDLE(dev), &pld);
if (ACPI_FAILURE(status))
return NULL;
return pld;
#else
return NULL;
#endif
}
static void free_pld(void *pld)
{
#ifdef CONFIG_ACPI
ACPI_FREE(pld);
#endif
}
static int __link_port(struct typec_port *con, struct port_node *node)
{
int ret;
ret = sysfs_create_link(&node->dev->kobj, &con->dev.kobj, "connector");
if (ret)
return ret;
ret = sysfs_create_link(&con->dev.kobj, &node->dev->kobj,
dev_name(node->dev));
if (ret) {
sysfs_remove_link(&node->dev->kobj, "connector");
return ret;
}
list_add_tail(&node->list, &con->port_list);
return 0;
}
static int link_port(struct typec_port *con, struct port_node *node)
{
int ret;
mutex_lock(&con->port_list_lock);
ret = __link_port(con, node);
mutex_unlock(&con->port_list_lock);
return ret;
}
static void __unlink_port(struct typec_port *con, struct port_node *node)
{
sysfs_remove_link(&con->dev.kobj, dev_name(node->dev));
sysfs_remove_link(&node->dev->kobj, "connector");
list_del(&node->list);
}
static void unlink_port(struct typec_port *con, struct port_node *node)
{
mutex_lock(&con->port_list_lock);
__unlink_port(con, node);
mutex_unlock(&con->port_list_lock);
}
static struct port_node *create_port_node(struct device *port)
{
struct port_node *node;
node = kzalloc(sizeof(*node), GFP_KERNEL);
if (!node)
return ERR_PTR(-ENOMEM);
node->dev = get_device(port);
node->pld = get_pld(port);
return node;
}
static void remove_port_node(struct port_node *node)
{
put_device(node->dev);
free_pld(node->pld);
kfree(node);
}
static int connector_match(struct device *dev, const void *data)
{
const struct port_node *node = data;
if (!is_typec_port(dev))
return 0;
return acpi_pld_match(to_typec_port(dev)->pld, node->pld);
}
static struct device *find_connector(struct port_node *node)
{
if (!node->pld)
return NULL;
return class_find_device(&typec_class, NULL, node, connector_match);
}
/**
* typec_link_port - Link a port to its connector
* @port: The port device
*
* Find the connector of @port and create symlink named "connector" for it.
* Returns 0 on success, or errno in case of a failure.
*
* NOTE. The function increments the reference count of @port on success.
*/
int typec_link_port(struct device *port)
{
struct device *connector;
struct port_node *node;
int ret;
node = create_port_node(port);
if (IS_ERR(node))
return PTR_ERR(node);
connector = find_connector(node);
if (!connector) {
ret = 0;
goto remove_node;
}
ret = link_port(to_typec_port(connector), node);
if (ret)
goto put_connector;
return 0;
put_connector:
put_device(connector);
remove_node:
remove_port_node(node);
return ret;
}
EXPORT_SYMBOL_GPL(typec_link_port);
static int port_match_and_unlink(struct device *connector, void *port)
{
struct port_node *node;
struct port_node *tmp;
int ret = 0;
if (!is_typec_port(connector))
return 0;
mutex_lock(&to_typec_port(connector)->port_list_lock);
list_for_each_entry_safe(node, tmp, &to_typec_port(connector)->port_list, list) {
ret = node->dev == port;
if (ret) {
unlink_port(to_typec_port(connector), node);
remove_port_node(node);
put_device(connector);
break;
}
}
mutex_unlock(&to_typec_port(connector)->port_list_lock);
return ret;
}
/**
* typec_unlink_port - Unlink port from its connector
* @port: The port device
*
* Removes the symlink "connector" and decrements the reference count of @port.
*/
void typec_unlink_port(struct device *port)
{
class_for_each_device(&typec_class, NULL, port, port_match_and_unlink);
}
EXPORT_SYMBOL_GPL(typec_unlink_port);
static int each_port(struct device *port, void *connector)
{
struct port_node *node;
int ret;
node = create_port_node(port);
if (IS_ERR(node))
return PTR_ERR(node);
if (!connector_match(connector, node)) {
remove_port_node(node);
return 0;
}
ret = link_port(to_typec_port(connector), node);
if (ret) {
remove_port_node(node->pld);
return ret;
}
get_device(connector);
if (con_adev->pld_crc == adev->pld_crc)
component_match_add(&arg->port->dev, &arg->match, typec_port_compare,
acpi_fwnode_handle(adev));
return 0;
}
int typec_link_ports(struct typec_port *con)
{
int ret = 0;
struct each_port_arg arg = { .port = con, .match = NULL };
con->pld = get_pld(&con->dev);
if (!con->pld)
return 0;
bus_for_each_dev(&acpi_bus_type, NULL, &arg, typec_port_match);
ret = usb_for_each_port(&con->dev, each_port);
if (ret)
typec_unlink_ports(con);
return ret;
/*
* REVISIT: Now each connector can have only a single component master.
* So far only the USB ports connected to the USB Type-C connector share
* the _PLD with it, but if there one day is something else (like maybe
* the DisplayPort ACPI device object) that also shares the _PLD with
* the connector, every one of those needs to have its own component
* master, because each different type of component needs to be bind to
* the connector independently of the other components. That requires
* improvements to the component framework. Right now you can only have
* one master per device.
*/
return component_master_add_with_match(&con->dev, &typec_aggregate_ops, arg.match);
}
void typec_unlink_ports(struct typec_port *con)
{
struct port_node *node;
struct port_node *tmp;
mutex_lock(&con->port_list_lock);
list_for_each_entry_safe(node, tmp, &con->port_list, list) {
__unlink_port(con, node);
remove_port_node(node);
put_device(&con->dev);
}
mutex_unlock(&con->port_list_lock);
free_pld(con->pld);
component_master_del(&con->dev, &typec_aggregate_ops);
}

12
include/linux/usb/typec.h
View File

@ -305,16 +305,4 @@ 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);
#if IS_REACHABLE(CONFIG_TYPEC)
int typec_link_port(struct device *port);
void typec_unlink_port(struct device *port);
#else
static inline int typec_link_port(struct device *port)
{
return 0;
}
static inline void typec_unlink_port(struct device *port) { }
#endif
#endif /* __LINUX_USB_TYPEC_H */