diff mbox series

[v2,19/36] coresight: Introduce generic platform data helper

Message ID 1555344260-12375-20-git-send-email-suzuki.poulose@arm.com
State New
Headers show
Series coresight: Support for ACPI bindings | expand

Commit Message

Suzuki K Poulose April 15, 2019, 4:04 p.m. UTC
So far we have hard coded the DT platform parsing code in
every driver. Introduce generic helper to parse the information
provided by the firmware in a platform agnostic manner, in preparation
for the ACPI support.

Cc: Mathieu Poirier <mathieu.poirier@linaro.org>
Signed-off-by: Suzuki K Poulose <suzuki.poulose@arm.com>

---
 drivers/hwtracing/coresight/coresight-catu.c       | 13 +++-----
 drivers/hwtracing/coresight/coresight-etb10.c      | 11 +++----
 drivers/hwtracing/coresight/coresight-etm3x.c      | 12 +++-----
 drivers/hwtracing/coresight/coresight-etm4x.c      | 11 +++----
 drivers/hwtracing/coresight/coresight-funnel.c     | 11 +++----
 drivers/hwtracing/coresight/coresight-platform.c   | 36 ++++++++++++++++------
 drivers/hwtracing/coresight/coresight-replicator.c | 12 +++-----
 drivers/hwtracing/coresight/coresight-stm.c        | 11 +++----
 drivers/hwtracing/coresight/coresight-tmc.c        | 13 +++-----
 drivers/hwtracing/coresight/coresight-tpiu.c       | 11 +++----
 include/linux/coresight.h                          |  7 ++---
 11 files changed, 66 insertions(+), 82 deletions(-)

-- 
2.7.4

Comments

Mathieu Poirier April 22, 2019, 6:09 p.m. UTC | #1
Hi Suzuki,

On Mon, Apr 15, 2019 at 05:04:02PM +0100, Suzuki K Poulose wrote:
> So far we have hard coded the DT platform parsing code in

> every driver. Introduce generic helper to parse the information

> provided by the firmware in a platform agnostic manner, in preparation

> for the ACPI support.

> 

> Cc: Mathieu Poirier <mathieu.poirier@linaro.org>

> Signed-off-by: Suzuki K Poulose <suzuki.poulose@arm.com>

> ---

>  drivers/hwtracing/coresight/coresight-catu.c       | 13 +++-----

>  drivers/hwtracing/coresight/coresight-etb10.c      | 11 +++----

>  drivers/hwtracing/coresight/coresight-etm3x.c      | 12 +++-----

>  drivers/hwtracing/coresight/coresight-etm4x.c      | 11 +++----

>  drivers/hwtracing/coresight/coresight-funnel.c     | 11 +++----

>  drivers/hwtracing/coresight/coresight-platform.c   | 36 ++++++++++++++++------

>  drivers/hwtracing/coresight/coresight-replicator.c | 12 +++-----

>  drivers/hwtracing/coresight/coresight-stm.c        | 11 +++----

>  drivers/hwtracing/coresight/coresight-tmc.c        | 13 +++-----

>  drivers/hwtracing/coresight/coresight-tpiu.c       | 11 +++----

>  include/linux/coresight.h                          |  7 ++---

>  11 files changed, 66 insertions(+), 82 deletions(-)

> 

> diff --git a/drivers/hwtracing/coresight/coresight-catu.c b/drivers/hwtracing/coresight/coresight-catu.c

> index 14d1cf5..65b86ec 100644

> --- a/drivers/hwtracing/coresight/coresight-catu.c

> +++ b/drivers/hwtracing/coresight/coresight-catu.c

> @@ -503,17 +503,14 @@ static int catu_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct coresight_desc catu_desc;

>  	struct coresight_platform_data *pdata = NULL;

>  	struct device *dev = &adev->dev;

> -	struct device_node *np = dev->of_node;

>  	void __iomem *base;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata)) {

> -			ret = PTR_ERR(pdata);

> -			goto out;

> -		}

> -		dev->platform_data = pdata;

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata)) {

> +		ret = PTR_ERR(pdata);

> +		goto out;

>  	}

> +	dev->platform_data = pdata;

>  

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata) {

> diff --git a/drivers/hwtracing/coresight/coresight-etb10.c b/drivers/hwtracing/coresight/coresight-etb10.c

> index 6e6e9aa..cd61b54 100644

> --- a/drivers/hwtracing/coresight/coresight-etb10.c

> +++ b/drivers/hwtracing/coresight/coresight-etb10.c

> @@ -681,14 +681,11 @@ static int etb_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct etb_drvdata *drvdata;

>  	struct resource *res = &adev->res;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = adev->dev.of_node;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata))

> -			return PTR_ERR(pdata);

> -		adev->dev.platform_data = pdata;

> -	}

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata))

> +		return PTR_ERR(pdata);

> +	adev->dev.platform_data = pdata;

>  

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata)

> diff --git a/drivers/hwtracing/coresight/coresight-etm3x.c b/drivers/hwtracing/coresight/coresight-etm3x.c

> index fa2f141..fa2164f 100644

> --- a/drivers/hwtracing/coresight/coresight-etm3x.c

> +++ b/drivers/hwtracing/coresight/coresight-etm3x.c

> @@ -790,20 +790,16 @@ static int etm_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct etm_drvdata *drvdata;

>  	struct resource *res = &adev->res;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = adev->dev.of_node;

>  

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata)

>  		return -ENOMEM;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata))

> -			return PTR_ERR(pdata);

> -

> -		adev->dev.platform_data = pdata;

> -	}

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata))

> +		return PTR_ERR(pdata);

>  

> +	adev->dev.platform_data = pdata;

>  	drvdata->use_cp14 = fwnode_property_read_bool(dev->fwnode, "arm,cp14");

>  	dev_set_drvdata(dev, drvdata);

>  

> diff --git a/drivers/hwtracing/coresight/coresight-etm4x.c b/drivers/hwtracing/coresight/coresight-etm4x.c

> index 75b923f..998b9f3 100644

> --- a/drivers/hwtracing/coresight/coresight-etm4x.c

> +++ b/drivers/hwtracing/coresight/coresight-etm4x.c

> @@ -976,18 +976,15 @@ static int etm4_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct etmv4_drvdata *drvdata;

>  	struct resource *res = &adev->res;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = adev->dev.of_node;

>  

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata)

>  		return -ENOMEM;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata))

> -			return PTR_ERR(pdata);

> -		adev->dev.platform_data = pdata;

> -	}

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata))

> +		return PTR_ERR(pdata);

> +	adev->dev.platform_data = pdata;

>  

>  	dev_set_drvdata(dev, drvdata);

>  

> diff --git a/drivers/hwtracing/coresight/coresight-funnel.c b/drivers/hwtracing/coresight/coresight-funnel.c

> index 1085f31..2590744 100644

> --- a/drivers/hwtracing/coresight/coresight-funnel.c

> +++ b/drivers/hwtracing/coresight/coresight-funnel.c

> @@ -185,14 +185,11 @@ static int funnel_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct funnel_drvdata *drvdata;

>  	struct resource *res = &adev->res;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = adev->dev.of_node;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata))

> -			return PTR_ERR(pdata);

> -		adev->dev.platform_data = pdata;

> -	}

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata))

> +		return PTR_ERR(pdata);

> +	adev->dev.platform_data = pdata;

>  

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata)

> diff --git a/drivers/hwtracing/coresight/coresight-platform.c b/drivers/hwtracing/coresight/coresight-platform.c

> index 4c31299..25a1838 100644

> --- a/drivers/hwtracing/coresight/coresight-platform.c

> +++ b/drivers/hwtracing/coresight/coresight-platform.c

> @@ -230,23 +230,17 @@ static int of_coresight_parse_endpoint(struct device *dev,

>  	return ret;

>  }

>  

> -struct coresight_platform_data *

> +static struct coresight_platform_data *

>  of_get_coresight_platform_data(struct device *dev,

> -			       const struct device_node *node)

> +			       struct coresight_platform_data *pdata)

>  {

>  	int ret = 0;

> -	struct coresight_platform_data *pdata;

>  	struct coresight_connection *conn;

>  	struct device_node *ep = NULL;

>  	const struct device_node *parent = NULL;

>  	bool legacy_binding = false;

> +	struct device_node *node = dev->of_node;

>  

> -	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);

> -	if (!pdata)

> -		return ERR_PTR(-ENOMEM);

> -

> -	/* Use device name as sysfs handle */

> -	pdata->name = dev_name(dev);

>  	pdata->cpu = of_coresight_get_cpu(node);

>  

>  	/* Get the number of input and output port for this component */

> @@ -298,5 +292,27 @@ of_get_coresight_platform_data(struct device *dev,

>  

>  	return pdata;

>  }

> -EXPORT_SYMBOL_GPL(of_get_coresight_platform_data);

>  #endif

> +

> +struct coresight_platform_data *

> +coresight_get_platform_data(struct device *dev)

> +{

> +	struct coresight_platform_data *pdata;

> +	struct fwnode_handle *fwnode = dev_fwnode(dev);

> +

> +	if (IS_ERR_OR_NULL(fwnode))

> +		return NULL;

> +

> +	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);

> +	if (!pdata)

> +		return ERR_PTR(-ENOMEM);

> +

> +	/* Use device name as sysfs handle */

> +	pdata->name = dev_name(dev);

> +

> +	if (is_of_node(fwnode))

> +		return of_get_coresight_platform_data(dev, pdata);


Now that I'm looking a patch 26, returning a coresight_platform_data pointer is
a little weird here.  Function of_get_coresight_platform_data() simply fills in
the pdata and should probably be returning an error code rather than a
pointer.  If of_get_coresight_platform_data() returns 0 then pdata is returned.

Mathieu

> +

> +	return ERR_PTR(-ENOENT);

> +}

> +EXPORT_SYMBOL_GPL(coresight_get_platform_data);

> diff --git a/drivers/hwtracing/coresight/coresight-replicator.c b/drivers/hwtracing/coresight/coresight-replicator.c

> index 8bbb008..7eb3bf7 100644

> --- a/drivers/hwtracing/coresight/coresight-replicator.c

> +++ b/drivers/hwtracing/coresight/coresight-replicator.c

> @@ -177,15 +177,12 @@ static int replicator_probe(struct device *dev, struct resource *res)

>  	struct coresight_platform_data *pdata = NULL;

>  	struct replicator_drvdata *drvdata;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = dev->of_node;

>  	void __iomem *base;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata))

> -			return PTR_ERR(pdata);

> -		dev->platform_data = pdata;

> -	}

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata))

> +		return PTR_ERR(pdata);

> +	dev->platform_data = pdata;

>  

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata)

> @@ -213,7 +210,6 @@ static int replicator_probe(struct device *dev, struct resource *res)

>  	}

>  

>  	dev_set_drvdata(dev, drvdata);

> -

>  	desc.type = CORESIGHT_DEV_TYPE_LINK;

>  	desc.subtype.link_subtype = CORESIGHT_DEV_SUBTYPE_LINK_SPLIT;

>  	desc.ops = &replicator_cs_ops;

> diff --git a/drivers/hwtracing/coresight/coresight-stm.c b/drivers/hwtracing/coresight/coresight-stm.c

> index a0690be..eae0094 100644

> --- a/drivers/hwtracing/coresight/coresight-stm.c

> +++ b/drivers/hwtracing/coresight/coresight-stm.c

> @@ -809,14 +809,11 @@ static int stm_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct resource ch_res;

>  	size_t bitmap_size;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = adev->dev.of_node;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata))

> -			return PTR_ERR(pdata);

> -		adev->dev.platform_data = pdata;

> -	}

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata))

> +		return PTR_ERR(pdata);

> +	adev->dev.platform_data = pdata;

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata)

>  		return -ENOMEM;

> diff --git a/drivers/hwtracing/coresight/coresight-tmc.c b/drivers/hwtracing/coresight/coresight-tmc.c

> index c470b81..7dbdf59 100644

> --- a/drivers/hwtracing/coresight/coresight-tmc.c

> +++ b/drivers/hwtracing/coresight/coresight-tmc.c

> @@ -395,16 +395,13 @@ static int tmc_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct tmc_drvdata *drvdata;

>  	struct resource *res = &adev->res;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = adev->dev.of_node;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata)) {

> -			ret = PTR_ERR(pdata);

> -			goto out;

> -		}

> -		adev->dev.platform_data = pdata;

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata)) {

> +		ret = PTR_ERR(pdata);

> +		goto out;

>  	}

> +	adev->dev.platform_data = pdata;

>  

>  	ret = -ENOMEM;

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

> diff --git a/drivers/hwtracing/coresight/coresight-tpiu.c b/drivers/hwtracing/coresight/coresight-tpiu.c

> index 96af7d5..eea7fd1 100644

> --- a/drivers/hwtracing/coresight/coresight-tpiu.c

> +++ b/drivers/hwtracing/coresight/coresight-tpiu.c

> @@ -120,14 +120,11 @@ static int tpiu_probe(struct amba_device *adev, const struct amba_id *id)

>  	struct tpiu_drvdata *drvdata;

>  	struct resource *res = &adev->res;

>  	struct coresight_desc desc = { 0 };

> -	struct device_node *np = adev->dev.of_node;

>  

> -	if (np) {

> -		pdata = of_get_coresight_platform_data(dev, np);

> -		if (IS_ERR(pdata))

> -			return PTR_ERR(pdata);

> -		adev->dev.platform_data = pdata;

> -	}

> +	pdata = coresight_get_platform_data(dev);

> +	if (IS_ERR(pdata))

> +		return PTR_ERR(pdata);

> +	dev->platform_data = pdata;

>  

>  	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>  	if (!drvdata)

> diff --git a/include/linux/coresight.h b/include/linux/coresight.h

> index 7b87965..5b29255 100644

> --- a/include/linux/coresight.h

> +++ b/include/linux/coresight.h

> @@ -293,14 +293,11 @@ static inline void coresight_disclaim_device_unlocked(void __iomem *base) {}

>  

>  #ifdef CONFIG_OF

>  extern int of_coresight_get_cpu(const struct device_node *node);

> -extern struct coresight_platform_data *

> -of_get_coresight_platform_data(struct device *dev,

> -			       const struct device_node *node);

>  #else

>  static inline int of_coresight_get_cpu(const struct device_node *node)

>  { return 0; }

> -static inline struct coresight_platform_data *of_get_coresight_platform_data(

> -	struct device *dev, const struct device_node *node) { return NULL; }

>  #endif

>  

> +struct coresight_platform_data *coresight_get_platform_data(struct device *dev);

> +

>  #endif

> -- 

> 2.7.4

>
Suzuki K Poulose April 23, 2019, 9:43 a.m. UTC | #2
On 04/22/2019 07:09 PM, Mathieu Poirier wrote:
> Hi Suzuki,

> 

> On Mon, Apr 15, 2019 at 05:04:02PM +0100, Suzuki K Poulose wrote:

>> So far we have hard coded the DT platform parsing code in

>> every driver. Introduce generic helper to parse the information

>> provided by the firmware in a platform agnostic manner, in preparation

>> for the ACPI support.

>>

>> Cc: Mathieu Poirier <mathieu.poirier@linaro.org>

>> Signed-off-by: Suzuki K Poulose <suzuki.poulose@arm.com>

>> ---

>>   drivers/hwtracing/coresight/coresight-catu.c       | 13 +++-----

>>   drivers/hwtracing/coresight/coresight-etb10.c      | 11 +++----

>>   drivers/hwtracing/coresight/coresight-etm3x.c      | 12 +++-----

>>   drivers/hwtracing/coresight/coresight-etm4x.c      | 11 +++----

>>   drivers/hwtracing/coresight/coresight-funnel.c     | 11 +++----

>>   drivers/hwtracing/coresight/coresight-platform.c   | 36 ++++++++++++++++------

>>   drivers/hwtracing/coresight/coresight-replicator.c | 12 +++-----

>>   drivers/hwtracing/coresight/coresight-stm.c        | 11 +++----

>>   drivers/hwtracing/coresight/coresight-tmc.c        | 13 +++-----

>>   drivers/hwtracing/coresight/coresight-tpiu.c       | 11 +++----

>>   include/linux/coresight.h                          |  7 ++---

>>   11 files changed, 66 insertions(+), 82 deletions(-)

>>

>> diff --git a/drivers/hwtracing/coresight/coresight-catu.c b/drivers/hwtracing/coresight/coresight-catu.c

>> index 14d1cf5..65b86ec 100644

>> --- a/drivers/hwtracing/coresight/coresight-catu.c

>> +++ b/drivers/hwtracing/coresight/coresight-catu.c

>> @@ -503,17 +503,14 @@ static int catu_probe(struct amba_device *adev, const struct amba_id *id)

>>   	struct coresight_desc catu_desc;

>>   	struct coresight_platform_data *pdata = NULL;

>>   	struct device *dev = &adev->dev;

>> -	struct device_node *np = dev->of_node;

>>   	void __iomem *base;

>>   

>> -	if (np) {

>> -		pdata = of_get_coresight_platform_data(dev, np);

>> -		if (IS_ERR(pdata)) {

>> -			ret = PTR_ERR(pdata);

>> -			goto out;

>> -		}

>> -		dev->platform_data = pdata;

>> +	pdata = coresight_get_platform_data(dev);

>> +	if (IS_ERR(pdata)) {

>> +		ret = PTR_ERR(pdata);

>> +		goto out;

>>   	}

>> +	dev->platform_data = pdata;

>>   

>>   	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>>   	if (!drvdata) {

>> diff --git a/drivers/hwtracing/coresight/coresight-etb10.c b/drivers/hwtracing/coresight/coresight-etb10.c

>> index 6e6e9aa..cd61b54 100644

>> --- a/drivers/hwtracing/coresight/coresight-etb10.c

>> +++ b/drivers/hwtracing/coresight/coresight-etb10.c

>> @@ -681,14 +681,11 @@ static int etb_probe(struct amba_device *adev, const struct amba_id *id)

>>   	struct etb_drvdata *drvdata;

>>   	struct resource *res = &adev->res;

>>   	struct coresight_desc desc = { 0 };

>> -	struct device_node *np = adev->dev.of_node;

>>   

>> -	if (np) {

>> -		pdata = of_get_coresight_platform_data(dev, np);

>> -		if (IS_ERR(pdata))

>> -			return PTR_ERR(pdata);

>> -		adev->dev.platform_data = pdata;

>> -	}

>> +	pdata = coresight_get_platform_data(dev);

>> +	if (IS_ERR(pdata))

>> +		return PTR_ERR(pdata);

>> +	adev->dev.platform_data = pdata;

>>   

>>   	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>>   	if (!drvdata)

>> diff --git a/drivers/hwtracing/coresight/coresight-etm3x.c b/drivers/hwtracing/coresight/coresight-etm3x.c

>> index fa2f141..fa2164f 100644

>> --- a/drivers/hwtracing/coresight/coresight-etm3x.c

>> +++ b/drivers/hwtracing/coresight/coresight-etm3x.c

>> @@ -790,20 +790,16 @@ static int etm_probe(struct amba_device *adev, const struct amba_id *id)

>>   	struct etm_drvdata *drvdata;

>>   	struct resource *res = &adev->res;

>>   	struct coresight_desc desc = { 0 };

>> -	struct device_node *np = adev->dev.of_node;

>>   

>>   	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>>   	if (!drvdata)

>>   		return -ENOMEM;

>>   

>> -	if (np) {

>> -		pdata = of_get_coresight_platform_data(dev, np);

>> -		if (IS_ERR(pdata))

>> -			return PTR_ERR(pdata);

>> -

>> -		adev->dev.platform_data = pdata;

>> -	}

>> +	pdata = coresight_get_platform_data(dev);

>> +	if (IS_ERR(pdata))

>> +		return PTR_ERR(pdata);

>>   

>> +	adev->dev.platform_data = pdata;

>>   	drvdata->use_cp14 = fwnode_property_read_bool(dev->fwnode, "arm,cp14");

>>   	dev_set_drvdata(dev, drvdata);

>>   

>> diff --git a/drivers/hwtracing/coresight/coresight-etm4x.c b/drivers/hwtracing/coresight/coresight-etm4x.c

>> index 75b923f..998b9f3 100644

>> --- a/drivers/hwtracing/coresight/coresight-etm4x.c

>> +++ b/drivers/hwtracing/coresight/coresight-etm4x.c

>> @@ -976,18 +976,15 @@ static int etm4_probe(struct amba_device *adev, const struct amba_id *id)

>>   	struct etmv4_drvdata *drvdata;

>>   	struct resource *res = &adev->res;

>>   	struct coresight_desc desc = { 0 };

>> -	struct device_node *np = adev->dev.of_node;

>>   

>>   	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>>   	if (!drvdata)

>>   		return -ENOMEM;

>>   

>> -	if (np) {

>> -		pdata = of_get_coresight_platform_data(dev, np);

>> -		if (IS_ERR(pdata))

>> -			return PTR_ERR(pdata);

>> -		adev->dev.platform_data = pdata;

>> -	}

>> +	pdata = coresight_get_platform_data(dev);

>> +	if (IS_ERR(pdata))

>> +		return PTR_ERR(pdata);

>> +	adev->dev.platform_data = pdata;

>>   

>>   	dev_set_drvdata(dev, drvdata);

>>   

>> diff --git a/drivers/hwtracing/coresight/coresight-funnel.c b/drivers/hwtracing/coresight/coresight-funnel.c

>> index 1085f31..2590744 100644

>> --- a/drivers/hwtracing/coresight/coresight-funnel.c

>> +++ b/drivers/hwtracing/coresight/coresight-funnel.c

>> @@ -185,14 +185,11 @@ static int funnel_probe(struct amba_device *adev, const struct amba_id *id)

>>   	struct funnel_drvdata *drvdata;

>>   	struct resource *res = &adev->res;

>>   	struct coresight_desc desc = { 0 };

>> -	struct device_node *np = adev->dev.of_node;

>>   

>> -	if (np) {

>> -		pdata = of_get_coresight_platform_data(dev, np);

>> -		if (IS_ERR(pdata))

>> -			return PTR_ERR(pdata);

>> -		adev->dev.platform_data = pdata;

>> -	}

>> +	pdata = coresight_get_platform_data(dev);

>> +	if (IS_ERR(pdata))

>> +		return PTR_ERR(pdata);

>> +	adev->dev.platform_data = pdata;

>>   

>>   	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);

>>   	if (!drvdata)

>> diff --git a/drivers/hwtracing/coresight/coresight-platform.c b/drivers/hwtracing/coresight/coresight-platform.c

>> index 4c31299..25a1838 100644

>> --- a/drivers/hwtracing/coresight/coresight-platform.c

>> +++ b/drivers/hwtracing/coresight/coresight-platform.c

>> @@ -230,23 +230,17 @@ static int of_coresight_parse_endpoint(struct device *dev,

>>   	return ret;

>>   }

>>   

>> -struct coresight_platform_data *

>> +static struct coresight_platform_data *

>>   of_get_coresight_platform_data(struct device *dev,

>> -			       const struct device_node *node)

>> +			       struct coresight_platform_data *pdata)

>>   {

>>   	int ret = 0;

>> -	struct coresight_platform_data *pdata;

>>   	struct coresight_connection *conn;

>>   	struct device_node *ep = NULL;

>>   	const struct device_node *parent = NULL;

>>   	bool legacy_binding = false;

>> +	struct device_node *node = dev->of_node;

>>   

>> -	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);

>> -	if (!pdata)

>> -		return ERR_PTR(-ENOMEM);

>> -

>> -	/* Use device name as sysfs handle */

>> -	pdata->name = dev_name(dev);

>>   	pdata->cpu = of_coresight_get_cpu(node);

>>   

>>   	/* Get the number of input and output port for this component */

>> @@ -298,5 +292,27 @@ of_get_coresight_platform_data(struct device *dev,

>>   

>>   	return pdata;

>>   }

>> -EXPORT_SYMBOL_GPL(of_get_coresight_platform_data);

>>   #endif

>> +

>> +struct coresight_platform_data *

>> +coresight_get_platform_data(struct device *dev)

>> +{

>> +	struct coresight_platform_data *pdata;

>> +	struct fwnode_handle *fwnode = dev_fwnode(dev);

>> +

>> +	if (IS_ERR_OR_NULL(fwnode))

>> +		return NULL;

>> +

>> +	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);

>> +	if (!pdata)

>> +		return ERR_PTR(-ENOMEM);

>> +

>> +	/* Use device name as sysfs handle */

>> +	pdata->name = dev_name(dev);

>> +

>> +	if (is_of_node(fwnode))

>> +		return of_get_coresight_platform_data(dev, pdata);

> 

> Now that I'm looking a patch 26, returning a coresight_platform_data pointer is

> a little weird here.  Function of_get_coresight_platform_data() simply fills in

> the pdata and should probably be returning an error code rather than a

> pointer.  If of_get_coresight_platform_data() returns 0 then pdata is returned.s, 


Yes, that makes sense. I will fix it.

Cheers
Suzuki
diff mbox series

Patch

diff --git a/drivers/hwtracing/coresight/coresight-catu.c b/drivers/hwtracing/coresight/coresight-catu.c
index 14d1cf5..65b86ec 100644
--- a/drivers/hwtracing/coresight/coresight-catu.c
+++ b/drivers/hwtracing/coresight/coresight-catu.c
@@ -503,17 +503,14 @@  static int catu_probe(struct amba_device *adev, const struct amba_id *id)
 	struct coresight_desc catu_desc;
 	struct coresight_platform_data *pdata = NULL;
 	struct device *dev = &adev->dev;
-	struct device_node *np = dev->of_node;
 	void __iomem *base;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata)) {
-			ret = PTR_ERR(pdata);
-			goto out;
-		}
-		dev->platform_data = pdata;
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata)) {
+		ret = PTR_ERR(pdata);
+		goto out;
 	}
+	dev->platform_data = pdata;
 
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata) {
diff --git a/drivers/hwtracing/coresight/coresight-etb10.c b/drivers/hwtracing/coresight/coresight-etb10.c
index 6e6e9aa..cd61b54 100644
--- a/drivers/hwtracing/coresight/coresight-etb10.c
+++ b/drivers/hwtracing/coresight/coresight-etb10.c
@@ -681,14 +681,11 @@  static int etb_probe(struct amba_device *adev, const struct amba_id *id)
 	struct etb_drvdata *drvdata;
 	struct resource *res = &adev->res;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = adev->dev.of_node;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata))
-			return PTR_ERR(pdata);
-		adev->dev.platform_data = pdata;
-	}
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata))
+		return PTR_ERR(pdata);
+	adev->dev.platform_data = pdata;
 
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
diff --git a/drivers/hwtracing/coresight/coresight-etm3x.c b/drivers/hwtracing/coresight/coresight-etm3x.c
index fa2f141..fa2164f 100644
--- a/drivers/hwtracing/coresight/coresight-etm3x.c
+++ b/drivers/hwtracing/coresight/coresight-etm3x.c
@@ -790,20 +790,16 @@  static int etm_probe(struct amba_device *adev, const struct amba_id *id)
 	struct etm_drvdata *drvdata;
 	struct resource *res = &adev->res;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = adev->dev.of_node;
 
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
 		return -ENOMEM;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata))
-			return PTR_ERR(pdata);
-
-		adev->dev.platform_data = pdata;
-	}
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata))
+		return PTR_ERR(pdata);
 
+	adev->dev.platform_data = pdata;
 	drvdata->use_cp14 = fwnode_property_read_bool(dev->fwnode, "arm,cp14");
 	dev_set_drvdata(dev, drvdata);
 
diff --git a/drivers/hwtracing/coresight/coresight-etm4x.c b/drivers/hwtracing/coresight/coresight-etm4x.c
index 75b923f..998b9f3 100644
--- a/drivers/hwtracing/coresight/coresight-etm4x.c
+++ b/drivers/hwtracing/coresight/coresight-etm4x.c
@@ -976,18 +976,15 @@  static int etm4_probe(struct amba_device *adev, const struct amba_id *id)
 	struct etmv4_drvdata *drvdata;
 	struct resource *res = &adev->res;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = adev->dev.of_node;
 
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
 		return -ENOMEM;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata))
-			return PTR_ERR(pdata);
-		adev->dev.platform_data = pdata;
-	}
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata))
+		return PTR_ERR(pdata);
+	adev->dev.platform_data = pdata;
 
 	dev_set_drvdata(dev, drvdata);
 
diff --git a/drivers/hwtracing/coresight/coresight-funnel.c b/drivers/hwtracing/coresight/coresight-funnel.c
index 1085f31..2590744 100644
--- a/drivers/hwtracing/coresight/coresight-funnel.c
+++ b/drivers/hwtracing/coresight/coresight-funnel.c
@@ -185,14 +185,11 @@  static int funnel_probe(struct amba_device *adev, const struct amba_id *id)
 	struct funnel_drvdata *drvdata;
 	struct resource *res = &adev->res;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = adev->dev.of_node;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata))
-			return PTR_ERR(pdata);
-		adev->dev.platform_data = pdata;
-	}
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata))
+		return PTR_ERR(pdata);
+	adev->dev.platform_data = pdata;
 
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
diff --git a/drivers/hwtracing/coresight/coresight-platform.c b/drivers/hwtracing/coresight/coresight-platform.c
index 4c31299..25a1838 100644
--- a/drivers/hwtracing/coresight/coresight-platform.c
+++ b/drivers/hwtracing/coresight/coresight-platform.c
@@ -230,23 +230,17 @@  static int of_coresight_parse_endpoint(struct device *dev,
 	return ret;
 }
 
-struct coresight_platform_data *
+static struct coresight_platform_data *
 of_get_coresight_platform_data(struct device *dev,
-			       const struct device_node *node)
+			       struct coresight_platform_data *pdata)
 {
 	int ret = 0;
-	struct coresight_platform_data *pdata;
 	struct coresight_connection *conn;
 	struct device_node *ep = NULL;
 	const struct device_node *parent = NULL;
 	bool legacy_binding = false;
+	struct device_node *node = dev->of_node;
 
-	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
-	if (!pdata)
-		return ERR_PTR(-ENOMEM);
-
-	/* Use device name as sysfs handle */
-	pdata->name = dev_name(dev);
 	pdata->cpu = of_coresight_get_cpu(node);
 
 	/* Get the number of input and output port for this component */
@@ -298,5 +292,27 @@  of_get_coresight_platform_data(struct device *dev,
 
 	return pdata;
 }
-EXPORT_SYMBOL_GPL(of_get_coresight_platform_data);
 #endif
+
+struct coresight_platform_data *
+coresight_get_platform_data(struct device *dev)
+{
+	struct coresight_platform_data *pdata;
+	struct fwnode_handle *fwnode = dev_fwnode(dev);
+
+	if (IS_ERR_OR_NULL(fwnode))
+		return NULL;
+
+	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
+	if (!pdata)
+		return ERR_PTR(-ENOMEM);
+
+	/* Use device name as sysfs handle */
+	pdata->name = dev_name(dev);
+
+	if (is_of_node(fwnode))
+		return of_get_coresight_platform_data(dev, pdata);
+
+	return ERR_PTR(-ENOENT);
+}
+EXPORT_SYMBOL_GPL(coresight_get_platform_data);
diff --git a/drivers/hwtracing/coresight/coresight-replicator.c b/drivers/hwtracing/coresight/coresight-replicator.c
index 8bbb008..7eb3bf7 100644
--- a/drivers/hwtracing/coresight/coresight-replicator.c
+++ b/drivers/hwtracing/coresight/coresight-replicator.c
@@ -177,15 +177,12 @@  static int replicator_probe(struct device *dev, struct resource *res)
 	struct coresight_platform_data *pdata = NULL;
 	struct replicator_drvdata *drvdata;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = dev->of_node;
 	void __iomem *base;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata))
-			return PTR_ERR(pdata);
-		dev->platform_data = pdata;
-	}
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata))
+		return PTR_ERR(pdata);
+	dev->platform_data = pdata;
 
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
@@ -213,7 +210,6 @@  static int replicator_probe(struct device *dev, struct resource *res)
 	}
 
 	dev_set_drvdata(dev, drvdata);
-
 	desc.type = CORESIGHT_DEV_TYPE_LINK;
 	desc.subtype.link_subtype = CORESIGHT_DEV_SUBTYPE_LINK_SPLIT;
 	desc.ops = &replicator_cs_ops;
diff --git a/drivers/hwtracing/coresight/coresight-stm.c b/drivers/hwtracing/coresight/coresight-stm.c
index a0690be..eae0094 100644
--- a/drivers/hwtracing/coresight/coresight-stm.c
+++ b/drivers/hwtracing/coresight/coresight-stm.c
@@ -809,14 +809,11 @@  static int stm_probe(struct amba_device *adev, const struct amba_id *id)
 	struct resource ch_res;
 	size_t bitmap_size;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = adev->dev.of_node;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata))
-			return PTR_ERR(pdata);
-		adev->dev.platform_data = pdata;
-	}
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata))
+		return PTR_ERR(pdata);
+	adev->dev.platform_data = pdata;
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
 		return -ENOMEM;
diff --git a/drivers/hwtracing/coresight/coresight-tmc.c b/drivers/hwtracing/coresight/coresight-tmc.c
index c470b81..7dbdf59 100644
--- a/drivers/hwtracing/coresight/coresight-tmc.c
+++ b/drivers/hwtracing/coresight/coresight-tmc.c
@@ -395,16 +395,13 @@  static int tmc_probe(struct amba_device *adev, const struct amba_id *id)
 	struct tmc_drvdata *drvdata;
 	struct resource *res = &adev->res;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = adev->dev.of_node;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata)) {
-			ret = PTR_ERR(pdata);
-			goto out;
-		}
-		adev->dev.platform_data = pdata;
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata)) {
+		ret = PTR_ERR(pdata);
+		goto out;
 	}
+	adev->dev.platform_data = pdata;
 
 	ret = -ENOMEM;
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
diff --git a/drivers/hwtracing/coresight/coresight-tpiu.c b/drivers/hwtracing/coresight/coresight-tpiu.c
index 96af7d5..eea7fd1 100644
--- a/drivers/hwtracing/coresight/coresight-tpiu.c
+++ b/drivers/hwtracing/coresight/coresight-tpiu.c
@@ -120,14 +120,11 @@  static int tpiu_probe(struct amba_device *adev, const struct amba_id *id)
 	struct tpiu_drvdata *drvdata;
 	struct resource *res = &adev->res;
 	struct coresight_desc desc = { 0 };
-	struct device_node *np = adev->dev.of_node;
 
-	if (np) {
-		pdata = of_get_coresight_platform_data(dev, np);
-		if (IS_ERR(pdata))
-			return PTR_ERR(pdata);
-		adev->dev.platform_data = pdata;
-	}
+	pdata = coresight_get_platform_data(dev);
+	if (IS_ERR(pdata))
+		return PTR_ERR(pdata);
+	dev->platform_data = pdata;
 
 	drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
 	if (!drvdata)
diff --git a/include/linux/coresight.h b/include/linux/coresight.h
index 7b87965..5b29255 100644
--- a/include/linux/coresight.h
+++ b/include/linux/coresight.h
@@ -293,14 +293,11 @@  static inline void coresight_disclaim_device_unlocked(void __iomem *base) {}
 
 #ifdef CONFIG_OF
 extern int of_coresight_get_cpu(const struct device_node *node);
-extern struct coresight_platform_data *
-of_get_coresight_platform_data(struct device *dev,
-			       const struct device_node *node);
 #else
 static inline int of_coresight_get_cpu(const struct device_node *node)
 { return 0; }
-static inline struct coresight_platform_data *of_get_coresight_platform_data(
-	struct device *dev, const struct device_node *node) { return NULL; }
 #endif
 
+struct coresight_platform_data *coresight_get_platform_data(struct device *dev);
+
 #endif