Signed-off-by: Jiang Liu <jiang....@linux.intel.com>
---
 arch/x86/kernel/apic/io_apic.c |   41 +++++++++++++++++++++++++++++-----------
 1 file changed, 30 insertions(+), 11 deletions(-)

diff --git a/arch/x86/kernel/apic/io_apic.c b/arch/x86/kernel/apic/io_apic.c
index dd81b58cce95..faed9b62977d 100644
--- a/arch/x86/kernel/apic/io_apic.c
+++ b/arch/x86/kernel/apic/io_apic.c
@@ -117,6 +117,26 @@ struct mp_ioapic_gsi *mp_ioapic_gsi_routing(int ioapic_idx)
        return &ioapics[ioapic_idx].gsi_config;
 }
 
+static inline int mp_ioapic_pin_count(int ioapic)
+{
+       struct mp_ioapic_gsi *gsi_cfg = mp_ioapic_gsi_routing(ioapic);
+
+       return gsi_cfg->gsi_end - gsi_cfg->gsi_base + 1;
+}
+
+static inline u32 mp_pin_2_gsi(int ioapic, int pin)
+{
+       return mp_ioapic_gsi_routing(ioapic)->gsi_base + pin;
+}
+
+/* Initialize all legacy IRQs and all pins on the first IOAPIC at boot */
+static inline int mp_init_pin_at_boot(int ioapic, int pin)
+{
+       u32 gsi = mp_pin_2_gsi(ioapic, pin);
+
+       return ioapic == 0 || gsi < NR_IRQS_LEGACY;
+}
+
 int nr_ioapics;
 
 /* The one past the highest gsi number used */
@@ -1378,15 +1398,15 @@ static void __init __io_apic_setup_irqs(unsigned int 
ioapic_idx)
        unsigned int pin, irq;
 
        for_each_pin(ioapic_idx, pin) {
+               if (!mp_init_pin_at_boot(ioapic_idx, pin))
+                       continue;
+
                idx = find_irq_entry(ioapic_idx, pin, mp_INT);
                if (io_apic_pin_not_connected(idx, ioapic_idx, pin))
                        continue;
 
                irq = pin_2_irq(idx, ioapic_idx, pin);
 
-               if ((ioapic_idx > 0) && (irq > NR_IRQS_LEGACY))
-                       continue;
-
                /*
                 * Skip the timer IRQ if there's a quirk handler
                 * installed and if it returns 1:
@@ -1430,16 +1450,15 @@ void setup_IO_APIC_irq_extra(u32 gsi)
                return;
 
        pin = mp_find_ioapic_pin(ioapic_idx, gsi);
+       if (mp_init_pin_at_boot(ioapic_idx, pin))
+               return;
+
        idx = find_irq_entry(ioapic_idx, pin, mp_INT);
        if (idx == -1)
                return;
 
        irq = pin_2_irq(idx, ioapic_idx, pin);
 
-       /* Only handle the non legacy irqs on secondary ioapics */
-       if (ioapic_idx == 0 || irq < NR_IRQS_LEGACY)
-               return;
-
        set_io_apic_irq_attr(&attr, ioapic_idx, pin, irq_trigger(idx),
                             irq_polarity(idx));
 
@@ -3605,14 +3624,14 @@ void __init setup_ioapic_dest(void)
                return;
 
        for_each_ioapic_pin(ioapic, pin) {
-               irq_entry = find_irq_entry(ioapic, pin, mp_INT);
-               if (irq_entry == -1)
+               if (!mp_init_pin_at_boot(ioapic, pin))
                        continue;
-               irq = pin_2_irq(irq_entry, ioapic, pin);
 
-               if ((ioapic > 0) && (irq > NR_IRQS_LEGACY))
+               irq_entry = find_irq_entry(ioapic, pin, mp_INT);
+               if (irq_entry == -1)
                        continue;
 
+               irq = pin_2_irq(irq_entry, ioapic, pin);
                idata = irq_get_irq_data(irq);
 
                /*
-- 
1.7.10.4

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to