Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history 
yaml
---
r: 116415
b: refs/heads/master
c: e5a5371
h: refs/heads/master
i:
  116413: c58a2a5
  116411: b15c25d
  116407: 44fe7fa
  116399: c334da5
  116383: 9b38956
  116351: 639b340
v: v3
  • Loading branch information
Yinghai Lu authored and Ingo Molnar committed Oct 16, 2008
1 parent 2c0c25a commit 1be7cfd
Show file tree
Hide file tree
Showing 2 changed files with 121 additions and 42 deletions.
2 changes: 1 addition & 1 deletion [refs]
View file
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: 3ac2de48ed3c998df7f366e039c97eedb27e7c3d
refs/heads/master: e5a53714acfc7b5f868d07d27c5f02cb00b118db
161 changes: 120 additions & 41 deletions trunk/arch/x86/kernel/io_apic_64.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -58,10 +58,11 @@
#define __apicdebuginit(type) static type __init

struct irq_cfg;

struct irq_pin_list;
struct irq_cfg {
unsigned int irq;
struct irq_cfg *next;
struct irq_pin_list *irq_2_pin;
cpumask_t domain;
cpumask_t old_domain;
unsigned move_cleanup_count;
Expand Down Expand Up @@ -252,13 +253,66 @@ int pin_map_size;
* between pins and IRQs.
*/

static struct irq_pin_list {
short apic, pin;
int next;
} *irq_2_pin;
struct irq_pin_list {
int apic, 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, sizeof(struct irq_pin_list), 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 {
unsigned int index;
Expand Down Expand Up @@ -300,16 +354,17 @@ static bool io_apic_level_ack_pending(unsigned int irq)
{
struct irq_pin_list *entry;
unsigned long flags;
struct irq_cfg *cfg = irq_cfg(irq);

spin_lock_irqsave(&ioapic_lock, flags);
entry = irq_2_pin + irq;
entry = cfg->irq_2_pin;
for (;;) {
unsigned int reg;
int pin;

pin = entry->pin;
if (pin == -1)
if (!entry)
break;
pin = entry->pin;
reg = io_apic_read(entry->apic, 0x10 + pin*2);
/* Is the remote IRR bit set? */
if (reg & IO_APIC_REDIR_REMOTE_IRR) {
Expand All @@ -318,7 +373,7 @@ static bool io_apic_level_ack_pending(unsigned int irq)
}
if (!entry->next)
break;
entry = irq_2_pin + entry->next;
entry = entry->next;
}
spin_unlock_irqrestore(&ioapic_lock, flags);

Expand All @@ -339,21 +394,24 @@ static inline void io_apic_sync(unsigned int apic)
\
{ \
int pin; \
struct irq_pin_list *entry = irq_2_pin + irq; \
struct irq_cfg *cfg; \
struct irq_pin_list *entry; \
\
BUG_ON(irq >= nr_irqs); \
cfg = irq_cfg(irq); \
entry = cfg->irq_2_pin; \
for (;;) { \
unsigned int reg; \
pin = entry->pin; \
if (pin == -1) \
if (!entry) \
break; \
pin = entry->pin; \
reg = io_apic_read(entry->apic, 0x10 + R + pin*2); \
reg ACTION; \
io_apic_modify(entry->apic, reg); \
FINAL; \
if (!entry->next) \
break; \
entry = irq_2_pin + entry->next; \
entry = entry->next; \
} \
}

Expand Down Expand Up @@ -416,15 +474,20 @@ static void ioapic_mask_entry(int apic, int pin)
static void __target_IO_APIC_irq(unsigned int irq, unsigned int dest, u8 vector)
{
int apic, pin;
struct irq_pin_list *entry = irq_2_pin + irq;
struct irq_cfg *cfg;
struct irq_pin_list *entry;

BUG_ON(irq >= nr_irqs);
cfg = irq_cfg(irq);
entry = cfg->irq_2_pin;
for (;;) {
unsigned int reg;

if (!entry)
break;

apic = entry->apic;
pin = entry->pin;
if (pin == -1)
break;
/*
* With interrupt-remapping, destination information comes
* from interrupt-remapping table entry.
Expand All @@ -437,7 +500,7 @@ static void __target_IO_APIC_irq(unsigned int irq, unsigned int dest, u8 vector)
io_apic_modify(apic, reg);
if (!entry->next)
break;
entry = irq_2_pin + entry->next;
entry = entry->next;
}
}

Expand Down Expand Up @@ -480,22 +543,35 @@ static void set_ioapic_affinity_irq(unsigned int irq, cpumask_t mask)
int first_free_entry;
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;

BUG_ON(irq >= nr_irqs);
irq_cfg_alloc(irq);
/* 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;
}

while (entry->next)
entry = irq_2_pin + entry->next;
while (entry->next) {
/* not again, please */
if (entry->apic == apic && entry->pin == pin)
return;

if (entry->pin != -1) {
entry->next = first_free_entry;
entry = irq_2_pin + entry->next;
if (++first_free_entry >= pin_map_size)
panic("io_apic.c: ran out of irq_2_pin entries!");
entry = entry->next;
}

entry->next = get_one_free_irq_2_pin();
entry = entry->next;
entry->apic = apic;
entry->pin = pin;
printk(KERN_DEBUG " x add_pin_to_irq: irq %d --> apic %d pin %d\n", irq, apic, pin);
}

/*
Expand All @@ -505,17 +581,24 @@ static void __init replace_pin_at_irq(unsigned int irq,
int oldapic, int oldpin,
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) {
entry->apic = newapic;
entry->pin = newpin;
}
if (!entry->next)
replaced = 1;
/* every one is different, right? */
break;
entry = irq_2_pin + entry->next;
}
entry = entry->next;
}

/* why? call replace before add? */
if (!replaced)
add_pin_to_irq(irq, newapic, newpin);
}


Expand Down Expand Up @@ -1326,15 +1409,16 @@ __apicdebuginit(void) print_IO_APIC(void)
}
printk(KERN_DEBUG "IRQ to pin mappings:\n");
for (i = 0; i < nr_irqs; i++) {
struct irq_pin_list *entry = irq_2_pin + i;
if (entry->pin < 0)
struct irq_cfg *cfg = irq_cfg(i);
struct irq_pin_list *entry = cfg->irq_2_pin;
if (!entry)
continue;
printk(KERN_DEBUG "IRQ%d ", i);
for (;;) {
printk("-> %d:%d", entry->apic, entry->pin);
if (!entry->next)
break;
entry = irq_2_pin + entry->next;
entry = entry->next;
}
printk("\n");
}
Expand Down Expand Up @@ -1495,14 +1579,9 @@ void __init enable_IO_APIC(void)
{
union IO_APIC_reg_01 reg_01;
int i8259_apic, i8259_pin;
int i, apic;
int apic;
unsigned long flags;

for (i = 0; i < pin_map_size; i++) {
irq_2_pin[i].pin = -1;
irq_2_pin[i].next = 0;
}

/*
* The number of IO-APIC IRQ registers (== #pins):
*/
Expand Down

0 comments on commit 1be7cfd

Please sign in to comment.