| Message ID | 20190529090848.34350-8-yibin.gong@nxp.com (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | add edma2 for i.mx7ulp | expand |
On 29-05-19, 17:08, yibin.gong@nxp.com wrote: > From: Robin Gong <yibin.gong@nxp.com> > > Add edma2 for i.mx7ulp by version v3, since v2 has already Why leading spaces at start of line? > been used by mcf-edma. > The big changes based on v1 are belows: > 1. only one dmamux. > 2. another clock dma_clk except dmamux clk. > 3. 16 independent interrupts instead of only one interrupt for > all channels. > > Signed-off-by: Robin Gong <yibin.gong@nxp.com> > --- > drivers/dma/fsl-edma-common.c | 18 +++++++++++- > drivers/dma/fsl-edma-common.h | 3 ++ > drivers/dma/fsl-edma.c | 67 +++++++++++++++++++++++++++++++++++++++++++ > 3 files changed, 87 insertions(+), 1 deletion(-) > > diff --git a/drivers/dma/fsl-edma-common.c b/drivers/dma/fsl-edma-common.c > index 45d70d3..0d9915c 100644 > --- a/drivers/dma/fsl-edma-common.c > +++ b/drivers/dma/fsl-edma-common.c > @@ -90,6 +90,19 @@ static void mux_configure8(struct fsl_edma_chan *fsl_chan, void __iomem *addr, > iowrite8(val8, addr + off); > } > > +void mux_configure32(struct fsl_edma_chan *fsl_chan, void __iomem *addr, > + u32 off, u32 slot, bool enable) > +{ > + u32 val; > + > + if (enable) > + val = EDMAMUX_CHCFG_ENBL << 24 | slot; > + else > + val = EDMAMUX_CHCFG_DIS; > + > + iowrite32(val, addr + off * 4); > +} > + > void fsl_edma_chan_mux(struct fsl_edma_chan *fsl_chan, > unsigned int slot, bool enable) > { > @@ -102,7 +115,10 @@ void fsl_edma_chan_mux(struct fsl_edma_chan *fsl_chan, > muxaddr = fsl_chan->edma->muxbase[ch / chans_per_mux]; > slot = EDMAMUX_CHCFG_SOURCE(slot); > > - mux_configure8(fsl_chan, muxaddr, ch_off, slot, enable); > + if (fsl_chan->edma->version == v3) > + mux_configure32(fsl_chan, muxaddr, ch_off, slot, enable); > + else > + mux_configure8(fsl_chan, muxaddr, ch_off, slot, enable); > } > EXPORT_SYMBOL_GPL(fsl_edma_chan_mux); > > diff --git a/drivers/dma/fsl-edma-common.h b/drivers/dma/fsl-edma-common.h > index 014ab74..07482d2 100644 > --- a/drivers/dma/fsl-edma-common.h > +++ b/drivers/dma/fsl-edma-common.h > @@ -125,6 +125,7 @@ struct fsl_edma_chan { > dma_addr_t dma_dev_addr; > u32 dma_dev_size; > enum dma_data_direction dma_dir; > + char chan_name[16]; > }; > > struct fsl_edma_desc { > @@ -139,6 +140,7 @@ struct fsl_edma_desc { > enum edma_version { > v1, /* 32ch, Vybrid, mpc57x, etc */ > v2, /* 64ch Coldfire */ > + v3, /* 32ch, i.mx7ulp */ > }; > > struct fsl_edma_drvdata { > @@ -154,6 +156,7 @@ struct fsl_edma_engine { > void __iomem *membase; > void __iomem *muxbase[DMAMUX_NR]; > struct clk *muxclk[DMAMUX_NR]; > + struct clk *dmaclk; > u32 dmamux_nr; > struct mutex fsl_edma_mutex; > const struct fsl_edma_drvdata *drvdata; > diff --git a/drivers/dma/fsl-edma.c b/drivers/dma/fsl-edma.c > index cf18301..45b26d6 100644 > --- a/drivers/dma/fsl-edma.c > +++ b/drivers/dma/fsl-edma.c > @@ -165,6 +165,51 @@ fsl_edma_irq_init(struct platform_device *pdev, struct fsl_edma_engine *fsl_edma > return 0; > } > > +static int > +fsl_edma2_irq_init(struct platform_device *pdev, > + struct fsl_edma_engine *fsl_edma) > +{ > + struct device_node *np = pdev->dev.of_node; > + int i, ret, irq; > + int count = 0; Superflous initialization of count! > + > + count = of_irq_count(np); > + dev_info(&pdev->dev, "%s Found %d interrupts\r\n", __func__, count); Consider using debug level.. > + if (count <= 2) { > + dev_err(&pdev->dev, "Interrupts in DTS not correct.\n"); > + return -EINVAL; > + } > + /* > + * 16 channel independent interrupts + 1 error interrupt on i.mx7ulp. > + * 2 channel share one interrupt, for example, ch0/ch16, ch1/ch17... > + * For now, just simply request irq without IRQF_SHARED flag, since 16 > + * channels are enough on i.mx7ulp whose M4 domain own some peripherals. > + */ > + for (i = 0; i < count; i++) { > + irq = platform_get_irq(pdev, i); > + if (irq < 0) > + return -ENXIO; > + > + sprintf(fsl_edma->chans[i].chan_name, "eDMA2-CH%02d", i); > + > + /* The last IRQ is for eDMA err */ > + if (i == count - 1) > + ret = devm_request_irq(&pdev->dev, irq, > + fsl_edma_err_handler, > + 0, "eDMA2-ERR", fsl_edma); > + else > + empty line is waste here > + ret = devm_request_irq(&pdev->dev, irq, > + fsl_edma_tx_handler, 0, > + fsl_edma->chans[i].chan_name, > + fsl_edma); > + if (ret) > + return ret; > + } > + > + return 0; > +} > + > static void fsl_edma_irq_exit( > struct platform_device *pdev, struct fsl_edma_engine *fsl_edma) > { > @@ -191,8 +236,16 @@ static struct fsl_edma_drvdata vf610_data = { > .setup_irq = fsl_edma_irq_init, > }; > > +static struct fsl_edma_drvdata imx7ulp_data = { > + .version = v3, > + .dmamuxs = 1, > + .has_dmaclk = true, > + .setup_irq = fsl_edma2_irq_init, > +}; > + > static const struct of_device_id fsl_edma_dt_ids[] = { > { .compatible = "fsl,vf610-edma", .data = &vf610_data}, > + { .compatible = "fsl,imx7ulp-edma", .data = &imx7ulp_data}, > { /* sentinel */ } > }; > MODULE_DEVICE_TABLE(of, fsl_edma_dt_ids); > @@ -242,6 +295,20 @@ static int fsl_edma_probe(struct platform_device *pdev) > fsl_edma_setup_regs(fsl_edma); > regs = &fsl_edma->regs; > > + if (drvdata->has_dmaclk) { > + fsl_edma->dmaclk = devm_clk_get(&pdev->dev, "dma"); > + if (IS_ERR(fsl_edma->dmaclk)) { > + dev_err(&pdev->dev, "Missing DMA block clock.\n"); > + return PTR_ERR(fsl_edma->dmaclk); > + } > + > + ret = clk_prepare_enable(fsl_edma->dmaclk); > + if (ret) { > + dev_err(&pdev->dev, "DMA clk block failed.\n"); > + return ret; > + } > + } > + > for (i = 0; i < fsl_edma->dmamux_nr; i++) { > char clkname[32]; > > -- > 2.7.4
On 2019-06-04 at 12:37 +0000, Vinod Koul wrote: > On 29-05-19, 17:08, yibin.gong@nxp.com wrote: > > > > From: Robin Gong <yibin.gong@nxp.com> > > > > Add edma2 for i.mx7ulp by version v3, since v2 has already > Why leading spaces at start of line? Sorry for the typo, will fix in next version > > > > > been used by mcf-edma. > > The big changes based on v1 are belows: > > 1. only one dmamux. > > 2. another clock dma_clk except dmamux clk. > > 3. 16 independent interrupts instead of only one interrupt for > > all channels. > > > > Signed-off-by: Robin Gong <yibin.gong@nxp.com> > > --- > > drivers/dma/fsl-edma-common.c | 18 +++++++++++- > > drivers/dma/fsl-edma-common.h | 3 ++ > > drivers/dma/fsl-edma.c | 67 > > +++++++++++++++++++++++++++++++++++++++++++ > > 3 files changed, 87 insertions(+), 1 deletion(-) > > > > diff --git a/drivers/dma/fsl-edma-common.c b/drivers/dma/fsl-edma- > > common.c > > index 45d70d3..0d9915c 100644 > > --- a/drivers/dma/fsl-edma-common.c > > +++ b/drivers/dma/fsl-edma-common.c > > @@ -90,6 +90,19 @@ static void mux_configure8(struct fsl_edma_chan > > *fsl_chan, void __iomem *addr, > > iowrite8(val8, addr + off); > > } > > > > +void mux_configure32(struct fsl_edma_chan *fsl_chan, void __iomem > > *addr, > > + u32 off, u32 slot, bool enable) > > +{ > > + u32 val; > > + > > + if (enable) > > + val = EDMAMUX_CHCFG_ENBL << 24 | slot; > > + else > > + val = EDMAMUX_CHCFG_DIS; > > + > > + iowrite32(val, addr + off * 4); > > +} > > + > > void fsl_edma_chan_mux(struct fsl_edma_chan *fsl_chan, > > unsigned int slot, bool enable) > > { > > @@ -102,7 +115,10 @@ void fsl_edma_chan_mux(struct fsl_edma_chan > > *fsl_chan, > > muxaddr = fsl_chan->edma->muxbase[ch / chans_per_mux]; > > slot = EDMAMUX_CHCFG_SOURCE(slot); > > > > - mux_configure8(fsl_chan, muxaddr, ch_off, slot, enable); > > + if (fsl_chan->edma->version == v3) > > + mux_configure32(fsl_chan, muxaddr, ch_off, slot, > > enable); > > + else > > + mux_configure8(fsl_chan, muxaddr, ch_off, slot, > > enable); > > } > > EXPORT_SYMBOL_GPL(fsl_edma_chan_mux); > > > > diff --git a/drivers/dma/fsl-edma-common.h b/drivers/dma/fsl-edma- > > common.h > > index 014ab74..07482d2 100644 > > --- a/drivers/dma/fsl-edma-common.h > > +++ b/drivers/dma/fsl-edma-common.h > > @@ -125,6 +125,7 @@ struct fsl_edma_chan { > > dma_addr_t dma_dev_addr; > > u32 dma_dev_size; > > enum dma_data_direction dma_dir; > > + char chan_name[16]; > > }; > > > > struct fsl_edma_desc { > > @@ -139,6 +140,7 @@ struct fsl_edma_desc { > > enum edma_version { > > v1, /* 32ch, Vybrid, mpc57x, etc */ > > v2, /* 64ch Coldfire */ > > + v3, /* 32ch, i.mx7ulp */ > > }; > > > > struct fsl_edma_drvdata { > > @@ -154,6 +156,7 @@ struct fsl_edma_engine { > > void __iomem *membase; > > void __iomem *muxbase[DMAMUX_NR]; > > struct clk *muxclk[DMAMUX_NR]; > > + struct clk *dmaclk; > > u32 dmamux_nr; > > struct mutex fsl_edma_mutex; > > const struct fsl_edma_drvdata *drvdata; > > diff --git a/drivers/dma/fsl-edma.c b/drivers/dma/fsl-edma.c > > index cf18301..45b26d6 100644 > > --- a/drivers/dma/fsl-edma.c > > +++ b/drivers/dma/fsl-edma.c > > @@ -165,6 +165,51 @@ fsl_edma_irq_init(struct platform_device > > *pdev, struct fsl_edma_engine *fsl_edma > > return 0; > > } > > > > +static int > > +fsl_edma2_irq_init(struct platform_device *pdev, > > + struct fsl_edma_engine *fsl_edma) > > +{ > > + struct device_node *np = pdev->dev.of_node; > > + int i, ret, irq; > > + int count = 0; > Superflous initialization of count! Would fix it in v4. > > > > > + > > + count = of_irq_count(np); > > + dev_info(&pdev->dev, "%s Found %d interrupts\r\n", > > __func__, count); > Consider using debug level.. Would downgrade print level in v4. > > > > > + if (count <= 2) { > > + dev_err(&pdev->dev, "Interrupts in DTS not > > correct.\n"); > > + return -EINVAL; > > + } > > + /* > > + * 16 channel independent interrupts + 1 error interrupt > > on i.mx7ulp. > > + * 2 channel share one interrupt, for example, ch0/ch16, > > ch1/ch17... > > + * For now, just simply request irq without IRQF_SHARED > > flag, since 16 > > + * channels are enough on i.mx7ulp whose M4 domain own > > some peripherals. > > + */ > > + for (i = 0; i < count; i++) { > > + irq = platform_get_irq(pdev, i); > > + if (irq < 0) > > + return -ENXIO; > > + > > + sprintf(fsl_edma->chans[i].chan_name, "eDMA2- > > CH%02d", i); > > + > > + /* The last IRQ is for eDMA err */ > > + if (i == count - 1) > > + ret = devm_request_irq(&pdev->dev, irq, > > + fsl_edma_err_handl > > er, > > + 0, "eDMA2-ERR", > > fsl_edma); > > + else > > + > empty line is waste here > > > > > + ret = devm_request_irq(&pdev->dev, irq, > > + fsl_edma_tx_handle > > r, 0, > > + fsl_edma- > > >chans[i].chan_name, > > + fsl_edma); > > + if (ret) > > + return ret; > > + } > > + > > + return 0; > > +} > > + > > static void fsl_edma_irq_exit( > > struct platform_device *pdev, struct > > fsl_edma_engine *fsl_edma) > > { > > @@ -191,8 +236,16 @@ static struct fsl_edma_drvdata vf610_data = { > > .setup_irq = fsl_edma_irq_init, > > }; > > > > +static struct fsl_edma_drvdata imx7ulp_data = { > > + .version = v3, > > + .dmamuxs = 1, > > + .has_dmaclk = true, > > + .setup_irq = fsl_edma2_irq_init, > > +}; > > + > > static const struct of_device_id fsl_edma_dt_ids[] = { > > { .compatible = "fsl,vf610-edma", .data = &vf610_data}, > > + { .compatible = "fsl,imx7ulp-edma", .data = > > &imx7ulp_data}, > > { /* sentinel */ } > > }; > > MODULE_DEVICE_TABLE(of, fsl_edma_dt_ids); > > @@ -242,6 +295,20 @@ static int fsl_edma_probe(struct > > platform_device *pdev) > > fsl_edma_setup_regs(fsl_edma); > > regs = &fsl_edma->regs; > > > > + if (drvdata->has_dmaclk) { > > + fsl_edma->dmaclk = devm_clk_get(&pdev->dev, > > "dma"); > > + if (IS_ERR(fsl_edma->dmaclk)) { > > + dev_err(&pdev->dev, "Missing DMA block > > clock.\n"); > > + return PTR_ERR(fsl_edma->dmaclk); > > + } > > + > > + ret = clk_prepare_enable(fsl_edma->dmaclk); > > + if (ret) { > > + dev_err(&pdev->dev, "DMA clk block > > failed.\n"); > > + return ret; > > + } > > + } > > + > > for (i = 0; i < fsl_edma->dmamux_nr; i++) { > > char clkname[32]; > > > > -- > > 2.7.4
diff --git a/drivers/dma/fsl-edma-common.c b/drivers/dma/fsl-edma-common.c index 45d70d3..0d9915c 100644 --- a/drivers/dma/fsl-edma-common.c +++ b/drivers/dma/fsl-edma-common.c @@ -90,6 +90,19 @@ static void mux_configure8(struct fsl_edma_chan *fsl_chan, void __iomem *addr, iowrite8(val8, addr + off); } +void mux_configure32(struct fsl_edma_chan *fsl_chan, void __iomem *addr, + u32 off, u32 slot, bool enable) +{ + u32 val; + + if (enable) + val = EDMAMUX_CHCFG_ENBL << 24 | slot; + else + val = EDMAMUX_CHCFG_DIS; + + iowrite32(val, addr + off * 4); +} + void fsl_edma_chan_mux(struct fsl_edma_chan *fsl_chan, unsigned int slot, bool enable) { @@ -102,7 +115,10 @@ void fsl_edma_chan_mux(struct fsl_edma_chan *fsl_chan, muxaddr = fsl_chan->edma->muxbase[ch / chans_per_mux]; slot = EDMAMUX_CHCFG_SOURCE(slot); - mux_configure8(fsl_chan, muxaddr, ch_off, slot, enable); + if (fsl_chan->edma->version == v3) + mux_configure32(fsl_chan, muxaddr, ch_off, slot, enable); + else + mux_configure8(fsl_chan, muxaddr, ch_off, slot, enable); } EXPORT_SYMBOL_GPL(fsl_edma_chan_mux); diff --git a/drivers/dma/fsl-edma-common.h b/drivers/dma/fsl-edma-common.h index 014ab74..07482d2 100644 --- a/drivers/dma/fsl-edma-common.h +++ b/drivers/dma/fsl-edma-common.h @@ -125,6 +125,7 @@ struct fsl_edma_chan { dma_addr_t dma_dev_addr; u32 dma_dev_size; enum dma_data_direction dma_dir; + char chan_name[16]; }; struct fsl_edma_desc { @@ -139,6 +140,7 @@ struct fsl_edma_desc { enum edma_version { v1, /* 32ch, Vybrid, mpc57x, etc */ v2, /* 64ch Coldfire */ + v3, /* 32ch, i.mx7ulp */ }; struct fsl_edma_drvdata { @@ -154,6 +156,7 @@ struct fsl_edma_engine { void __iomem *membase; void __iomem *muxbase[DMAMUX_NR]; struct clk *muxclk[DMAMUX_NR]; + struct clk *dmaclk; u32 dmamux_nr; struct mutex fsl_edma_mutex; const struct fsl_edma_drvdata *drvdata; diff --git a/drivers/dma/fsl-edma.c b/drivers/dma/fsl-edma.c index cf18301..45b26d6 100644 --- a/drivers/dma/fsl-edma.c +++ b/drivers/dma/fsl-edma.c @@ -165,6 +165,51 @@ fsl_edma_irq_init(struct platform_device *pdev, struct fsl_edma_engine *fsl_edma return 0; } +static int +fsl_edma2_irq_init(struct platform_device *pdev, + struct fsl_edma_engine *fsl_edma) +{ + struct device_node *np = pdev->dev.of_node; + int i, ret, irq; + int count = 0; + + count = of_irq_count(np); + dev_info(&pdev->dev, "%s Found %d interrupts\r\n", __func__, count); + if (count <= 2) { + dev_err(&pdev->dev, "Interrupts in DTS not correct.\n"); + return -EINVAL; + } + /* + * 16 channel independent interrupts + 1 error interrupt on i.mx7ulp. + * 2 channel share one interrupt, for example, ch0/ch16, ch1/ch17... + * For now, just simply request irq without IRQF_SHARED flag, since 16 + * channels are enough on i.mx7ulp whose M4 domain own some peripherals. + */ + for (i = 0; i < count; i++) { + irq = platform_get_irq(pdev, i); + if (irq < 0) + return -ENXIO; + + sprintf(fsl_edma->chans[i].chan_name, "eDMA2-CH%02d", i); + + /* The last IRQ is for eDMA err */ + if (i == count - 1) + ret = devm_request_irq(&pdev->dev, irq, + fsl_edma_err_handler, + 0, "eDMA2-ERR", fsl_edma); + else + + ret = devm_request_irq(&pdev->dev, irq, + fsl_edma_tx_handler, 0, + fsl_edma->chans[i].chan_name, + fsl_edma); + if (ret) + return ret; + } + + return 0; +} + static void fsl_edma_irq_exit( struct platform_device *pdev, struct fsl_edma_engine *fsl_edma) { @@ -191,8 +236,16 @@ static struct fsl_edma_drvdata vf610_data = { .setup_irq = fsl_edma_irq_init, }; +static struct fsl_edma_drvdata imx7ulp_data = { + .version = v3, + .dmamuxs = 1, + .has_dmaclk = true, + .setup_irq = fsl_edma2_irq_init, +}; + static const struct of_device_id fsl_edma_dt_ids[] = { { .compatible = "fsl,vf610-edma", .data = &vf610_data}, + { .compatible = "fsl,imx7ulp-edma", .data = &imx7ulp_data}, { /* sentinel */ } }; MODULE_DEVICE_TABLE(of, fsl_edma_dt_ids); @@ -242,6 +295,20 @@ static int fsl_edma_probe(struct platform_device *pdev) fsl_edma_setup_regs(fsl_edma); regs = &fsl_edma->regs; + if (drvdata->has_dmaclk) { + fsl_edma->dmaclk = devm_clk_get(&pdev->dev, "dma"); + if (IS_ERR(fsl_edma->dmaclk)) { + dev_err(&pdev->dev, "Missing DMA block clock.\n"); + return PTR_ERR(fsl_edma->dmaclk); + } + + ret = clk_prepare_enable(fsl_edma->dmaclk); + if (ret) { + dev_err(&pdev->dev, "DMA clk block failed.\n"); + return ret; + } + } + for (i = 0; i < fsl_edma->dmamux_nr; i++) { char clkname[32];