2 * MSI hooks for standard x86 apic
8 #include <linux/dmar.h>
10 #include <asm/msidef.h>
12 static struct irq_chip ia64_msi_chip
;
15 static int ia64_set_msi_irq_affinity(struct irq_data
*idata
,
16 const cpumask_t
*cpu_mask
, bool force
)
20 int cpu
= cpumask_first_and(cpu_mask
, cpu_online_mask
);
21 unsigned int irq
= idata
->irq
;
23 if (irq_prepare_move(irq
, cpu
))
26 get_cached_msi_msg(irq
, &msg
);
28 addr
= msg
.address_lo
;
29 addr
&= MSI_ADDR_DEST_ID_MASK
;
30 addr
|= MSI_ADDR_DEST_ID_CPU(cpu_physical_id(cpu
));
31 msg
.address_lo
= addr
;
34 data
&= MSI_DATA_VECTOR_MASK
;
35 data
|= MSI_DATA_VECTOR(irq_to_vector(irq
));
38 write_msi_msg(irq
, &msg
);
39 cpumask_copy(idata
->affinity
, cpumask_of(cpu
));
43 #endif /* CONFIG_SMP */
45 int ia64_setup_msi_irq(struct pci_dev
*pdev
, struct msi_desc
*desc
)
48 unsigned long dest_phys_id
;
56 irq_set_msi_desc(irq
, desc
);
57 cpumask_and(&mask
, &(irq_to_domain(irq
)), cpu_online_mask
);
58 dest_phys_id
= cpu_physical_id(first_cpu(mask
));
59 vector
= irq_to_vector(irq
);
64 MSI_ADDR_DEST_MODE_PHYS
|
65 MSI_ADDR_REDIRECTION_CPU
|
66 MSI_ADDR_DEST_ID_CPU(dest_phys_id
);
69 MSI_DATA_TRIGGER_EDGE
|
70 MSI_DATA_LEVEL_ASSERT
|
71 MSI_DATA_DELIVERY_FIXED
|
72 MSI_DATA_VECTOR(vector
);
74 write_msi_msg(irq
, &msg
);
75 irq_set_chip_and_handler(irq
, &ia64_msi_chip
, handle_edge_irq
);
80 void ia64_teardown_msi_irq(unsigned int irq
)
85 static void ia64_ack_msi_irq(struct irq_data
*data
)
87 irq_complete_move(data
->irq
);
92 static int ia64_msi_retrigger_irq(struct irq_data
*data
)
94 unsigned int vector
= irq_to_vector(data
->irq
);
95 ia64_resend_irq(vector
);
101 * Generic ops used on most IA64 platforms.
103 static struct irq_chip ia64_msi_chip
= {
105 .irq_mask
= mask_msi_irq
,
106 .irq_unmask
= unmask_msi_irq
,
107 .irq_ack
= ia64_ack_msi_irq
,
109 .irq_set_affinity
= ia64_set_msi_irq_affinity
,
111 .irq_retrigger
= ia64_msi_retrigger_irq
,
115 int arch_setup_msi_irq(struct pci_dev
*pdev
, struct msi_desc
*desc
)
117 if (platform_setup_msi_irq
)
118 return platform_setup_msi_irq(pdev
, desc
);
120 return ia64_setup_msi_irq(pdev
, desc
);
123 void arch_teardown_msi_irq(unsigned int irq
)
125 if (platform_teardown_msi_irq
)
126 return platform_teardown_msi_irq(irq
);
128 return ia64_teardown_msi_irq(irq
);
131 #ifdef CONFIG_INTEL_IOMMU
133 static int dmar_msi_set_affinity(struct irq_data
*data
,
134 const struct cpumask
*mask
, bool force
)
136 unsigned int irq
= data
->irq
;
137 struct irq_cfg
*cfg
= irq_cfg
+ irq
;
139 int cpu
= cpumask_first_and(mask
, cpu_online_mask
);
141 if (irq_prepare_move(irq
, cpu
))
144 dmar_msi_read(irq
, &msg
);
146 msg
.data
&= ~MSI_DATA_VECTOR_MASK
;
147 msg
.data
|= MSI_DATA_VECTOR(cfg
->vector
);
148 msg
.address_lo
&= ~MSI_ADDR_DEST_ID_MASK
;
149 msg
.address_lo
|= MSI_ADDR_DEST_ID_CPU(cpu_physical_id(cpu
));
151 dmar_msi_write(irq
, &msg
);
152 cpumask_copy(data
->affinity
, mask
);
156 #endif /* CONFIG_SMP */
158 static struct irq_chip dmar_msi_type
= {
160 .irq_unmask
= dmar_msi_unmask
,
161 .irq_mask
= dmar_msi_mask
,
162 .irq_ack
= ia64_ack_msi_irq
,
164 .irq_set_affinity
= dmar_msi_set_affinity
,
166 .irq_retrigger
= ia64_msi_retrigger_irq
,
170 msi_compose_msg(struct pci_dev
*pdev
, unsigned int irq
, struct msi_msg
*msg
)
172 struct irq_cfg
*cfg
= irq_cfg
+ irq
;
176 cpumask_and(&mask
, &(irq_to_domain(irq
)), cpu_online_mask
);
177 dest
= cpu_physical_id(first_cpu(mask
));
182 MSI_ADDR_DEST_MODE_PHYS
|
183 MSI_ADDR_REDIRECTION_CPU
|
184 MSI_ADDR_DEST_ID_CPU(dest
);
187 MSI_DATA_TRIGGER_EDGE
|
188 MSI_DATA_LEVEL_ASSERT
|
189 MSI_DATA_DELIVERY_FIXED
|
190 MSI_DATA_VECTOR(cfg
->vector
);
194 int arch_setup_dmar_msi(unsigned int irq
)
199 ret
= msi_compose_msg(NULL
, irq
, &msg
);
202 dmar_msi_write(irq
, &msg
);
203 irq_set_chip_and_handler_name(irq
, &dmar_msi_type
, handle_edge_irq
,
207 #endif /* CONFIG_INTEL_IOMMU */