1// SPDX-License-Identifier: GPL-2.0
2/*
3 * leon_pci_grpci1.c: GRPCI1 Host PCI driver
4 *
5 * Copyright (C) 2013 Aeroflex Gaisler AB
6 *
7 * This GRPCI1 driver does not support PCI interrupts taken from
8 * GPIO pins. Interrupt generation at PCI parity and system error
9 * detection is by default turned off since some GRPCI1 cores does
10 * not support detection. It can be turned on from the bootloader
11 * using the all_pci_errors property.
12 *
13 * Contributors: Daniel Hellstrom <daniel@gaisler.com>
14 */
15
16#include <linux/export.h>
17#include <linux/kernel.h>
18#include <linux/of.h>
19#include <linux/of_irq.h>
20#include <linux/platform_device.h>
21#include <linux/delay.h>
22#include <linux/pci.h>
23
24#include <asm/leon_pci.h>
25#include <asm/sections.h>
26#include <asm/vaddrs.h>
27#include <asm/leon.h>
28#include <asm/io.h>
29
30#include "irq.h"
31
32/* Enable/Disable Debugging Configuration Space Access */
33#undef GRPCI1_DEBUG_CFGACCESS
34
35/*
36 * GRPCI1 APB Register MAP
37 */
38struct grpci1_regs {
39 unsigned int cfg_stat; /* 0x00 Configuration / Status */
40 unsigned int bar0; /* 0x04 BAR0 (RO) */
41 unsigned int page0; /* 0x08 PAGE0 (RO) */
42 unsigned int bar1; /* 0x0C BAR1 (RO) */
43 unsigned int page1; /* 0x10 PAGE1 */
44 unsigned int iomap; /* 0x14 IO Map */
45 unsigned int stat_cmd; /* 0x18 PCI Status & Command (RO) */
46 unsigned int irq; /* 0x1C Interrupt register */
47};
48
49#define REGLOAD(a) (be32_to_cpu(__raw_readl(&(a))))
50#define REGSTORE(a, v) (__raw_writel(cpu_to_be32(v), &(a)))
51
52#define PAGE0_BTEN_BIT 0
53#define PAGE0_BTEN (1 << PAGE0_BTEN_BIT)
54
55#define CFGSTAT_HOST_BIT 13
56#define CFGSTAT_CTO_BIT 8
57#define CFGSTAT_HOST (1 << CFGSTAT_HOST_BIT)
58#define CFGSTAT_CTO (1 << CFGSTAT_CTO_BIT)
59
60#define IRQ_DPE (1 << 9)
61#define IRQ_SSE (1 << 8)
62#define IRQ_RMA (1 << 7)
63#define IRQ_RTA (1 << 6)
64#define IRQ_STA (1 << 5)
65#define IRQ_DPED (1 << 4)
66#define IRQ_INTD (1 << 3)
67#define IRQ_INTC (1 << 2)
68#define IRQ_INTB (1 << 1)
69#define IRQ_INTA (1 << 0)
70#define IRQ_DEF_ERRORS (IRQ_RMA | IRQ_RTA | IRQ_STA)
71#define IRQ_ALL_ERRORS (IRQ_DPED | IRQ_DEF_ERRORS | IRQ_SSE | IRQ_DPE)
72#define IRQ_INTX (IRQ_INTA | IRQ_INTB | IRQ_INTC | IRQ_INTD)
73#define IRQ_MASK_BIT 16
74
75#define DEF_PCI_ERRORS (PCI_STATUS_SIG_TARGET_ABORT | \
76 PCI_STATUS_REC_TARGET_ABORT | \
77 PCI_STATUS_REC_MASTER_ABORT)
78#define ALL_PCI_ERRORS (PCI_STATUS_PARITY | PCI_STATUS_DETECTED_PARITY | \
79 PCI_STATUS_SIG_SYSTEM_ERROR | DEF_PCI_ERRORS)
80
81#define TGT 256
82
83struct grpci1_priv {
84 struct leon_pci_info info; /* must be on top of this structure */
85 struct grpci1_regs __iomem *regs; /* GRPCI register map */
86 struct device *dev;
87 int pci_err_mask; /* STATUS register error mask */
88 int irq; /* LEON irqctrl GRPCI IRQ */
89 unsigned char irq_map[4]; /* GRPCI nexus PCI INTX# IRQs */
90 unsigned int irq_err; /* GRPCI nexus Virt Error IRQ */
91
92 /* AHB PCI Windows */
93 unsigned long pci_area; /* MEMORY */
94 unsigned long pci_area_end;
95 unsigned long pci_io; /* I/O */
96 unsigned long pci_conf; /* CONFIGURATION */
97 unsigned long pci_conf_end;
98 unsigned long pci_io_va;
99};
100
101static struct grpci1_priv *grpci1priv;
102
103static int grpci1_cfg_w32(struct grpci1_priv *priv, unsigned int bus,
104 unsigned int devfn, int where, u32 val);
105
106static int grpci1_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
107{
108 struct grpci1_priv *priv = dev->bus->sysdata;
109 int irq_group;
110
111 /* Use default IRQ decoding on PCI BUS0 according slot numbering */
112 irq_group = slot & 0x3;
113 pin = ((pin - 1) + irq_group) & 0x3;
114
115 return priv->irq_map[pin];
116}
117
118static int grpci1_cfg_r32(struct grpci1_priv *priv, unsigned int bus,
119 unsigned int devfn, int where, u32 *val)
120{
121 u32 *pci_conf, tmp, cfg;
122
123 if (where & 0x3)
124 return -EINVAL;
125
126 if (bus == 0) {
127 devfn += (0x8 * 6); /* start at AD16=Device0 */
128 } else if (bus == TGT) {
129 bus = 0;
130 devfn = 0; /* special case: bridge controller itself */
131 }
132
133 /* Select bus */
134 cfg = REGLOAD(priv->regs->cfg_stat);
135 REGSTORE(priv->regs->cfg_stat, (cfg & ~(0xf << 23)) | (bus << 23));
136
137 /* do read access */
138 pci_conf = (u32 *) (priv->pci_conf | (devfn << 8) | (where & 0xfc));
139 tmp = LEON3_BYPASS_LOAD_PA(pci_conf);
140
141 /* check if master abort was received */
142 if (REGLOAD(priv->regs->cfg_stat) & CFGSTAT_CTO) {
143 *val = 0xffffffff;
144 /* Clear Master abort bit in PCI cfg space (is set) */
145 tmp = REGLOAD(priv->regs->stat_cmd);
146 grpci1_cfg_w32(priv, TGT, devfn: 0, PCI_COMMAND, val: tmp);
147 } else {
148 /* Bus always little endian (unaffected by byte-swapping) */
149 *val = swab32(tmp);
150 }
151
152 return 0;
153}
154
155static int grpci1_cfg_r16(struct grpci1_priv *priv, unsigned int bus,
156 unsigned int devfn, int where, u32 *val)
157{
158 u32 v;
159 int ret;
160
161 if (where & 0x1)
162 return -EINVAL;
163 ret = grpci1_cfg_r32(priv, bus, devfn, where: where & ~0x3, val: &v);
164 *val = 0xffff & (v >> (8 * (where & 0x3)));
165 return ret;
166}
167
168static int grpci1_cfg_r8(struct grpci1_priv *priv, unsigned int bus,
169 unsigned int devfn, int where, u32 *val)
170{
171 u32 v;
172 int ret;
173
174 ret = grpci1_cfg_r32(priv, bus, devfn, where: where & ~0x3, val: &v);
175 *val = 0xff & (v >> (8 * (where & 3)));
176
177 return ret;
178}
179
180static int grpci1_cfg_w32(struct grpci1_priv *priv, unsigned int bus,
181 unsigned int devfn, int where, u32 val)
182{
183 unsigned int *pci_conf;
184 u32 cfg;
185
186 if (where & 0x3)
187 return -EINVAL;
188
189 if (bus == 0) {
190 devfn += (0x8 * 6); /* start at AD16=Device0 */
191 } else if (bus == TGT) {
192 bus = 0;
193 devfn = 0; /* special case: bridge controller itself */
194 }
195
196 /* Select bus */
197 cfg = REGLOAD(priv->regs->cfg_stat);
198 REGSTORE(priv->regs->cfg_stat, (cfg & ~(0xf << 23)) | (bus << 23));
199
200 pci_conf = (unsigned int *) (priv->pci_conf |
201 (devfn << 8) | (where & 0xfc));
202 LEON3_BYPASS_STORE_PA(pci_conf, swab32(val));
203
204 return 0;
205}
206
207static int grpci1_cfg_w16(struct grpci1_priv *priv, unsigned int bus,
208 unsigned int devfn, int where, u32 val)
209{
210 int ret;
211 u32 v;
212
213 if (where & 0x1)
214 return -EINVAL;
215 ret = grpci1_cfg_r32(priv, bus, devfn, where: where&~3, val: &v);
216 if (ret)
217 return ret;
218 v = (v & ~(0xffff << (8 * (where & 0x3)))) |
219 ((0xffff & val) << (8 * (where & 0x3)));
220 return grpci1_cfg_w32(priv, bus, devfn, where: where & ~0x3, val: v);
221}
222
223static int grpci1_cfg_w8(struct grpci1_priv *priv, unsigned int bus,
224 unsigned int devfn, int where, u32 val)
225{
226 int ret;
227 u32 v;
228
229 ret = grpci1_cfg_r32(priv, bus, devfn, where: where & ~0x3, val: &v);
230 if (ret != 0)
231 return ret;
232 v = (v & ~(0xff << (8 * (where & 0x3)))) |
233 ((0xff & val) << (8 * (where & 0x3)));
234 return grpci1_cfg_w32(priv, bus, devfn, where: where & ~0x3, val: v);
235}
236
237/* Read from Configuration Space. When entering here the PCI layer has taken
238 * the pci_lock spinlock and IRQ is off.
239 */
240static int grpci1_read_config(struct pci_bus *bus, unsigned int devfn,
241 int where, int size, u32 *val)
242{
243 struct grpci1_priv *priv = grpci1priv;
244 unsigned int busno = bus->number;
245 int ret;
246
247 if (PCI_SLOT(devfn) > 15 || busno > 15) {
248 *val = ~0;
249 return 0;
250 }
251
252 switch (size) {
253 case 1:
254 ret = grpci1_cfg_r8(priv, bus: busno, devfn, where, val);
255 break;
256 case 2:
257 ret = grpci1_cfg_r16(priv, bus: busno, devfn, where, val);
258 break;
259 case 4:
260 ret = grpci1_cfg_r32(priv, bus: busno, devfn, where, val);
261 break;
262 default:
263 ret = -EINVAL;
264 break;
265 }
266
267#ifdef GRPCI1_DEBUG_CFGACCESS
268 printk(KERN_INFO
269 "grpci1_read_config: [%02x:%02x:%x] ofs=%d val=%x size=%d\n",
270 busno, PCI_SLOT(devfn), PCI_FUNC(devfn), where, *val, size);
271#endif
272
273 return ret;
274}
275
276/* Write to Configuration Space. When entering here the PCI layer has taken
277 * the pci_lock spinlock and IRQ is off.
278 */
279static int grpci1_write_config(struct pci_bus *bus, unsigned int devfn,
280 int where, int size, u32 val)
281{
282 struct grpci1_priv *priv = grpci1priv;
283 unsigned int busno = bus->number;
284
285 if (PCI_SLOT(devfn) > 15 || busno > 15)
286 return 0;
287
288#ifdef GRPCI1_DEBUG_CFGACCESS
289 printk(KERN_INFO
290 "grpci1_write_config: [%02x:%02x:%x] ofs=%d size=%d val=%x\n",
291 busno, PCI_SLOT(devfn), PCI_FUNC(devfn), where, size, val);
292#endif
293
294 switch (size) {
295 default:
296 return -EINVAL;
297 case 1:
298 return grpci1_cfg_w8(priv, bus: busno, devfn, where, val);
299 case 2:
300 return grpci1_cfg_w16(priv, bus: busno, devfn, where, val);
301 case 4:
302 return grpci1_cfg_w32(priv, bus: busno, devfn, where, val);
303 }
304}
305
306static struct pci_ops grpci1_ops = {
307 .read = grpci1_read_config,
308 .write = grpci1_write_config,
309};
310
311/* GENIRQ IRQ chip implementation for grpci1 irqmode=0..2. In configuration
312 * 3 where all PCI Interrupts has a separate IRQ on the system IRQ controller
313 * this is not needed and the standard IRQ controller can be used.
314 */
315
316static void grpci1_mask_irq(struct irq_data *data)
317{
318 u32 irqidx;
319 struct grpci1_priv *priv = grpci1priv;
320
321 irqidx = (u32)data->chip_data - 1;
322 if (irqidx > 3) /* only mask PCI interrupts here */
323 return;
324 irqidx += IRQ_MASK_BIT;
325
326 REGSTORE(priv->regs->irq, REGLOAD(priv->regs->irq) & ~(1 << irqidx));
327}
328
329static void grpci1_unmask_irq(struct irq_data *data)
330{
331 u32 irqidx;
332 struct grpci1_priv *priv = grpci1priv;
333
334 irqidx = (u32)data->chip_data - 1;
335 if (irqidx > 3) /* only unmask PCI interrupts here */
336 return;
337 irqidx += IRQ_MASK_BIT;
338
339 REGSTORE(priv->regs->irq, REGLOAD(priv->regs->irq) | (1 << irqidx));
340}
341
342static unsigned int grpci1_startup_irq(struct irq_data *data)
343{
344 grpci1_unmask_irq(data);
345 return 0;
346}
347
348static void grpci1_shutdown_irq(struct irq_data *data)
349{
350 grpci1_mask_irq(data);
351}
352
353static struct irq_chip grpci1_irq = {
354 .name = "grpci1",
355 .irq_startup = grpci1_startup_irq,
356 .irq_shutdown = grpci1_shutdown_irq,
357 .irq_mask = grpci1_mask_irq,
358 .irq_unmask = grpci1_unmask_irq,
359};
360
361/* Handle one or multiple IRQs from the PCI core */
362static void grpci1_pci_flow_irq(struct irq_desc *desc)
363{
364 struct grpci1_priv *priv = grpci1priv;
365 int i, ack = 0;
366 unsigned int irqreg;
367
368 irqreg = REGLOAD(priv->regs->irq);
369 irqreg = (irqreg >> IRQ_MASK_BIT) & irqreg;
370
371 /* Error Interrupt? */
372 if (irqreg & IRQ_ALL_ERRORS) {
373 generic_handle_irq(irq: priv->irq_err);
374 ack = 1;
375 }
376
377 /* PCI Interrupt? */
378 if (irqreg & IRQ_INTX) {
379 /* Call respective PCI Interrupt handler */
380 for (i = 0; i < 4; i++) {
381 if (irqreg & (1 << i))
382 generic_handle_irq(irq: priv->irq_map[i]);
383 }
384 ack = 1;
385 }
386
387 /*
388 * Call "first level" IRQ chip end-of-irq handler. It will ACK LEON IRQ
389 * Controller, this must be done after IRQ sources have been handled to
390 * avoid double IRQ generation
391 */
392 if (ack)
393 desc->irq_data.chip->irq_eoi(&desc->irq_data);
394}
395
396/* Create a virtual IRQ */
397static unsigned int grpci1_build_device_irq(unsigned int irq)
398{
399 unsigned int virq = 0, pil;
400
401 pil = 1 << 8;
402 virq = irq_alloc(real_irq: irq, pil);
403 if (virq == 0)
404 goto out;
405
406 irq_set_chip_and_handler_name(irq: virq, chip: &grpci1_irq, handle: handle_simple_irq,
407 name: "pcilvl");
408 irq_set_chip_data(irq: virq, data: (void *)irq);
409
410out:
411 return virq;
412}
413
414/*
415 * Initialize mappings AMBA<->PCI, clear IRQ state, setup PCI interface
416 *
417 * Target BARs:
418 * BAR0: unused in this implementation
419 * BAR1: peripheral DMA to host's memory (size at least 256MByte)
420 * BAR2..BAR5: not implemented in hardware
421 */
422static void grpci1_hw_init(struct grpci1_priv *priv)
423{
424 u32 ahbadr, bar_sz, data, pciadr;
425 struct grpci1_regs __iomem *regs = priv->regs;
426
427 /* set 1:1 mapping between AHB -> PCI memory space */
428 REGSTORE(regs->cfg_stat, priv->pci_area & 0xf0000000);
429
430 /* map PCI accesses to target BAR1 to Linux kernel memory 1:1 */
431 ahbadr = 0xf0000000 & (u32)__pa(PAGE_ALIGN((unsigned long) &_end));
432 REGSTORE(regs->page1, ahbadr);
433
434 /* translate I/O accesses to 0, I/O Space always @ PCI low 64Kbytes */
435 REGSTORE(regs->iomap, REGLOAD(regs->iomap) & 0x0000ffff);
436
437 /* disable and clear pending interrupts */
438 REGSTORE(regs->irq, 0);
439
440 /* Setup BAR0 outside access range so that it does not conflict with
441 * peripheral DMA. There is no need to set up the PAGE0 register.
442 */
443 grpci1_cfg_w32(priv, TGT, devfn: 0, PCI_BASE_ADDRESS_0, val: 0xffffffff);
444 grpci1_cfg_r32(priv, TGT, devfn: 0, PCI_BASE_ADDRESS_0, val: &bar_sz);
445 bar_sz = ~bar_sz + 1;
446 pciadr = priv->pci_area - bar_sz;
447 grpci1_cfg_w32(priv, TGT, devfn: 0, PCI_BASE_ADDRESS_0, val: pciadr);
448
449 /*
450 * Setup the Host's PCI Target BAR1 for other peripherals to access,
451 * and do DMA to the host's memory.
452 */
453 grpci1_cfg_w32(priv, TGT, devfn: 0, PCI_BASE_ADDRESS_1, val: ahbadr);
454
455 /*
456 * Setup Latency Timer and cache line size. Default cache line
457 * size will result in poor performance (256 word fetches), 0xff
458 * will set it according to the max size of the PCI FIFO.
459 */
460 grpci1_cfg_w8(priv, TGT, devfn: 0, PCI_CACHE_LINE_SIZE, val: 0xff);
461 grpci1_cfg_w8(priv, TGT, devfn: 0, PCI_LATENCY_TIMER, val: 0x40);
462
463 /* set as bus master, enable pci memory responses, clear status bits */
464 grpci1_cfg_r32(priv, TGT, devfn: 0, PCI_COMMAND, val: &data);
465 data |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
466 grpci1_cfg_w32(priv, TGT, devfn: 0, PCI_COMMAND, val: data);
467}
468
469static irqreturn_t grpci1_jump_interrupt(int irq, void *arg)
470{
471 struct grpci1_priv *priv = arg;
472 dev_err(priv->dev, "Jump IRQ happened\n");
473 return IRQ_NONE;
474}
475
476/* Handle GRPCI1 Error Interrupt */
477static irqreturn_t grpci1_err_interrupt(int irq, void *arg)
478{
479 struct grpci1_priv *priv = arg;
480 u32 status;
481
482 grpci1_cfg_r16(priv, TGT, devfn: 0, PCI_STATUS, val: &status);
483 status &= priv->pci_err_mask;
484
485 if (status == 0)
486 return IRQ_NONE;
487
488 if (status & PCI_STATUS_PARITY)
489 dev_err(priv->dev, "Data Parity Error\n");
490
491 if (status & PCI_STATUS_SIG_TARGET_ABORT)
492 dev_err(priv->dev, "Signalled Target Abort\n");
493
494 if (status & PCI_STATUS_REC_TARGET_ABORT)
495 dev_err(priv->dev, "Received Target Abort\n");
496
497 if (status & PCI_STATUS_REC_MASTER_ABORT)
498 dev_err(priv->dev, "Received Master Abort\n");
499
500 if (status & PCI_STATUS_SIG_SYSTEM_ERROR)
501 dev_err(priv->dev, "Signalled System Error\n");
502
503 if (status & PCI_STATUS_DETECTED_PARITY)
504 dev_err(priv->dev, "Parity Error\n");
505
506 /* Clear handled INT TYPE IRQs */
507 grpci1_cfg_w16(priv, TGT, devfn: 0, PCI_STATUS, val: status);
508
509 return IRQ_HANDLED;
510}
511
512static int grpci1_of_probe(struct platform_device *ofdev)
513{
514 struct grpci1_regs __iomem *regs;
515 struct grpci1_priv *priv;
516 int err, len;
517 const int *tmp;
518 u32 cfg, size, err_mask;
519 struct resource *res;
520
521 if (grpci1priv) {
522 dev_err(&ofdev->dev, "only one GRPCI1 supported\n");
523 return -ENODEV;
524 }
525
526 if (ofdev->num_resources < 3) {
527 dev_err(&ofdev->dev, "not enough APB/AHB resources\n");
528 return -EIO;
529 }
530
531 priv = devm_kzalloc(dev: &ofdev->dev, size: sizeof(*priv), GFP_KERNEL);
532 if (!priv) {
533 dev_err(&ofdev->dev, "memory allocation failed\n");
534 return -ENOMEM;
535 }
536 platform_set_drvdata(pdev: ofdev, data: priv);
537 priv->dev = &ofdev->dev;
538
539 /* find device register base address */
540 res = platform_get_resource(ofdev, IORESOURCE_MEM, 0);
541 regs = devm_ioremap_resource(dev: &ofdev->dev, res);
542 if (IS_ERR(ptr: regs))
543 return PTR_ERR(ptr: regs);
544
545 /*
546 * check that we're in Host Slot and that we can act as a Host Bridge
547 * and not only as target/peripheral.
548 */
549 cfg = REGLOAD(regs->cfg_stat);
550 if ((cfg & CFGSTAT_HOST) == 0) {
551 dev_err(&ofdev->dev, "not in host system slot\n");
552 return -EIO;
553 }
554
555 /* check that BAR1 support 256 MByte so that we can map kernel space */
556 REGSTORE(regs->page1, 0xffffffff);
557 size = ~REGLOAD(regs->page1) + 1;
558 if (size < 0x10000000) {
559 dev_err(&ofdev->dev, "BAR1 must be at least 256MByte\n");
560 return -EIO;
561 }
562
563 /* hardware must support little-endian PCI (byte-twisting) */
564 if ((REGLOAD(regs->page0) & PAGE0_BTEN) == 0) {
565 dev_err(&ofdev->dev, "byte-twisting is required\n");
566 return -EIO;
567 }
568
569 priv->regs = regs;
570 priv->irq = irq_of_parse_and_map(node: ofdev->dev.of_node, index: 0);
571 dev_info(&ofdev->dev, "host found at 0x%p, irq%d\n", regs, priv->irq);
572
573 /* Find PCI Memory, I/O and Configuration Space Windows */
574 priv->pci_area = ofdev->resource[1].start;
575 priv->pci_area_end = ofdev->resource[1].end+1;
576 priv->pci_io = ofdev->resource[2].start;
577 priv->pci_conf = ofdev->resource[2].start + 0x10000;
578 priv->pci_conf_end = priv->pci_conf + 0x10000;
579 priv->pci_io_va = (unsigned long)ioremap(offset: priv->pci_io, size: 0x10000);
580 if (!priv->pci_io_va) {
581 dev_err(&ofdev->dev, "unable to map PCI I/O area\n");
582 return -EIO;
583 }
584
585 printk(KERN_INFO
586 "GRPCI1: MEMORY SPACE [0x%08lx - 0x%08lx]\n"
587 " I/O SPACE [0x%08lx - 0x%08lx]\n"
588 " CONFIG SPACE [0x%08lx - 0x%08lx]\n",
589 priv->pci_area, priv->pci_area_end-1,
590 priv->pci_io, priv->pci_conf-1,
591 priv->pci_conf, priv->pci_conf_end-1);
592
593 /*
594 * I/O Space resources in I/O Window mapped into Virtual Adr Space
595 * We never use low 4KB because some devices seem have problems using
596 * address 0.
597 */
598 priv->info.io_space.name = "GRPCI1 PCI I/O Space";
599 priv->info.io_space.start = priv->pci_io_va + 0x1000;
600 priv->info.io_space.end = priv->pci_io_va + 0x10000 - 1;
601 priv->info.io_space.flags = IORESOURCE_IO;
602
603 /*
604 * grpci1 has no prefetchable memory, map everything as
605 * non-prefetchable memory
606 */
607 priv->info.mem_space.name = "GRPCI1 PCI MEM Space";
608 priv->info.mem_space.start = priv->pci_area;
609 priv->info.mem_space.end = priv->pci_area_end - 1;
610 priv->info.mem_space.flags = IORESOURCE_MEM;
611
612 if (request_resource(root: &iomem_resource, new: &priv->info.mem_space) < 0) {
613 dev_err(&ofdev->dev, "unable to request PCI memory area\n");
614 err = -ENOMEM;
615 goto err1;
616 }
617
618 if (request_resource(root: &ioport_resource, new: &priv->info.io_space) < 0) {
619 dev_err(&ofdev->dev, "unable to request PCI I/O area\n");
620 err = -ENOMEM;
621 goto err2;
622 }
623
624 /* setup maximum supported PCI buses */
625 priv->info.busn.name = "GRPCI1 busn";
626 priv->info.busn.start = 0;
627 priv->info.busn.end = 15;
628
629 grpci1priv = priv;
630
631 /* Initialize hardware */
632 grpci1_hw_init(priv);
633
634 /*
635 * Get PCI Interrupt to System IRQ mapping and setup IRQ handling
636 * Error IRQ. All PCI and PCI-Error interrupts are shared using the
637 * same system IRQ.
638 */
639 leon_update_virq_handling(priv->irq, grpci1_pci_flow_irq, "pcilvl", 0);
640
641 priv->irq_map[0] = grpci1_build_device_irq(irq: 1);
642 priv->irq_map[1] = grpci1_build_device_irq(irq: 2);
643 priv->irq_map[2] = grpci1_build_device_irq(irq: 3);
644 priv->irq_map[3] = grpci1_build_device_irq(irq: 4);
645 priv->irq_err = grpci1_build_device_irq(irq: 5);
646
647 printk(KERN_INFO " PCI INTA..D#: IRQ%d, IRQ%d, IRQ%d, IRQ%d\n",
648 priv->irq_map[0], priv->irq_map[1], priv->irq_map[2],
649 priv->irq_map[3]);
650
651 /* Enable IRQs on LEON IRQ controller */
652 err = devm_request_irq(dev: &ofdev->dev, irq: priv->irq, handler: grpci1_jump_interrupt, irqflags: 0,
653 devname: "GRPCI1_JUMP", dev_id: priv);
654 if (err) {
655 dev_err(&ofdev->dev, "ERR IRQ request failed: %d\n", err);
656 goto err3;
657 }
658
659 /* Setup IRQ handler for access errors */
660 err = devm_request_irq(dev: &ofdev->dev, irq: priv->irq_err,
661 handler: grpci1_err_interrupt, IRQF_SHARED, devname: "GRPCI1_ERR",
662 dev_id: priv);
663 if (err) {
664 dev_err(&ofdev->dev, "ERR VIRQ request failed: %d\n", err);
665 goto err3;
666 }
667
668 tmp = of_get_property(node: ofdev->dev.of_node, name: "all_pci_errors", lenp: &len);
669 if (tmp && (len == 4)) {
670 priv->pci_err_mask = ALL_PCI_ERRORS;
671 err_mask = IRQ_ALL_ERRORS << IRQ_MASK_BIT;
672 } else {
673 priv->pci_err_mask = DEF_PCI_ERRORS;
674 err_mask = IRQ_DEF_ERRORS << IRQ_MASK_BIT;
675 }
676
677 /*
678 * Enable Error Interrupts. PCI interrupts are unmasked once request_irq
679 * is called by the PCI Device drivers
680 */
681 REGSTORE(regs->irq, err_mask);
682
683 /* Init common layer and scan buses */
684 priv->info.ops = &grpci1_ops;
685 priv->info.map_irq = grpci1_map_irq;
686 leon_pci_init(ofdev, &priv->info);
687
688 return 0;
689
690err3:
691 release_resource(new: &priv->info.io_space);
692err2:
693 release_resource(new: &priv->info.mem_space);
694err1:
695 iounmap(addr: (void __iomem *)priv->pci_io_va);
696 grpci1priv = NULL;
697 return err;
698}
699
700static const struct of_device_id grpci1_of_match[] = {
701 {
702 .name = "GAISLER_PCIFBRG",
703 },
704 {
705 .name = "01_014",
706 },
707 {},
708};
709
710static struct platform_driver grpci1_of_driver = {
711 .driver = {
712 .name = "grpci1",
713 .of_match_table = grpci1_of_match,
714 },
715 .probe = grpci1_of_probe,
716};
717
718static int __init grpci1_init(void)
719{
720 return platform_driver_register(&grpci1_of_driver);
721}
722
723subsys_initcall(grpci1_init);
724

source code of linux/arch/sparc/kernel/leon_pci_grpci1.c