diff mbox series

[V3,04/12] ASoC: amd: create acp5x platform devices

Message ID 20210719165140.16143-5-vijendar.mukunda@amd.com (mailing list archive)
State Superseded
Headers show
Series Add Vangogh ACP ASoC driver | expand

Commit Message

Vijendar Mukunda July 19, 2021, 4:51 p.m. UTC
ACP5.x IP has multiple I2S controllers and DMA controller.
Create platform devices for I2S HS controller instance, I2S SP controller
instance and DMA contrller.
Pass PCI resources like MMIO, irq to these platform devices.

Signed-off-by: Vijendar Mukunda <Vijendar.Mukunda@amd.com>
---
 sound/soc/amd/vangogh/acp5x.h     | 10 ++++
 sound/soc/amd/vangogh/pci-acp5x.c | 95 ++++++++++++++++++++++++++++++-
 2 files changed, 102 insertions(+), 3 deletions(-)

Comments

Pierre-Louis Bossart July 19, 2021, 6:07 p.m. UTC | #1
On 7/19/21 11:51 AM, Vijendar Mukunda wrote:
> ACP5.x IP has multiple I2S controllers and DMA controller.
> Create platform devices for I2S HS controller instance, I2S SP controller
> instance and DMA contrller.

typo: controller

> Pass PCI resources like MMIO, irq to these platform devices.
> 
> Signed-off-by: Vijendar Mukunda <Vijendar.Mukunda@amd.com>
> ---
>  sound/soc/amd/vangogh/acp5x.h     | 10 ++++
>  sound/soc/amd/vangogh/pci-acp5x.c | 95 ++++++++++++++++++++++++++++++-
>  2 files changed, 102 insertions(+), 3 deletions(-)
> 
> diff --git a/sound/soc/amd/vangogh/acp5x.h b/sound/soc/amd/vangogh/acp5x.h
> index 708586109315..bbf29fd2b12f 100644
> --- a/sound/soc/amd/vangogh/acp5x.h
> +++ b/sound/soc/amd/vangogh/acp5x.h
> @@ -22,6 +22,16 @@
>  #define ACP_ERR_INTR_MASK	0x20000000
>  #define ACP_EXT_INTR_STAT_CLEAR_MASK 0xFFFFFFFF
>  
> +#define ACP5x_DEVS 0x03

3?

> +#define	ACP5x_REG_START	0x1240000
> +#define	ACP5x_REG_END	0x1250200
> +#define ACP5x_I2STDM_REG_START	0x1242400
> +#define ACP5x_I2STDM_REG_END	0x1242410
> +#define ACP5x_HS_TDM_REG_START	0x1242814
> +#define ACP5x_HS_TDM_REG_END	0x1242824
> +#define I2S_MODE 0x00
> +#define ACP5x_I2S_MODE 0x00
> +
>  /* common header file uses exact offset rather than relative
>   * offset which requires substraction logic from base_addr

typo: subtraction

>   * for accessing ACP5x MMIO space registers
> diff --git a/sound/soc/amd/vangogh/pci-acp5x.c b/sound/soc/amd/vangogh/pci-acp5x.c
> index 523b962fe35e..3cc15a15b745 100644
> --- a/sound/soc/amd/vangogh/pci-acp5x.c
> +++ b/sound/soc/amd/vangogh/pci-acp5x.c
> @@ -8,11 +8,16 @@
>  #include <linux/module.h>
>  #include <linux/io.h>
>  #include <linux/delay.h>
> +#include <linux/platform_device.h>
> +#include <linux/interrupt.h>
>  
>  #include "acp5x.h"
>  
>  struct acp5x_dev_data {
>  	void __iomem *acp5x_base;
> +	bool acp5x_audio_mode;
> +	struct resource *res;
> +	struct platform_device *pdev[3];

pdev[ACP5x_DEVS] ?

>  };
>  
>  static int acp5x_power_on(void __iomem *acp5x_base)
> @@ -114,9 +119,12 @@ static int snd_acp5x_probe(struct pci_dev *pci,
>  			   const struct pci_device_id *pci_id)
>  {
>  	struct acp5x_dev_data *adata;
> -	int ret;
> -	u32 addr;
> +	struct platform_device_info pdevinfo[3];
> +	unsigned int irqflags;
> +	int ret, i;
> +	u32 addr, val;
>  
> +	irqflags = IRQF_SHARED;
>  	if (pci->revision != 0x50)
>  		return -ENODEV;
>  
> @@ -150,6 +158,83 @@ static int snd_acp5x_probe(struct pci_dev *pci,
>  	if (ret)
>  		goto release_regions;
>  
> +	val = acp_readl(adata->acp5x_base + ACP_PIN_CONFIG);
> +	switch (val) {
> +	case I2S_MODE:
> +		adata->res = devm_kzalloc(&pci->dev,
> +					  sizeof(struct resource) * 4,

what is this 4 value?

> +					  GFP_KERNEL);
> +		if (!adata->res) {
> +			ret = -ENOMEM;
> +			goto de_init;
> +		}
> +
> +		adata->res[0].name = "acp5x_i2s_iomem";
> +		adata->res[0].flags = IORESOURCE_MEM;
> +		adata->res[0].start = addr;
> +		adata->res[0].end = addr + (ACP5x_REG_END - ACP5x_REG_START);
> +
> +		adata->res[1].name = "acp5x_i2s_sp";
> +		adata->res[1].flags = IORESOURCE_MEM;
> +		adata->res[1].start = addr + ACP5x_I2STDM_REG_START;
> +		adata->res[1].end = addr + ACP5x_I2STDM_REG_END;
> +
> +		adata->res[2].name = "acp5x_i2s_hs";
> +		adata->res[2].flags = IORESOURCE_MEM;
> +		adata->res[2].start = addr + ACP5x_HS_TDM_REG_START;
> +		adata->res[2].end = addr + ACP5x_HS_TDM_REG_END;
> +
> +		adata->res[3].name = "acp5x_i2s_irq";
> +		adata->res[3].flags = IORESOURCE_IRQ;
> +		adata->res[3].start = pci->irq;
> +		adata->res[3].end = adata->res[3].start;
> +
> +		adata->acp5x_audio_mode = ACP5x_I2S_MODE;
> +
> +		memset(&pdevinfo, 0, sizeof(pdevinfo));
> +		pdevinfo[0].name = "acp5x_i2s_dma";
> +		pdevinfo[0].id = 0;
> +		pdevinfo[0].parent = &pci->dev;
> +		pdevinfo[0].num_res = 4;
> +		pdevinfo[0].res = &adata->res[0];
> +		pdevinfo[0].data = &irqflags;
> +		pdevinfo[0].size_data = sizeof(irqflags);
> +
> +		pdevinfo[1].name = "acp5x_i2s_playcap";
> +		pdevinfo[1].id = 0;
> +		pdevinfo[1].parent = &pci->dev;
> +		pdevinfo[1].num_res = 1;
> +		pdevinfo[1].res = &adata->res[1];
> +
> +		pdevinfo[2].name = "acp5x_i2s_playcap";
> +		pdevinfo[2].id = 1;
> +		pdevinfo[2].parent = &pci->dev;
> +		pdevinfo[2].num_res = 1;
> +		pdevinfo[2].res = &adata->res[2];
> +
> +		for (i = 0; i < ACP5x_DEVS; i++) {
> +			adata->pdev[i] =
> +				platform_device_register_full(&pdevinfo[i]);
> +			if (IS_ERR(adata->pdev[i])) {
> +				dev_err(&pci->dev, "cannot register %s device\n",
> +					pdevinfo[i].name);
> +				ret = PTR_ERR(adata->pdev[i]);
> +				goto unregister_devs;
> +			}
> +		}
> +		break;
> +	default:
> +		dev_info(&pci->dev, "ACP audio mode : %d\n", val);
> +	}
> +	return 0;
> +
> +unregister_devs:
> +	if (val == I2S_MODE)

nit-pick: you can't reach this point outside of the I2S_MODE, so this test is not useful


> +		for (i = 0; i < ACP5x_DEVS; i++)
> +			platform_device_unregister(adata->pdev[i]);

only unregister what you registered?

for (--i; i > 0; i--)

> +de_init:
> +	if (acp5x_deinit(adata->acp5x_base))
> +		dev_err(&pci->dev, "ACP de-init failed\n");
>  release_regions:
>  	pci_release_regions(pci);
>  disable_pci:
> @@ -161,9 +246,13 @@ static int snd_acp5x_probe(struct pci_dev *pci,
>  static void snd_acp5x_remove(struct pci_dev *pci)
>  {
>  	struct acp5x_dev_data *adata;
> -	int ret;
> +	int i, ret;
>  
>  	adata = pci_get_drvdata(pci);
> +	if (adata->acp5x_audio_mode == ACP5x_I2S_MODE) {
> +		for (i = 0; i < ACP5x_DEVS; i++)
> +			platform_device_unregister(adata->pdev[i]);
> +	}
>  	ret = acp5x_deinit(adata->acp5x_base);
>  	if (ret)
>  		dev_err(&pci->dev, "ACP de-init failed\n");
>
Vijendar Mukunda July 19, 2021, 7:17 p.m. UTC | #2
On 7/19/21 11:37 PM, Pierre-Louis Bossart wrote:
> 
> 
> On 7/19/21 11:51 AM, Vijendar Mukunda wrote:
>> ACP5.x IP has multiple I2S controllers and DMA controller.
>> Create platform devices for I2S HS controller instance, I2S SP controller
>> instance and DMA contrller.
> 
> typo: controller
Will fix it.
> 
>> Pass PCI resources like MMIO, irq to these platform devices.
>>
>> Signed-off-by: Vijendar Mukunda <Vijendar.Mukunda@amd.com>
>> ---
>>  sound/soc/amd/vangogh/acp5x.h     | 10 ++++
>>  sound/soc/amd/vangogh/pci-acp5x.c | 95 ++++++++++++++++++++++++++++++-
>>  2 files changed, 102 insertions(+), 3 deletions(-)
>>
>> diff --git a/sound/soc/amd/vangogh/acp5x.h b/sound/soc/amd/vangogh/acp5x.h
>> index 708586109315..bbf29fd2b12f 100644
>> --- a/sound/soc/amd/vangogh/acp5x.h
>> +++ b/sound/soc/amd/vangogh/acp5x.h
>> @@ -22,6 +22,16 @@
>>  #define ACP_ERR_INTR_MASK	0x20000000
>>  #define ACP_EXT_INTR_STAT_CLEAR_MASK 0xFFFFFFFF
>>  
>> +#define ACP5x_DEVS 0x03
> 
> 3?
> 
Will create 3 platform devices for DMA device and two
I2S controllers.

>> +#define	ACP5x_REG_START	0x1240000
>> +#define	ACP5x_REG_END	0x1250200
>> +#define ACP5x_I2STDM_REG_START	0x1242400
>> +#define ACP5x_I2STDM_REG_END	0x1242410
>> +#define ACP5x_HS_TDM_REG_START	0x1242814
>> +#define ACP5x_HS_TDM_REG_END	0x1242824
>> +#define I2S_MODE 0x00
>> +#define ACP5x_I2S_MODE 0x00
>> +
>>  /* common header file uses exact offset rather than relative
>>   * offset which requires substraction logic from base_addr
> 
> typo: subtraction
Will fix it
> 
>>   * for accessing ACP5x MMIO space registers
>> diff --git a/sound/soc/amd/vangogh/pci-acp5x.c b/sound/soc/amd/vangogh/pci-acp5x.c
>> index 523b962fe35e..3cc15a15b745 100644
>> --- a/sound/soc/amd/vangogh/pci-acp5x.c
>> +++ b/sound/soc/amd/vangogh/pci-acp5x.c
>> @@ -8,11 +8,16 @@
>>  #include <linux/module.h>
>>  #include <linux/io.h>
>>  #include <linux/delay.h>
>> +#include <linux/platform_device.h>
>> +#include <linux/interrupt.h>
>>  
>>  #include "acp5x.h"
>>  
>>  struct acp5x_dev_data {
>>  	void __iomem *acp5x_base;
>> +	bool acp5x_audio_mode;
>> +	struct resource *res;
>> +	struct platform_device *pdev[3];
> 
> pdev[ACP5x_DEVS] ?
Will update it.
> 
>>  };
>>  
>>  static int acp5x_power_on(void __iomem *acp5x_base)
>> @@ -114,9 +119,12 @@ static int snd_acp5x_probe(struct pci_dev *pci,
>>  			   const struct pci_device_id *pci_id)
>>  {
>>  	struct acp5x_dev_data *adata;
>> -	int ret;
>> -	u32 addr;
>> +	struct platform_device_info pdevinfo[3];
>> +	unsigned int irqflags;
>> +	int ret, i;
>> +	u32 addr, val;
>>  
>> +	irqflags = IRQF_SHARED;
>>  	if (pci->revision != 0x50)
>>  		return -ENODEV;
>>  
>> @@ -150,6 +158,83 @@ static int snd_acp5x_probe(struct pci_dev *pci,
>>  	if (ret)
>>  		goto release_regions;
>>  
>> +	val = acp_readl(adata->acp5x_base + ACP_PIN_CONFIG);
>> +	switch (val) {
>> +	case I2S_MODE:
>> +		adata->res = devm_kzalloc(&pci->dev,
>> +					  sizeof(struct resource) * 4,
> 
> what is this 4 value?
We are creating 4 resources using MFD framework.
Will use macro instead of hard-coded value.
> 
>> +					  GFP_KERNEL);
>> +		if (!adata->res) {
>> +			ret = -ENOMEM;
>> +			goto de_init;
>> +		}
>> +
>> +		adata->res[0].name = "acp5x_i2s_iomem";
>> +		adata->res[0].flags = IORESOURCE_MEM;
>> +		adata->res[0].start = addr;
>> +		adata->res[0].end = addr + (ACP5x_REG_END - ACP5x_REG_START);
>> +
>> +		adata->res[1].name = "acp5x_i2s_sp";
>> +		adata->res[1].flags = IORESOURCE_MEM;
>> +		adata->res[1].start = addr + ACP5x_I2STDM_REG_START;
>> +		adata->res[1].end = addr + ACP5x_I2STDM_REG_END;
>> +
>> +		adata->res[2].name = "acp5x_i2s_hs";
>> +		adata->res[2].flags = IORESOURCE_MEM;
>> +		adata->res[2].start = addr + ACP5x_HS_TDM_REG_START;
>> +		adata->res[2].end = addr + ACP5x_HS_TDM_REG_END;
>> +
>> +		adata->res[3].name = "acp5x_i2s_irq";
>> +		adata->res[3].flags = IORESOURCE_IRQ;
>> +		adata->res[3].start = pci->irq;
>> +		adata->res[3].end = adata->res[3].start;
>> +
>> +		adata->acp5x_audio_mode = ACP5x_I2S_MODE;
>> +
>> +		memset(&pdevinfo, 0, sizeof(pdevinfo));
>> +		pdevinfo[0].name = "acp5x_i2s_dma";
>> +		pdevinfo[0].id = 0;
>> +		pdevinfo[0].parent = &pci->dev;
>> +		pdevinfo[0].num_res = 4;
>> +		pdevinfo[0].res = &adata->res[0];
>> +		pdevinfo[0].data = &irqflags;
>> +		pdevinfo[0].size_data = sizeof(irqflags);
>> +
>> +		pdevinfo[1].name = "acp5x_i2s_playcap";
>> +		pdevinfo[1].id = 0;
>> +		pdevinfo[1].parent = &pci->dev;
>> +		pdevinfo[1].num_res = 1;
>> +		pdevinfo[1].res = &adata->res[1];
>> +
>> +		pdevinfo[2].name = "acp5x_i2s_playcap";
>> +		pdevinfo[2].id = 1;
>> +		pdevinfo[2].parent = &pci->dev;
>> +		pdevinfo[2].num_res = 1;
>> +		pdevinfo[2].res = &adata->res[2];
>> +
>> +		for (i = 0; i < ACP5x_DEVS; i++) {
>> +			adata->pdev[i] =
>> +				platform_device_register_full(&pdevinfo[i]);
>> +			if (IS_ERR(adata->pdev[i])) {
>> +				dev_err(&pci->dev, "cannot register %s device\n",
>> +					pdevinfo[i].name);
>> +				ret = PTR_ERR(adata->pdev[i]);
>> +				goto unregister_devs;
>> +			}
>> +		}
>> +		break;
>> +	default:
>> +		dev_info(&pci->dev, "ACP audio mode : %d\n", val);
>> +	}
>> +	return 0;
>> +
>> +unregister_devs:
>> +	if (val == I2S_MODE)
> 
> nit-pick: you can't reach this point outside of the I2S_MODE, so this test is not useful
> 
> 
>> +		for (i = 0; i < ACP5x_DEVS; i++)
>> +			platform_device_unregister(adata->pdev[i]);
> 
> only unregister what you registered?

Yes, We are unregistering devices which got registered.
We can refactor the code by moving code to switch case it self rather
than handling by declaring the label for it.

Will fix it and post the new version.

> 
> for (--i; i > 0; i--)
> 
>> +de_init:
>> +	if (acp5x_deinit(adata->acp5x_base))
>> +		dev_err(&pci->dev, "ACP de-init failed\n");
>>  release_regions:
>>  	pci_release_regions(pci);
>>  disable_pci:
>> @@ -161,9 +246,13 @@ static int snd_acp5x_probe(struct pci_dev *pci,
>>  static void snd_acp5x_remove(struct pci_dev *pci)
>>  {
>>  	struct acp5x_dev_data *adata;
>> -	int ret;
>> +	int i, ret;
>>  
>>  	adata = pci_get_drvdata(pci);
>> +	if (adata->acp5x_audio_mode == ACP5x_I2S_MODE) {
>> +		for (i = 0; i < ACP5x_DEVS; i++)
>> +			platform_device_unregister(adata->pdev[i]);
>> +	}
>>  	ret = acp5x_deinit(adata->acp5x_base);
>>  	if (ret)
>>  		dev_err(&pci->dev, "ACP de-init failed\n");
>>
diff mbox series

Patch

diff --git a/sound/soc/amd/vangogh/acp5x.h b/sound/soc/amd/vangogh/acp5x.h
index 708586109315..bbf29fd2b12f 100644
--- a/sound/soc/amd/vangogh/acp5x.h
+++ b/sound/soc/amd/vangogh/acp5x.h
@@ -22,6 +22,16 @@ 
 #define ACP_ERR_INTR_MASK	0x20000000
 #define ACP_EXT_INTR_STAT_CLEAR_MASK 0xFFFFFFFF
 
+#define ACP5x_DEVS 0x03
+#define	ACP5x_REG_START	0x1240000
+#define	ACP5x_REG_END	0x1250200
+#define ACP5x_I2STDM_REG_START	0x1242400
+#define ACP5x_I2STDM_REG_END	0x1242410
+#define ACP5x_HS_TDM_REG_START	0x1242814
+#define ACP5x_HS_TDM_REG_END	0x1242824
+#define I2S_MODE 0x00
+#define ACP5x_I2S_MODE 0x00
+
 /* common header file uses exact offset rather than relative
  * offset which requires substraction logic from base_addr
  * for accessing ACP5x MMIO space registers
diff --git a/sound/soc/amd/vangogh/pci-acp5x.c b/sound/soc/amd/vangogh/pci-acp5x.c
index 523b962fe35e..3cc15a15b745 100644
--- a/sound/soc/amd/vangogh/pci-acp5x.c
+++ b/sound/soc/amd/vangogh/pci-acp5x.c
@@ -8,11 +8,16 @@ 
 #include <linux/module.h>
 #include <linux/io.h>
 #include <linux/delay.h>
+#include <linux/platform_device.h>
+#include <linux/interrupt.h>
 
 #include "acp5x.h"
 
 struct acp5x_dev_data {
 	void __iomem *acp5x_base;
+	bool acp5x_audio_mode;
+	struct resource *res;
+	struct platform_device *pdev[3];
 };
 
 static int acp5x_power_on(void __iomem *acp5x_base)
@@ -114,9 +119,12 @@  static int snd_acp5x_probe(struct pci_dev *pci,
 			   const struct pci_device_id *pci_id)
 {
 	struct acp5x_dev_data *adata;
-	int ret;
-	u32 addr;
+	struct platform_device_info pdevinfo[3];
+	unsigned int irqflags;
+	int ret, i;
+	u32 addr, val;
 
+	irqflags = IRQF_SHARED;
 	if (pci->revision != 0x50)
 		return -ENODEV;
 
@@ -150,6 +158,83 @@  static int snd_acp5x_probe(struct pci_dev *pci,
 	if (ret)
 		goto release_regions;
 
+	val = acp_readl(adata->acp5x_base + ACP_PIN_CONFIG);
+	switch (val) {
+	case I2S_MODE:
+		adata->res = devm_kzalloc(&pci->dev,
+					  sizeof(struct resource) * 4,
+					  GFP_KERNEL);
+		if (!adata->res) {
+			ret = -ENOMEM;
+			goto de_init;
+		}
+
+		adata->res[0].name = "acp5x_i2s_iomem";
+		adata->res[0].flags = IORESOURCE_MEM;
+		adata->res[0].start = addr;
+		adata->res[0].end = addr + (ACP5x_REG_END - ACP5x_REG_START);
+
+		adata->res[1].name = "acp5x_i2s_sp";
+		adata->res[1].flags = IORESOURCE_MEM;
+		adata->res[1].start = addr + ACP5x_I2STDM_REG_START;
+		adata->res[1].end = addr + ACP5x_I2STDM_REG_END;
+
+		adata->res[2].name = "acp5x_i2s_hs";
+		adata->res[2].flags = IORESOURCE_MEM;
+		adata->res[2].start = addr + ACP5x_HS_TDM_REG_START;
+		adata->res[2].end = addr + ACP5x_HS_TDM_REG_END;
+
+		adata->res[3].name = "acp5x_i2s_irq";
+		adata->res[3].flags = IORESOURCE_IRQ;
+		adata->res[3].start = pci->irq;
+		adata->res[3].end = adata->res[3].start;
+
+		adata->acp5x_audio_mode = ACP5x_I2S_MODE;
+
+		memset(&pdevinfo, 0, sizeof(pdevinfo));
+		pdevinfo[0].name = "acp5x_i2s_dma";
+		pdevinfo[0].id = 0;
+		pdevinfo[0].parent = &pci->dev;
+		pdevinfo[0].num_res = 4;
+		pdevinfo[0].res = &adata->res[0];
+		pdevinfo[0].data = &irqflags;
+		pdevinfo[0].size_data = sizeof(irqflags);
+
+		pdevinfo[1].name = "acp5x_i2s_playcap";
+		pdevinfo[1].id = 0;
+		pdevinfo[1].parent = &pci->dev;
+		pdevinfo[1].num_res = 1;
+		pdevinfo[1].res = &adata->res[1];
+
+		pdevinfo[2].name = "acp5x_i2s_playcap";
+		pdevinfo[2].id = 1;
+		pdevinfo[2].parent = &pci->dev;
+		pdevinfo[2].num_res = 1;
+		pdevinfo[2].res = &adata->res[2];
+
+		for (i = 0; i < ACP5x_DEVS; i++) {
+			adata->pdev[i] =
+				platform_device_register_full(&pdevinfo[i]);
+			if (IS_ERR(adata->pdev[i])) {
+				dev_err(&pci->dev, "cannot register %s device\n",
+					pdevinfo[i].name);
+				ret = PTR_ERR(adata->pdev[i]);
+				goto unregister_devs;
+			}
+		}
+		break;
+	default:
+		dev_info(&pci->dev, "ACP audio mode : %d\n", val);
+	}
+	return 0;
+
+unregister_devs:
+	if (val == I2S_MODE)
+		for (i = 0; i < ACP5x_DEVS; i++)
+			platform_device_unregister(adata->pdev[i]);
+de_init:
+	if (acp5x_deinit(adata->acp5x_base))
+		dev_err(&pci->dev, "ACP de-init failed\n");
 release_regions:
 	pci_release_regions(pci);
 disable_pci:
@@ -161,9 +246,13 @@  static int snd_acp5x_probe(struct pci_dev *pci,
 static void snd_acp5x_remove(struct pci_dev *pci)
 {
 	struct acp5x_dev_data *adata;
-	int ret;
+	int i, ret;
 
 	adata = pci_get_drvdata(pci);
+	if (adata->acp5x_audio_mode == ACP5x_I2S_MODE) {
+		for (i = 0; i < ACP5x_DEVS; i++)
+			platform_device_unregister(adata->pdev[i]);
+	}
 	ret = acp5x_deinit(adata->acp5x_base);
 	if (ret)
 		dev_err(&pci->dev, "ACP de-init failed\n");