Merge "coresight: funnel: add support for duplicating funnel devices" (0030c38b) · Commits · e / devices / android_kernel_fairphone_FP4

drivers/hwtracing/coresight/coresight-funnel.c

+40 −4

Original line number	Diff line number	Diff line
		// SPDX-License-Identifier: GPL-2.0
		/*
		* Copyright (c) 2011-2012, The Linux Foundation. All rights reserved.
		* Copyright (c) 2011-2012,2017, The Linux Foundation. All rights reserved.
		*
		* Description: CoreSight Funnel driver
		*/
		@@ -16,6 +16,7 @@
		#include <linux/coresight.h>
		#include <linux/amba/bus.h>
		#include <linux/clk.h>
		#include <linux/of_address.h>

		#include "coresight-priv.h"

		@@ -161,6 +162,29 @@ static struct attribute *coresight_funnel_attrs[] = {
		};
		ATTRIBUTE_GROUPS(coresight_funnel);

		static int funnel_get_resource_byname(struct device_node *np,
		char ch_base, struct resource res)
		{
		const char *name = NULL;
		int index = 0, found = 0;

		while (!of_property_read_string_index(np, "reg-names", index, &name)) {
		if (strcmp(ch_base, name)) {
		index++;
		continue;
		}

		/* We have a match and @index is where it's at */
		found = 1;
		break;
		}

		if (!found)
		return -EINVAL;

		return of_address_to_resource(np, index, res);
		}

		static int funnel_probe(struct amba_device adev, const struct amba_id id)
		{
		int ret;
		@@ -168,7 +192,8 @@ static int funnel_probe(struct amba_device adev, const struct amba_id id)
		struct device *dev = &adev->dev;
		struct coresight_platform_data *pdata = NULL;
		struct funnel_drvdata *drvdata;
		struct resource *res = &adev->res;
		struct resource *res;
		struct resource res_real;
		struct coresight_desc desc = { 0 };
		struct device_node *np = adev->dev.of_node;

		@@ -192,8 +217,19 @@ static int funnel_probe(struct amba_device adev, const struct amba_id id)
		}
		dev_set_drvdata(dev, drvdata);

		/* Validity for the resource is already checked by the AMBA core */
		if (of_property_read_bool(np, "qcom,duplicate-funnel")) {
		ret = funnel_get_resource_byname(np, "funnel-base-real",
		&res_real);
		if (ret)
		return ret;

		res = &res_real;
		base = devm_ioremap(dev, res->start, resource_size(res));
		} else {
		/* Validity of resource is already checked by the AMBA core */
		res = &adev->res;
		base = devm_ioremap_resource(dev, res);
		}
		if (IS_ERR(base))
		return PTR_ERR(base);