uio: pruss: fix missing iounmap() in pruss_probe()
[linux-2.6-block.git] / drivers / uio / uio_pruss.c
CommitLineData
2aec85b2 1// SPDX-License-Identifier: GPL-2.0-only
f1a304e7
PG
2/*
3 * Programmable Real-Time Unit Sub System (PRUSS) UIO driver (uio_pruss)
4 *
5 * This driver exports PRUSS host event out interrupts and PRUSS, L3 RAM,
6 * and DDR RAM to user space for applications interacting with PRUSS firmware
7 *
8 * Copyright (C) 2010-11 Texas Instruments Incorporated - http://www.ti.com/
f1a304e7
PG
9 */
10#include <linux/device.h>
11#include <linux/module.h>
12#include <linux/moduleparam.h>
13#include <linux/platform_device.h>
14#include <linux/uio_driver.h>
15#include <linux/platform_data/uio_pruss.h>
16#include <linux/io.h>
17#include <linux/clk.h>
18#include <linux/dma-mapping.h>
87672676 19#include <linux/sizes.h>
f1a304e7 20#include <linux/slab.h>
2eb2478d 21#include <linux/genalloc.h>
f1a304e7
PG
22
23#define DRV_NAME "pruss_uio"
24#define DRV_VERSION "1.0"
25
26static int sram_pool_sz = SZ_16K;
27module_param(sram_pool_sz, int, 0);
28MODULE_PARM_DESC(sram_pool_sz, "sram pool size to allocate ");
29
30static int extram_pool_sz = SZ_256K;
31module_param(extram_pool_sz, int, 0);
32MODULE_PARM_DESC(extram_pool_sz, "external ram pool size to allocate");
33
34/*
25985edc 35 * Host event IRQ numbers from PRUSS - PRUSS can generate up to 8 interrupt
f1a304e7
PG
36 * events to AINTC of ARM host processor - which can be used for IPC b/w PRUSS
37 * firmware and user space application, async notification from PRU firmware
38 * to user space application
39 * 3 PRU_EVTOUT0
40 * 4 PRU_EVTOUT1
41 * 5 PRU_EVTOUT2
42 * 6 PRU_EVTOUT3
43 * 7 PRU_EVTOUT4
44 * 8 PRU_EVTOUT5
45 * 9 PRU_EVTOUT6
46 * 10 PRU_EVTOUT7
47*/
48#define MAX_PRUSS_EVT 8
49
50#define PINTC_HIDISR 0x0038
51#define PINTC_HIPIR 0x0900
52#define HIPIR_NOPEND 0x80000000
53#define PINTC_HIER 0x1500
54
55struct uio_pruss_dev {
56 struct uio_info *info;
57 struct clk *pruss_clk;
58 dma_addr_t sram_paddr;
59 dma_addr_t ddr_paddr;
60 void __iomem *prussio_vaddr;
2eb2478d 61 unsigned long sram_vaddr;
f1a304e7
PG
62 void *ddr_vaddr;
63 unsigned int hostirq_start;
64 unsigned int pintc_base;
2eb2478d 65 struct gen_pool *sram_pool;
f1a304e7
PG
66};
67
68static irqreturn_t pruss_handler(int irq, struct uio_info *info)
69{
70 struct uio_pruss_dev *gdev = info->priv;
71 int intr_bit = (irq - gdev->hostirq_start + 2);
72 int val, intr_mask = (1 << intr_bit);
73 void __iomem *base = gdev->prussio_vaddr + gdev->pintc_base;
74 void __iomem *intren_reg = base + PINTC_HIER;
75 void __iomem *intrdis_reg = base + PINTC_HIDISR;
76 void __iomem *intrstat_reg = base + PINTC_HIPIR + (intr_bit << 2);
77
78 val = ioread32(intren_reg);
79 /* Is interrupt enabled and active ? */
80 if (!(val & intr_mask) && (ioread32(intrstat_reg) & HIPIR_NOPEND))
81 return IRQ_NONE;
82 /* Disable interrupt */
83 iowrite32(intr_bit, intrdis_reg);
84 return IRQ_HANDLED;
85}
86
4719ebfd 87static void pruss_cleanup(struct device *dev, struct uio_pruss_dev *gdev)
f1a304e7
PG
88{
89 int cnt;
90 struct uio_info *p = gdev->info;
91
92 for (cnt = 0; cnt < MAX_PRUSS_EVT; cnt++, p++) {
93 uio_unregister_device(p);
f1a304e7
PG
94 }
95 iounmap(gdev->prussio_vaddr);
96 if (gdev->ddr_vaddr) {
4719ebfd 97 dma_free_coherent(dev, extram_pool_sz, gdev->ddr_vaddr,
f1a304e7
PG
98 gdev->ddr_paddr);
99 }
100 if (gdev->sram_vaddr)
2eb2478d
MP
101 gen_pool_free(gdev->sram_pool,
102 gdev->sram_vaddr,
103 sram_pool_sz);
e663c5db 104 clk_disable(gdev->pruss_clk);
f1a304e7
PG
105}
106
4719ebfd 107static int pruss_probe(struct platform_device *pdev)
f1a304e7
PG
108{
109 struct uio_info *p;
110 struct uio_pruss_dev *gdev;
111 struct resource *regs_prussio;
4719ebfd 112 struct device *dev = &pdev->dev;
95883676 113 int ret, cnt, i, len;
4719ebfd 114 struct uio_pruss_pdata *pdata = dev_get_platdata(dev);
f1a304e7 115
cfd3443e 116 gdev = devm_kzalloc(dev, sizeof(struct uio_pruss_dev), GFP_KERNEL);
f1a304e7
PG
117 if (!gdev)
118 return -ENOMEM;
119
cfd3443e
AA
120 gdev->info = devm_kcalloc(dev, MAX_PRUSS_EVT, sizeof(*p), GFP_KERNEL);
121 if (!gdev->info)
122 return -ENOMEM;
4719ebfd 123
f1a304e7 124 /* Power on PRU in case its not done as part of boot-loader */
68d62119 125 gdev->pruss_clk = devm_clk_get(dev, "pruss");
f1a304e7 126 if (IS_ERR(gdev->pruss_clk)) {
4719ebfd 127 dev_err(dev, "Failed to get clock\n");
cfd3443e 128 return PTR_ERR(gdev->pruss_clk);
95883676
DC
129 }
130
131 ret = clk_enable(gdev->pruss_clk);
132 if (ret) {
133 dev_err(dev, "Failed to enable clock\n");
68d62119 134 return ret;
f1a304e7
PG
135 }
136
4719ebfd 137 regs_prussio = platform_get_resource(pdev, IORESOURCE_MEM, 0);
f1a304e7 138 if (!regs_prussio) {
4719ebfd 139 dev_err(dev, "No PRUSS I/O resource specified\n");
95883676
DC
140 ret = -EIO;
141 goto err_clk_disable;
f1a304e7
PG
142 }
143
144 if (!regs_prussio->start) {
4719ebfd 145 dev_err(dev, "Invalid memory resource\n");
95883676
DC
146 ret = -EIO;
147 goto err_clk_disable;
f1a304e7
PG
148 }
149
2eb2478d
MP
150 if (pdata->sram_pool) {
151 gdev->sram_pool = pdata->sram_pool;
152 gdev->sram_vaddr =
288342e9
NC
153 (unsigned long)gen_pool_dma_alloc(gdev->sram_pool,
154 sram_pool_sz, &gdev->sram_paddr);
2eb2478d 155 if (!gdev->sram_vaddr) {
4719ebfd 156 dev_err(dev, "Could not allocate SRAM pool\n");
95883676
DC
157 ret = -ENOMEM;
158 goto err_clk_disable;
2eb2478d 159 }
f1a304e7
PG
160 }
161
4719ebfd 162 gdev->ddr_vaddr = dma_alloc_coherent(dev, extram_pool_sz,
f1a304e7
PG
163 &(gdev->ddr_paddr), GFP_KERNEL | GFP_DMA);
164 if (!gdev->ddr_vaddr) {
4719ebfd 165 dev_err(dev, "Could not allocate external memory\n");
95883676
DC
166 ret = -ENOMEM;
167 goto err_free_sram;
f1a304e7
PG
168 }
169
170 len = resource_size(regs_prussio);
171 gdev->prussio_vaddr = ioremap(regs_prussio->start, len);
172 if (!gdev->prussio_vaddr) {
4719ebfd 173 dev_err(dev, "Can't remap PRUSS I/O address range\n");
95883676
DC
174 ret = -ENOMEM;
175 goto err_free_ddr_vaddr;
f1a304e7
PG
176 }
177
2fd84b9b
ZS
178 ret = platform_get_irq(pdev, 0);
179 if (ret < 0)
979ca1ca 180 goto err_unmap;
2fd84b9b
ZS
181
182 gdev->hostirq_start = ret;
f1a304e7 183 gdev->pintc_base = pdata->pintc_base;
f1a304e7
PG
184
185 for (cnt = 0, p = gdev->info; cnt < MAX_PRUSS_EVT; cnt++, p++) {
186 p->mem[0].addr = regs_prussio->start;
187 p->mem[0].size = resource_size(regs_prussio);
188 p->mem[0].memtype = UIO_MEM_PHYS;
189
190 p->mem[1].addr = gdev->sram_paddr;
191 p->mem[1].size = sram_pool_sz;
192 p->mem[1].memtype = UIO_MEM_PHYS;
193
194 p->mem[2].addr = gdev->ddr_paddr;
195 p->mem[2].size = extram_pool_sz;
196 p->mem[2].memtype = UIO_MEM_PHYS;
197
cfd3443e 198 p->name = devm_kasprintf(dev, GFP_KERNEL, "pruss_evt%d", cnt);
f1a304e7
PG
199 p->version = DRV_VERSION;
200
201 /* Register PRUSS IRQ lines */
202 p->irq = gdev->hostirq_start + cnt;
203 p->handler = pruss_handler;
204 p->priv = gdev;
205
4719ebfd 206 ret = uio_register_device(dev, p);
cfd3443e 207 if (ret < 0)
95883676 208 goto err_unloop;
f1a304e7
PG
209 }
210
4719ebfd 211 platform_set_drvdata(pdev, gdev);
f1a304e7
PG
212 return 0;
213
95883676
DC
214err_unloop:
215 for (i = 0, p = gdev->info; i < cnt; i++, p++) {
216 uio_unregister_device(p);
95883676 217 }
979ca1ca 218err_unmap:
95883676
DC
219 iounmap(gdev->prussio_vaddr);
220err_free_ddr_vaddr:
221 dma_free_coherent(dev, extram_pool_sz, gdev->ddr_vaddr,
222 gdev->ddr_paddr);
223err_free_sram:
224 if (pdata->sram_pool)
225 gen_pool_free(gdev->sram_pool, gdev->sram_vaddr, sram_pool_sz);
226err_clk_disable:
227 clk_disable(gdev->pruss_clk);
95883676 228
f1a304e7
PG
229 return ret;
230}
231
9b96c312 232static int pruss_remove(struct platform_device *dev)
f1a304e7
PG
233{
234 struct uio_pruss_dev *gdev = platform_get_drvdata(dev);
235
4719ebfd 236 pruss_cleanup(&dev->dev, gdev);
f1a304e7
PG
237 return 0;
238}
239
240static struct platform_driver pruss_driver = {
241 .probe = pruss_probe,
5a59509b 242 .remove = pruss_remove,
f1a304e7
PG
243 .driver = {
244 .name = DRV_NAME,
f1a304e7
PG
245 },
246};
247
11e3123d 248module_platform_driver(pruss_driver);
f1a304e7
PG
249
250MODULE_LICENSE("GPL v2");
251MODULE_VERSION(DRV_VERSION);
252MODULE_AUTHOR("Amit Chatterjee <amit.chatterjee@ti.com>");
253MODULE_AUTHOR("Pratheesh Gangadhar <pratheesh@ti.com>");