1
2
3
4
5
6
7
8
9#include <linux/pci.h>
10#include <linux/msi.h>
11#include <asm/mach/irq.h>
12#include <asm/irq.h>
13#include <mach/irqs.h>
14
15
16
17static u32 read_imipr_0(void)
18{
19 u32 val;
20 asm volatile("mrc p6, 0, %0, c8, c1, 0":"=r" (val));
21 return val;
22}
23static void write_imipr_0(u32 val)
24{
25 asm volatile("mcr p6, 0, %0, c8, c1, 0"::"r" (val));
26}
27
28
29
30static u32 read_imipr_1(void)
31{
32 u32 val;
33 asm volatile("mrc p6, 0, %0, c9, c1, 0":"=r" (val));
34 return val;
35}
36static void write_imipr_1(u32 val)
37{
38 asm volatile("mcr p6, 0, %0, c9, c1, 0"::"r" (val));
39}
40
41
42
43static u32 read_imipr_2(void)
44{
45 u32 val;
46 asm volatile("mrc p6, 0, %0, c10, c1, 0":"=r" (val));
47 return val;
48}
49static void write_imipr_2(u32 val)
50{
51 asm volatile("mcr p6, 0, %0, c10, c1, 0"::"r" (val));
52}
53
54
55
56static u32 read_imipr_3(void)
57{
58 u32 val;
59 asm volatile("mrc p6, 0, %0, c11, c1, 0":"=r" (val));
60 return val;
61}
62static void write_imipr_3(u32 val)
63{
64 asm volatile("mcr p6, 0, %0, c11, c1, 0"::"r" (val));
65}
66
67static u32 (*read_imipr[])(void) = {
68 read_imipr_0,
69 read_imipr_1,
70 read_imipr_2,
71 read_imipr_3,
72};
73
74static void (*write_imipr[])(u32) = {
75 write_imipr_0,
76 write_imipr_1,
77 write_imipr_2,
78 write_imipr_3,
79};
80
81static void iop13xx_msi_handler(struct irq_desc *desc)
82{
83 int i, j;
84 unsigned long status;
85
86
87
88
89 for (i = 0; i < ARRAY_SIZE(read_imipr); i++) {
90 status = (read_imipr[i])();
91 if (!status)
92 continue;
93
94 do {
95 j = find_first_bit(&status, 32);
96 (write_imipr[i])(1 << j);
97 generic_handle_irq(IRQ_IOP13XX_MSI_0 + j + (32*i));
98 status = (read_imipr[i])();
99 } while (status);
100 }
101}
102
103void __init iop13xx_msi_init(void)
104{
105 irq_set_chained_handler(IRQ_IOP13XX_INBD_MSI, iop13xx_msi_handler);
106}
107
108static void iop13xx_msi_nop(struct irq_data *d)
109{
110 return;
111}
112
113static struct irq_chip iop13xx_msi_chip = {
114 .name = "PCI-MSI",
115 .irq_ack = iop13xx_msi_nop,
116 .irq_enable = pci_msi_unmask_irq,
117 .irq_disable = pci_msi_mask_irq,
118 .irq_mask = pci_msi_mask_irq,
119 .irq_unmask = pci_msi_unmask_irq,
120};
121
122int arch_setup_msi_irq(struct pci_dev *pdev, struct msi_desc *desc)
123{
124 int id, irq = irq_alloc_desc_from(IRQ_IOP13XX_MSI_0, -1);
125 struct msi_msg msg;
126
127 if (irq < 0)
128 return irq;
129
130 if (irq >= NR_IOP13XX_IRQS) {
131 irq_free_desc(irq);
132 return -ENOSPC;
133 }
134
135 irq_set_msi_desc(irq, desc);
136
137 msg.address_hi = 0x0;
138 msg.address_lo = IOP13XX_MU_MIMR_PCI;
139
140 id = iop13xx_cpu_id();
141 msg.data = (id << IOP13XX_MU_MIMR_CORE_SELECT) | (irq & 0x7f);
142
143 pci_write_msi_msg(irq, &msg);
144 irq_set_chip_and_handler(irq, &iop13xx_msi_chip, handle_simple_irq);
145
146 return 0;
147}
148
149void arch_teardown_msi_irq(unsigned int irq)
150{
151 irq_free_desc(irq);
152}
153