提交 0f978f45 编写于 作者: Y Yinghai Lu 提交者: Ingo Molnar

x86: make 32bit to use irq_2_pin in irq_cfg

so it is more like 64 bit.
Signed-off-by: NYinghai Lu <yhlu.kernel@gmail.com>
Signed-off-by: NIngo Molnar <mingo@elte.hu>
上级 da51a821
...@@ -95,10 +95,11 @@ DECLARE_BITMAP(mp_bus_not_pci, MAX_MP_BUSSES); ...@@ -95,10 +95,11 @@ DECLARE_BITMAP(mp_bus_not_pci, MAX_MP_BUSSES);
static int disable_timer_pin_1 __initdata; static int disable_timer_pin_1 __initdata;
struct irq_cfg; struct irq_cfg;
struct irq_pin_list;
struct irq_cfg { struct irq_cfg {
unsigned int irq; unsigned int irq;
struct irq_cfg *next; struct irq_cfg *next;
struct irq_pin_list *irq_2_pin;
u8 vector; u8 vector;
}; };
...@@ -275,11 +276,66 @@ int pin_map_size; ...@@ -275,11 +276,66 @@ int pin_map_size;
* between pins and IRQs. * between pins and IRQs.
*/ */
static struct irq_pin_list { struct irq_pin_list {
int apic, pin, next; int apic, pin;
} *irq_2_pin; struct irq_pin_list *next;
};
static struct irq_pin_list *irq_2_pin_head;
/* fill one page ? */
static int nr_irq_2_pin = 0x100;
static struct irq_pin_list *irq_2_pin_ptr;
static void __init irq_2_pin_init_work(void *data)
{
struct dyn_array *da = data;
struct irq_pin_list *pin;
int i;
pin = *da->name;
for (i = 1; i < *da->nr; i++)
pin[i-1].next = &pin[i];
irq_2_pin_ptr = &pin[0];
}
DEFINE_DYN_ARRAY(irq_2_pin_head, sizeof(struct irq_pin_list), nr_irq_2_pin, PAGE_SIZE, irq_2_pin_init_work);
static struct irq_pin_list *get_one_free_irq_2_pin(void)
{
struct irq_pin_list *pin;
int i;
pin = irq_2_pin_ptr;
if (pin) {
irq_2_pin_ptr = pin->next;
pin->next = NULL;
return pin;
}
/*
* we run out of pre-allocate ones, allocate more
*/
printk(KERN_DEBUG "try to get more irq_2_pin %d\n", nr_irq_2_pin);
if (after_bootmem)
pin = kzalloc(sizeof(struct irq_pin_list)*nr_irq_2_pin,
GFP_ATOMIC);
else
pin = __alloc_bootmem_nopanic(sizeof(struct irq_pin_list) *
nr_irq_2_pin, PAGE_SIZE, 0);
if (!pin)
panic("can not get more irq_2_pin\n");
DEFINE_DYN_ARRAY(irq_2_pin, sizeof(struct irq_pin_list), pin_map_size, 16, NULL); for (i = 1; i < nr_irq_2_pin; i++)
pin[i-1].next = &pin[i];
irq_2_pin_ptr = pin->next;
pin->next = NULL;
return pin;
}
struct io_apic { struct io_apic {
unsigned int index; unsigned int index;
...@@ -383,20 +439,34 @@ static void ioapic_mask_entry(int apic, int pin) ...@@ -383,20 +439,34 @@ static void ioapic_mask_entry(int apic, int pin)
*/ */
static void add_pin_to_irq(unsigned int irq, int apic, int pin) static void add_pin_to_irq(unsigned int irq, int apic, int pin)
{ {
struct irq_pin_list *entry = irq_2_pin + irq; struct irq_cfg *cfg;
struct irq_pin_list *entry;
/* first time to refer irq_cfg, so with new */
cfg = irq_cfg_alloc(irq);
entry = cfg->irq_2_pin;
if (!entry) {
entry = get_one_free_irq_2_pin();
cfg->irq_2_pin = entry;
entry->apic = apic;
entry->pin = pin;
printk(KERN_DEBUG " 0 add_pin_to_irq: irq %d --> apic %d pin %d\n", irq, apic, pin);
return;
}
irq_cfg_alloc(irq); while (entry->next) {
while (entry->next) /* not again, please */
entry = irq_2_pin + entry->next; if (entry->apic == apic && entry->pin == pin)
return;
if (entry->pin != -1) { entry = entry->next;
entry->next = first_free_entry;
entry = irq_2_pin + entry->next;
if (++first_free_entry >= pin_map_size)
panic("io_apic.c: whoops");
} }
entry->next = get_one_free_irq_2_pin();
entry = entry->next;
entry->apic = apic; entry->apic = apic;
entry->pin = pin; entry->pin = pin;
printk(KERN_DEBUG " x add_pin_to_irq: irq %d --> apic %d pin %d\n", irq, apic, pin);
} }
/* /*
...@@ -406,35 +476,45 @@ static void __init replace_pin_at_irq(unsigned int irq, ...@@ -406,35 +476,45 @@ static void __init replace_pin_at_irq(unsigned int irq,
int oldapic, int oldpin, int oldapic, int oldpin,
int newapic, int newpin) int newapic, int newpin)
{ {
struct irq_pin_list *entry = irq_2_pin + irq; struct irq_cfg *cfg = irq_cfg(irq);
struct irq_pin_list *entry = cfg->irq_2_pin;
int replaced = 0;
while (1) { while (entry) {
if (entry->apic == oldapic && entry->pin == oldpin) { if (entry->apic == oldapic && entry->pin == oldpin) {
entry->apic = newapic; entry->apic = newapic;
entry->pin = newpin; entry->pin = newpin;
} replaced = 1;
if (!entry->next) /* every one is different, right? */
break; break;
entry = irq_2_pin + entry->next; }
entry = entry->next;
} }
/* why? call replace before add? */
if (!replaced)
add_pin_to_irq(irq, newapic, newpin);
} }
static void __modify_IO_APIC_irq(unsigned int irq, unsigned long enable, unsigned long disable) static void __modify_IO_APIC_irq(unsigned int irq, unsigned long enable, unsigned long disable)
{ {
struct irq_pin_list *entry = irq_2_pin + irq; struct irq_cfg *cfg;
struct irq_pin_list *entry;
unsigned int pin, reg; unsigned int pin, reg;
cfg = irq_cfg(irq);
entry = cfg->irq_2_pin;
for (;;) { for (;;) {
pin = entry->pin; if (!entry)
if (pin == -1)
break; break;
pin = entry->pin;
reg = io_apic_read(entry->apic, 0x10 + pin*2); reg = io_apic_read(entry->apic, 0x10 + pin*2);
reg &= ~disable; reg &= ~disable;
reg |= enable; reg |= enable;
io_apic_modify(entry->apic, 0x10 + pin*2, reg); io_apic_modify(entry->apic, 0x10 + pin*2, reg);
if (!entry->next) if (!entry->next)
break; break;
entry = irq_2_pin + entry->next; entry = entry->next;
} }
} }
...@@ -509,13 +589,18 @@ static void clear_IO_APIC(void) ...@@ -509,13 +589,18 @@ static void clear_IO_APIC(void)
#ifdef CONFIG_SMP #ifdef CONFIG_SMP
static void set_ioapic_affinity_irq(unsigned int irq, cpumask_t cpumask) static void set_ioapic_affinity_irq(unsigned int irq, cpumask_t cpumask)
{ {
struct irq_cfg *cfg;
unsigned long flags; unsigned long flags;
int pin; int pin;
struct irq_pin_list *entry = irq_2_pin + irq; struct irq_pin_list *entry;
unsigned int apicid_value; unsigned int apicid_value;
cpumask_t tmp; cpumask_t tmp;
struct irq_desc *desc; struct irq_desc *desc;
cfg = irq_cfg(irq);
entry = cfg->irq_2_pin;
cpus_and(tmp, cpumask, cpu_online_map); cpus_and(tmp, cpumask, cpu_online_map);
if (cpus_empty(tmp)) if (cpus_empty(tmp))
tmp = TARGET_CPUS; tmp = TARGET_CPUS;
...@@ -527,13 +612,13 @@ static void set_ioapic_affinity_irq(unsigned int irq, cpumask_t cpumask) ...@@ -527,13 +612,13 @@ static void set_ioapic_affinity_irq(unsigned int irq, cpumask_t cpumask)
apicid_value = apicid_value << 24; apicid_value = apicid_value << 24;
spin_lock_irqsave(&ioapic_lock, flags); spin_lock_irqsave(&ioapic_lock, flags);
for (;;) { for (;;) {
pin = entry->pin; if (!entry)
if (pin == -1)
break; break;
pin = entry->pin;
io_apic_write(entry->apic, 0x10 + 1 + pin*2, apicid_value); io_apic_write(entry->apic, 0x10 + 1 + pin*2, apicid_value);
if (!entry->next) if (!entry->next)
break; break;
entry = irq_2_pin + entry->next; entry = entry->next;
} }
desc = irq_to_desc(irq); desc = irq_to_desc(irq);
desc->affinity = cpumask; desc->affinity = cpumask;
...@@ -1152,6 +1237,7 @@ __apicdebuginit(void) print_IO_APIC(void) ...@@ -1152,6 +1237,7 @@ __apicdebuginit(void) print_IO_APIC(void)
union IO_APIC_reg_02 reg_02; union IO_APIC_reg_02 reg_02;
union IO_APIC_reg_03 reg_03; union IO_APIC_reg_03 reg_03;
unsigned long flags; unsigned long flags;
struct irq_cfg *cfg;
if (apic_verbosity == APIC_QUIET) if (apic_verbosity == APIC_QUIET)
return; return;
...@@ -1240,16 +1326,16 @@ __apicdebuginit(void) print_IO_APIC(void) ...@@ -1240,16 +1326,16 @@ __apicdebuginit(void) print_IO_APIC(void)
} }
} }
printk(KERN_DEBUG "IRQ to pin mappings:\n"); printk(KERN_DEBUG "IRQ to pin mappings:\n");
for (i = 0; i < nr_irqs; i++) { for_each_irq_cfg(cfg) {
struct irq_pin_list *entry = irq_2_pin + i; struct irq_pin_list *entry = cfg->irq_2_pin;
if (entry->pin < 0) if (!entry)
continue; continue;
printk(KERN_DEBUG "IRQ%d ", i); printk(KERN_DEBUG "IRQ%d ", i);
for (;;) { for (;;) {
printk("-> %d:%d", entry->apic, entry->pin); printk("-> %d:%d", entry->apic, entry->pin);
if (!entry->next) if (!entry->next)
break; break;
entry = irq_2_pin + entry->next; entry = entry->next;
} }
printk("\n"); printk("\n");
} }
...@@ -1420,10 +1506,6 @@ static void __init enable_IO_APIC(void) ...@@ -1420,10 +1506,6 @@ static void __init enable_IO_APIC(void)
int i, apic; int i, apic;
unsigned long flags; unsigned long flags;
for (i = 0; i < pin_map_size; i++) {
irq_2_pin[i].pin = -1;
irq_2_pin[i].next = 0;
}
if (!pirqs_enabled) if (!pirqs_enabled)
for (i = 0; i < MAX_PIRQS; i++) for (i = 0; i < MAX_PIRQS; i++)
pirq_entries[i] = -1; pirq_entries[i] = -1;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册