82 lines
1.6 KiB
C
82 lines
1.6 KiB
C
|
/*
|
||
|
|
* Handle interrupts from the SRM, assuming no additional weirdness.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <linux/sched.h>
|
||
|
|
#include <linux/irq.h>
|
||
|
|
|
||
|
|
#include "proto.h"
|
||
|
|
#include "irq_impl.h"
|
||
|
|
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Is the palcode SMP safe? In other words: can we call cserve_ena/dis
|
||
|
|
* at the same time in multiple CPUs? To be safe I added a spinlock
|
||
|
|
* but it can be removed trivially if the palcode is robust against smp.
|
||
|
|
*/
|
||
|
|
DEFINE_SPINLOCK(srm_irq_lock);
|
||
|
|
|
||
|
|
static inline void
|
||
|
|
srm_enable_irq(unsigned int irq)
|
||
|
|
{
|
||
|
|
spin_lock(&srm_irq_lock);
|
||
|
|
cserve_ena(irq - 16);
|
||
|
|
spin_unlock(&srm_irq_lock);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void
|
||
|
|
srm_disable_irq(unsigned int irq)
|
||
|
|
{
|
||
|
|
spin_lock(&srm_irq_lock);
|
||
|
|
cserve_dis(irq - 16);
|
||
|
|
spin_unlock(&srm_irq_lock);
|
||
|
|
}
|
||
|
|
|
||
|
|
static unsigned int
|
||
|
|
srm_startup_irq(unsigned int irq)
|
||
|
|
{
|
||
|
|
srm_enable_irq(irq);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void
|
||
|
|
srm_end_irq(unsigned int irq)
|
||
|
|
{
|
||
|
|
if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
|
||
|
|
srm_enable_irq(irq);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Handle interrupts from the SRM, assuming no additional weirdness. */
|
||
|
|
static struct irq_chip srm_irq_type = {
|
||
|
|
.name = "SRM",
|
||
|
|
.startup = srm_startup_irq,
|
||
|
|
.shutdown = srm_disable_irq,
|
||
|
|
.enable = srm_enable_irq,
|
||
|
|
.disable = srm_disable_irq,
|
||
|
|
.ack = srm_disable_irq,
|
||
|
|
.end = srm_end_irq,
|
||
|
|
};
|
||
|
|
|
||
|
|
void __init
|
||
|
|
init_srm_irqs(long max, unsigned long ignore_mask)
|
||
|
|
{
|
||
|
|
long i;
|
||
|
|
|
||
|
|
if (NR_IRQS <= 16)
|
||
|
|
return;
|
||
|
|
for (i = 16; i < max; ++i) {
|
||
|
|
if (i < 64 && ((ignore_mask >> i) & 1))
|
||
|
|
continue;
|
||
|
|
irq_desc[i].status = IRQ_DISABLED | IRQ_LEVEL;
|
||
|
|
irq_desc[i].chip = &srm_irq_type;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void
|
||
|
|
srm_device_interrupt(unsigned long vector)
|
||
|
|
{
|
||
|
|
int irq = (vector - 0x800) >> 4;
|
||
|
|
handle_irq(irq);
|
||
|
|
}
|