Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 879b5308 authored by Satyajit Desai's avatar Satyajit Desai Committed by Gerrit - the friendly Code Review server
Browse files

coresight: funnel: add support for duplicating funnel devices 



Funnel devices are now capable of supporting multiple-input and
multiple-output configuration with in built hardware filtering
for TPDM devices. Add support for duplicating funnel devices in
order to leverage current amba framework for their programming.
Each set of input-output combination is treated as independent
funnel devices by amba framework.

Change-Id: Id005089cf753a05769715cf64e9000f4e8ce8857
Signed-off-by: default avatarSatyajit Desai <sadesai@codeaurora.org>
Signed-off-by: default avatarRama Aparna Mallavarapu <aparnam@codeaurora.org>
Signed-off-by: default avatarMulu He <muluhe@codeaurora.org>
parent d1338e7f

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);