From nobody Wed Sep 10 11:03:51 2025 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 2AEA0C77B61 for ; Tue, 25 Apr 2023 14:37:45 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S234128AbjDYOhT (ORCPT ); Tue, 25 Apr 2023 10:37:19 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:45664 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S234217AbjDYOgo (ORCPT ); Tue, 25 Apr 2023 10:36:44 -0400 Received: from foss.arm.com (foss.arm.com [217.140.110.172]) by lindbergh.monkeyblade.net (Postfix) with ESMTP id A3EABA249 for ; Tue, 25 Apr 2023 07:36:39 -0700 (PDT) Received: from usa-sjc-imap-foss1.foss.arm.com (unknown [10.121.207.14]) by usa-sjc-mx-foss1.foss.arm.com (Postfix) with ESMTP id 635A04B3; Tue, 25 Apr 2023 07:37:23 -0700 (PDT) Received: from localhost.localdomain (unknown [172.31.20.19]) by usa-sjc-imap-foss1.foss.arm.com (Postfix) with ESMTPA id D1CBA3F587; Tue, 25 Apr 2023 07:36:37 -0700 (PDT) From: James Clark To: coresight@lists.linaro.org, quic_jinlmao@quicinc.com, mike.leach@linaro.org, suzuki.poulose@arm.com Cc: James Clark , Leo Yan , Alexander Shishkin , Greg Kroah-Hartman , Mathieu Poirier , linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org Subject: [PATCH v6 06/13] coresight: Dynamically add connections Date: Tue, 25 Apr 2023 15:35:33 +0100 Message-Id: <20230425143542.2305069-7-james.clark@arm.com> X-Mailer: git-send-email 2.34.1 In-Reply-To: <20230425143542.2305069-1-james.clark@arm.com> References: <20230425143542.2305069-1-james.clark@arm.com> MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Type: text/plain; charset="utf-8" Add a function for adding connections dynamically. This also removes the 1:1 mapping between port number and the index into the connections array. The only place this mapping was used was in the warning for duplicate output ports, which has been replaced by a search. Other uses of the port number already use the port member variable. Being able to dynamically add connections will allow other devices like CTI to re-use the connection mechanism despite not having explicit connections described in the DT. The connections array is now no longer sparse, so child_fwnode doesn't need to be checked as all connections have a target node. Because the array is no longer sparse, the high in and out port numbers are required for the refcount arrays. But these will also be removed in a later commit when the refcount is made a property of the connection. Reviewed-by: Mike Leach Signed-off-by: James Clark --- drivers/hwtracing/coresight/coresight-core.c | 23 ++-- .../hwtracing/coresight/coresight-platform.c | 124 +++++++++--------- include/linux/coresight.h | 8 +- 3 files changed, 77 insertions(+), 78 deletions(-) diff --git a/drivers/hwtracing/coresight/coresight-core.c b/drivers/hwtraci= ng/coresight/coresight-core.c index f3dc320b374c..91274e7e6944 100644 --- a/drivers/hwtracing/coresight/coresight-core.c +++ b/drivers/hwtracing/coresight/coresight-core.c @@ -397,9 +397,9 @@ static void coresight_disable_link(struct coresight_dev= ice *csdev, link_subtype =3D csdev->subtype.link_subtype; =20 if (link_subtype =3D=3D CORESIGHT_DEV_SUBTYPE_LINK_MERG) { - nr_conns =3D csdev->pdata->nr_inconns; + nr_conns =3D csdev->pdata->high_inport; } else if (link_subtype =3D=3D CORESIGHT_DEV_SUBTYPE_LINK_SPLIT) { - nr_conns =3D csdev->pdata->nr_outconns; + nr_conns =3D csdev->pdata->high_outport; } else { nr_conns =3D 1; } @@ -1336,9 +1336,6 @@ static int coresight_orphan_match(struct device *dev,= void *data) for (i =3D 0; i < i_csdev->pdata->nr_outconns; i++) { conn =3D &i_csdev->pdata->out_conns[i]; =20 - /* Skip the port if FW doesn't describe it */ - if (!conn->dest_fwnode) - continue; /* We have found at least one orphan connection */ if (conn->dest_dev =3D=3D NULL) { /* Does it match this newly added device? */ @@ -1377,8 +1374,6 @@ static int coresight_fixup_device_conns(struct coresi= ght_device *csdev) for (i =3D 0; i < csdev->pdata->nr_outconns; i++) { struct coresight_connection *conn =3D &csdev->pdata->out_conns[i]; =20 - if (!conn->dest_fwnode) - continue; conn->dest_dev =3D coresight_find_csdev_by_fwnode(conn->dest_fwnode); if (conn->dest_dev && conn->dest_dev->has_conns_grp) { @@ -1413,7 +1408,7 @@ static int coresight_remove_match(struct device *dev,= void *data) for (i =3D 0; i < iterator->pdata->nr_outconns; i++) { conn =3D &iterator->pdata->out_conns[i]; =20 - if (conn->dest_dev =3D=3D NULL || conn->dest_fwnode =3D=3D NULL) + if (conn->dest_dev =3D=3D NULL) continue; =20 if (csdev->dev.fwnode =3D=3D conn->dest_fwnode) { @@ -1445,7 +1440,7 @@ static void coresight_remove_conns(struct coresight_d= evice *csdev) * doesn't have at least one input port, there is no point * in searching all the devices. */ - if (csdev->pdata->nr_inconns) + if (csdev->pdata->high_inport) bus_for_each_dev(&coresight_bustype, NULL, csdev, coresight_remove_match); } @@ -1552,10 +1547,8 @@ void coresight_release_platform_data(struct coresigh= t_device *csdev, * Drop the refcount and clear the handle as this device * is going away */ - if (conns[i].dest_fwnode) { - fwnode_handle_put(conns[i].dest_fwnode); - conns[i].dest_fwnode =3D NULL; - } + fwnode_handle_put(conns[i].dest_fwnode); + conns[i].dest_fwnode =3D NULL; } if (csdev) coresight_remove_conns_sysfs_group(csdev); @@ -1581,9 +1574,9 @@ struct coresight_device *coresight_register(struct co= resight_desc *desc) link_subtype =3D desc->subtype.link_subtype; =20 if (link_subtype =3D=3D CORESIGHT_DEV_SUBTYPE_LINK_MERG) - nr_refcnts =3D desc->pdata->nr_inconns; + nr_refcnts =3D desc->pdata->high_inport; else if (link_subtype =3D=3D CORESIGHT_DEV_SUBTYPE_LINK_SPLIT) - nr_refcnts =3D desc->pdata->nr_outconns; + nr_refcnts =3D desc->pdata->high_outport; } =20 refcnts =3D kcalloc(nr_refcnts, sizeof(*refcnts), GFP_KERNEL); diff --git a/drivers/hwtracing/coresight/coresight-platform.c b/drivers/hwt= racing/coresight/coresight-platform.c index 566cc99a2c34..8c2029336161 100644 --- a/drivers/hwtracing/coresight/coresight-platform.c +++ b/drivers/hwtracing/coresight/coresight-platform.c @@ -19,22 +19,45 @@ #include =20 #include "coresight-priv.h" + /* - * coresight_alloc_conns: Allocate connections record for each output - * port from the device. + * Add an entry to the connection list and assign @conn's contents to it. + * + * If the output port is already assigned on this device, return -EINVAL */ -static int coresight_alloc_conns(struct device *dev, - struct coresight_platform_data *pdata) +struct coresight_connection * +coresight_add_out_conn(struct device *dev, + struct coresight_platform_data *pdata, + const struct coresight_connection *new_conn) { - if (pdata->nr_outconns) { - pdata->out_conns =3D devm_kcalloc(dev, pdata->nr_outconns, - sizeof(*pdata->out_conns), GFP_KERNEL); - if (!pdata->out_conns) - return -ENOMEM; + int i; + struct coresight_connection *conn; + + /* + * Warn on any existing duplicate output port. + */ + for (i =3D 0; i < pdata->nr_outconns; ++i) { + conn =3D &pdata->out_conns[i]; + /* Output =3D=3D -1 means ignore the port for example for helpers */ + if (conn->src_port !=3D -1 && + conn->src_port =3D=3D new_conn->src_port) { + dev_warn(dev, "Duplicate output port %d\n", + conn->src_port); + return ERR_PTR(-EINVAL); + } } =20 - return 0; + pdata->nr_outconns++; + pdata->out_conns =3D + devm_krealloc_array(dev, pdata->out_conns, pdata->nr_outconns, + sizeof(*pdata->out_conns), GFP_KERNEL); + if (!pdata->out_conns) + return ERR_PTR(-ENOMEM); + + pdata->out_conns[pdata->nr_outconns - 1] =3D *new_conn; + return &pdata->out_conns[pdata->nr_outconns - 1]; } +EXPORT_SYMBOL_GPL(coresight_add_out_conn); =20 static struct device * coresight_find_device_by_fwnode(struct fwnode_handle *fwnode) @@ -224,7 +247,8 @@ static int of_coresight_parse_endpoint(struct device *d= ev, struct device_node *rep =3D NULL; struct device *rdev =3D NULL; struct fwnode_handle *rdev_fwnode; - struct coresight_connection *conn; + struct coresight_connection conn =3D {}; + struct coresight_connection *new_conn; =20 do { /* Parse the local port details */ @@ -251,14 +275,7 @@ static int of_coresight_parse_endpoint(struct device *= dev, break; } =20 - conn =3D &pdata->out_conns[endpoint.port]; - if (conn->dest_fwnode) { - dev_warn(dev, "Duplicate output port %d\n", - endpoint.port); - ret =3D -EINVAL; - break; - } - conn->src_port =3D endpoint.port; + conn.src_port =3D endpoint.port; /* * Hold the refcount to the target device. This could be * released via: @@ -267,8 +284,14 @@ static int of_coresight_parse_endpoint(struct device *= dev, * 2) While removing the target device via * coresight_remove_match() */ - conn->dest_fwnode =3D fwnode_handle_get(rdev_fwnode); - conn->dest_port =3D rendpoint.port; + conn.dest_fwnode =3D fwnode_handle_get(rdev_fwnode); + conn.dest_port =3D rendpoint.port; + + new_conn =3D coresight_add_out_conn(dev, pdata, &conn); + if (IS_ERR_VALUE(new_conn)) { + fwnode_handle_put(conn.dest_fwnode); + return PTR_ERR(new_conn); + } /* Connection record updated */ } while (0); =20 @@ -289,16 +312,12 @@ static int of_get_coresight_platform_data(struct devi= ce *dev, struct device_node *node =3D dev->of_node; =20 /* Get the number of input and output port for this component */ - of_coresight_get_ports(node, &pdata->nr_inconns, &pdata->nr_outconns); + of_coresight_get_ports(node, &pdata->high_inport, &pdata->high_outport); =20 /* If there are no output connections, we are done */ - if (!pdata->nr_outconns) + if (!pdata->high_outport) return 0; =20 - ret =3D coresight_alloc_conns(dev, pdata); - if (ret) - return ret; - parent =3D of_coresight_get_output_ports_node(node); /* * If the DT uses obsoleted bindings, the ports are listed @@ -683,12 +702,14 @@ static int acpi_coresight_parse_link(struct acpi_devi= ce *adev, * connection information and populate the supplied coresight_platform_data * instance. */ -static int acpi_coresight_parse_graph(struct acpi_device *adev, +static int acpi_coresight_parse_graph(struct device *dev, + struct acpi_device *adev, struct coresight_platform_data *pdata) { - int rc, i, nlinks; + int i, nlinks; const union acpi_object *graph; - struct coresight_connection *conns, *ptr; + struct coresight_connection conn, zero_conn =3D {}; + struct coresight_connection *new_conn; =20 pdata->nr_inconns =3D pdata->nr_outconns =3D 0; graph =3D acpi_get_coresight_graph(adev); @@ -699,30 +720,23 @@ static int acpi_coresight_parse_graph(struct acpi_dev= ice *adev, if (!nlinks) return 0; =20 - /* - * To avoid scanning the table twice (once for finding the number of - * output links and then later for parsing the output links), - * cache the links information in one go and then later copy - * it to the pdata. - */ - conns =3D devm_kcalloc(&adev->dev, nlinks, sizeof(*conns), GFP_KERNEL); - if (!conns) - return -ENOMEM; - ptr =3D conns; for (i =3D 0; i < nlinks; i++) { const union acpi_object *link =3D &graph->package.elements[3 + i]; int dir; =20 - dir =3D acpi_coresight_parse_link(adev, link, ptr); + conn =3D zero_conn; + dir =3D acpi_coresight_parse_link(adev, link, &conn); if (dir < 0) return dir; =20 if (dir =3D=3D ACPI_CORESIGHT_LINK_MASTER) { - if (ptr->src_port >=3D pdata->nr_outconns) - pdata->nr_outconns =3D ptr->src_port + 1; - ptr++; + if (conn.src_port >=3D pdata->high_outport) + pdata->high_outport =3D conn.src_port + 1; + new_conn =3D coresight_add_out_conn(dev, pdata, &conn); + if (IS_ERR(new_conn)) + return PTR_ERR(new_conn); } else { - WARN_ON(pdata->nr_inconns =3D=3D ptr->dest_port + 1); + WARN_ON(pdata->high_inport =3D=3D conn.dest_port + 1); /* * We do not track input port connections for a device. * However we need the highest port number described, @@ -730,25 +744,11 @@ static int acpi_coresight_parse_graph(struct acpi_dev= ice *adev, * record for an output connection. Hence, do not move * the ptr for input connections */ - if (ptr->dest_port >=3D pdata->nr_inconns) - pdata->nr_inconns =3D ptr->dest_port + 1; + if (conn.dest_port >=3D pdata->high_inport) + pdata->high_inport =3D conn.dest_port + 1; } } =20 - rc =3D coresight_alloc_conns(&adev->dev, pdata); - if (rc) - return rc; - - /* Copy the connection information to the final location */ - for (i =3D 0; conns + i < ptr; i++) { - int port =3D conns[i].src_port; - - /* Duplicate output port */ - WARN_ON(pdata->out_conns[port].dest_fwnode); - pdata->out_conns[port] =3D conns[i]; - } - - devm_kfree(&adev->dev, conns); return 0; } =20 @@ -809,7 +809,7 @@ acpi_get_coresight_platform_data(struct device *dev, if (!adev) return -EINVAL; =20 - return acpi_coresight_parse_graph(adev, pdata); + return acpi_coresight_parse_graph(dev, adev, pdata); } =20 #else diff --git a/include/linux/coresight.h b/include/linux/coresight.h index b6f444804bf3..12fdbd03e2f7 100644 --- a/include/linux/coresight.h +++ b/include/linux/coresight.h @@ -104,9 +104,11 @@ union coresight_dev_subtype { * * @nr_inconns: Number of elements for the input connections. * @nr_outconns: Number of elements for the output connections. - * @out_conns: Sparse array of nr_outconns connections from this component. + * @out_conns: Array of nr_outconns connections from this component. */ struct coresight_platform_data { + int high_inport; + int high_outport; int nr_inconns; int nr_outconns; struct coresight_connection *out_conns; @@ -609,5 +611,9 @@ static inline void coresight_write64(struct coresight_d= evice *csdev, u64 val, u3 extern int coresight_get_cpu(struct device *dev); =20 struct coresight_platform_data *coresight_get_platform_data(struct device = *dev); +struct coresight_connection * +coresight_add_out_conn(struct device *dev, + struct coresight_platform_data *pdata, + const struct coresight_connection *new_conn); =20 #endif /* _LINUX_COREISGHT_H */ --=20 2.34.1