|
@@ -960,10 +960,37 @@ void __init mp_register_ioapic(int id, u32 address, u32 gsi_base)
|
|
|
nr_ioapics++;
|
|
|
}
|
|
|
|
|
|
+static void assign_to_mp_irq(struct mp_config_intsrc *m,
|
|
|
+ struct mp_config_intsrc *mp_irq)
|
|
|
+{
|
|
|
+ memcpy(mp_irq, m, sizeof(struct mp_config_intsrc));
|
|
|
+}
|
|
|
+
|
|
|
+static int mp_irq_cmp(struct mp_config_intsrc *mp_irq,
|
|
|
+ struct mp_config_intsrc *m)
|
|
|
+{
|
|
|
+ return memcmp(mp_irq, m, sizeof(struct mp_config_intsrc));
|
|
|
+}
|
|
|
+
|
|
|
+static void save_mp_irq(struct mp_config_intsrc *m)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i = 0; i < mp_irq_entries; i++) {
|
|
|
+ if (!mp_irq_cmp(&mp_irqs[i], m))
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ assign_to_mp_irq(m, &mp_irqs[mp_irq_entries]);
|
|
|
+ if (++mp_irq_entries == MAX_IRQ_SOURCES)
|
|
|
+ panic("Max # of irq sources exceeded!!\n");
|
|
|
+}
|
|
|
+
|
|
|
void __init mp_override_legacy_irq(u8 bus_irq, u8 polarity, u8 trigger, u32 gsi)
|
|
|
{
|
|
|
int ioapic;
|
|
|
int pin;
|
|
|
+ struct mp_config_intsrc mp_irq;
|
|
|
|
|
|
/*
|
|
|
* Convert 'gsi' to 'ioapic.pin'.
|
|
@@ -981,18 +1008,15 @@ void __init mp_override_legacy_irq(u8 bus_irq, u8 polarity, u8 trigger, u32 gsi)
|
|
|
if ((bus_irq == 0) && (trigger == 3))
|
|
|
trigger = 1;
|
|
|
|
|
|
- mp_irqs[mp_irq_entries].mp_type = MP_INTSRC;
|
|
|
- mp_irqs[mp_irq_entries].mp_irqtype = mp_INT;
|
|
|
- mp_irqs[mp_irq_entries].mp_irqflag = (trigger << 2) | polarity;
|
|
|
- mp_irqs[mp_irq_entries].mp_srcbus = MP_ISA_BUS;
|
|
|
- mp_irqs[mp_irq_entries].mp_srcbusirq = bus_irq; /* IRQ */
|
|
|
- mp_irqs[mp_irq_entries].mp_dstapic =
|
|
|
- mp_ioapics[ioapic].mp_apicid; /* APIC ID */
|
|
|
- mp_irqs[mp_irq_entries].mp_dstirq = pin; /* INTIN# */
|
|
|
-
|
|
|
- if (++mp_irq_entries == MAX_IRQ_SOURCES)
|
|
|
- panic("Max # of irq sources exceeded!!\n");
|
|
|
+ mp_irq.mp_type = MP_INTSRC;
|
|
|
+ mp_irq.mp_irqtype = mp_INT;
|
|
|
+ mp_irq.mp_irqflag = (trigger << 2) | polarity;
|
|
|
+ mp_irq.mp_srcbus = MP_ISA_BUS;
|
|
|
+ mp_irq.mp_srcbusirq = bus_irq; /* IRQ */
|
|
|
+ mp_irq.mp_dstapic = mp_ioapics[ioapic].mp_apicid; /* APIC ID */
|
|
|
+ mp_irq.mp_dstirq = pin; /* INTIN# */
|
|
|
|
|
|
+ save_mp_irq(&mp_irq);
|
|
|
}
|
|
|
|
|
|
void __init mp_config_acpi_legacy_irqs(void)
|
|
@@ -1000,6 +1024,7 @@ void __init mp_config_acpi_legacy_irqs(void)
|
|
|
int i;
|
|
|
int ioapic;
|
|
|
unsigned int dstapic;
|
|
|
+ struct mp_config_intsrc mp_irq;
|
|
|
|
|
|
#if defined (CONFIG_MCA) || defined (CONFIG_EISA)
|
|
|
/*
|
|
@@ -1052,16 +1077,15 @@ void __init mp_config_acpi_legacy_irqs(void)
|
|
|
continue; /* IRQ already used */
|
|
|
}
|
|
|
|
|
|
- mp_irqs[mp_irq_entries].mp_type = MP_INTSRC;
|
|
|
- mp_irqs[mp_irq_entries].mp_irqflag = 0; /* Conforming */
|
|
|
- mp_irqs[mp_irq_entries].mp_srcbus = MP_ISA_BUS;
|
|
|
- mp_irqs[mp_irq_entries].mp_dstapic = dstapic;
|
|
|
- mp_irqs[mp_irq_entries].mp_irqtype = mp_INT;
|
|
|
- mp_irqs[mp_irq_entries].mp_srcbusirq = i; /* Identity mapped */
|
|
|
- mp_irqs[mp_irq_entries].mp_dstirq = i;
|
|
|
+ mp_irq.mp_type = MP_INTSRC;
|
|
|
+ mp_irq.mp_irqflag = 0; /* Conforming */
|
|
|
+ mp_irq.mp_srcbus = MP_ISA_BUS;
|
|
|
+ mp_irq.mp_dstapic = dstapic;
|
|
|
+ mp_irq.mp_irqtype = mp_INT;
|
|
|
+ mp_irq.mp_srcbusirq = i; /* Identity mapped */
|
|
|
+ mp_irq.mp_dstirq = i;
|
|
|
|
|
|
- if (++mp_irq_entries == MAX_IRQ_SOURCES)
|
|
|
- panic("Max # of irq sources exceeded!!\n");
|
|
|
+ save_mp_irq(&mp_irq);
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -1169,25 +1193,26 @@ int mp_register_gsi(u32 gsi, int triggering, int polarity)
|
|
|
int mp_config_acpi_gsi(unsigned char number, unsigned int devfn, u8 pin,
|
|
|
u32 gsi, int triggering, int polarity)
|
|
|
{
|
|
|
- struct mpc_config_intsrc intsrc;
|
|
|
+#ifdef CONFIG_X86_MPPARSE
|
|
|
+ struct mp_config_intsrc mp_irq;
|
|
|
int ioapic;
|
|
|
|
|
|
- if (!enable_update_mptable)
|
|
|
+ if (!acpi_ioapic)
|
|
|
return 0;
|
|
|
|
|
|
/* print the entry should happen on mptable identically */
|
|
|
- intsrc.mpc_type = MP_INTSRC;
|
|
|
- intsrc.mpc_irqtype = mp_INT;
|
|
|
- intsrc.mpc_irqflag = (triggering == ACPI_EDGE_SENSITIVE ? 4 : 0x0c) |
|
|
|
+ mp_irq.mp_type = MP_INTSRC;
|
|
|
+ mp_irq.mp_irqtype = mp_INT;
|
|
|
+ mp_irq.mp_irqflag = (triggering == ACPI_EDGE_SENSITIVE ? 4 : 0x0c) |
|
|
|
(polarity == ACPI_ACTIVE_HIGH ? 1 : 3);
|
|
|
- intsrc.mpc_srcbus = number;
|
|
|
- intsrc.mpc_srcbusirq = (((devfn >> 3) & 0x1f) << 2) | ((pin - 1) & 3);
|
|
|
+ mp_irq.mp_srcbus = number;
|
|
|
+ mp_irq.mp_srcbusirq = (((devfn >> 3) & 0x1f) << 2) | ((pin - 1) & 3);
|
|
|
ioapic = mp_find_ioapic(gsi);
|
|
|
- intsrc.mpc_dstapic = mp_ioapic_routing[ioapic].apic_id;
|
|
|
- intsrc.mpc_dstirq = gsi - mp_ioapic_routing[ioapic].gsi_base;
|
|
|
-
|
|
|
- MP_intsrc_info(&intsrc);
|
|
|
+ mp_irq.mp_dstapic = mp_ioapic_routing[ioapic].apic_id;
|
|
|
+ mp_irq.mp_dstirq = gsi - mp_ioapic_routing[ioapic].gsi_base;
|
|
|
|
|
|
+ save_mp_irq(&mp_irq);
|
|
|
+#endif
|
|
|
return 0;
|
|
|
}
|
|
|
|