usb: typec: port-mapper: Convert to the component framework
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
Greg Kroah-Hartman
parent
8c67d06f3f
commit
730b49aac4
@ -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/
|
||||
|
||||
@ -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;
|
||||
|
||||
@ -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__ */
|
||||
|
||||
@ -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);
|
||||
}
|
||||
|
||||
@ -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 */
|
||||
|
||||
Loading…
Reference in New Issue
Block a user