|
@@ -1,33 +1,36 @@
|
|
/*
|
|
/*
|
|
- * arch/s390/kernel/s390_ext.c
|
|
|
|
- *
|
|
|
|
- * S390 version
|
|
|
|
- * Copyright (C) 1999,2000 IBM Deutschland Entwicklung GmbH, IBM Corporation
|
|
|
|
- * Author(s): Holger Smolinski (Holger.Smolinski@de.ibm.com),
|
|
|
|
- * Martin Schwidefsky (schwidefsky@de.ibm.com)
|
|
|
|
|
|
+ * Copyright IBM Corp. 1999,2010
|
|
|
|
+ * Author(s): Holger Smolinski <Holger.Smolinski@de.ibm.com>,
|
|
|
|
+ * Martin Schwidefsky <schwidefsky@de.ibm.com>,
|
|
*/
|
|
*/
|
|
|
|
|
|
|
|
+#include <linux/kernel_stat.h>
|
|
|
|
+#include <linux/interrupt.h>
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/kernel.h>
|
|
-#include <linux/slab.h>
|
|
|
|
#include <linux/ftrace.h>
|
|
#include <linux/ftrace.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/errno.h>
|
|
-#include <linux/kernel_stat.h>
|
|
|
|
-#include <linux/interrupt.h>
|
|
|
|
-#include <asm/cputime.h>
|
|
|
|
-#include <asm/lowcore.h>
|
|
|
|
|
|
+#include <linux/slab.h>
|
|
#include <asm/s390_ext.h>
|
|
#include <asm/s390_ext.h>
|
|
#include <asm/irq_regs.h>
|
|
#include <asm/irq_regs.h>
|
|
|
|
+#include <asm/cputime.h>
|
|
|
|
+#include <asm/lowcore.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/irq.h>
|
|
#include "entry.h"
|
|
#include "entry.h"
|
|
|
|
|
|
|
|
+struct ext_int_info {
|
|
|
|
+ struct ext_int_info *next;
|
|
|
|
+ ext_int_handler_t handler;
|
|
|
|
+ __u16 code;
|
|
|
|
+};
|
|
|
|
+
|
|
/*
|
|
/*
|
|
* ext_int_hash[index] is the start of the list for all external interrupts
|
|
* ext_int_hash[index] is the start of the list for all external interrupts
|
|
* that hash to this index. With the current set of external interrupts
|
|
* that hash to this index. With the current set of external interrupts
|
|
* (0x1202 external call, 0x1004 cpu timer, 0x2401 hwc console, 0x4000
|
|
* (0x1202 external call, 0x1004 cpu timer, 0x2401 hwc console, 0x4000
|
|
* iucv and 0x2603 pfault) this is always the first element.
|
|
* iucv and 0x2603 pfault) this is always the first element.
|
|
*/
|
|
*/
|
|
-ext_int_info_t *ext_int_hash[256] = { NULL, };
|
|
|
|
|
|
+static struct ext_int_info *ext_int_hash[256];
|
|
|
|
|
|
static inline int ext_hash(__u16 code)
|
|
static inline int ext_hash(__u16 code)
|
|
{
|
|
{
|
|
@@ -36,90 +39,53 @@ static inline int ext_hash(__u16 code)
|
|
|
|
|
|
int register_external_interrupt(__u16 code, ext_int_handler_t handler)
|
|
int register_external_interrupt(__u16 code, ext_int_handler_t handler)
|
|
{
|
|
{
|
|
- ext_int_info_t *p;
|
|
|
|
- int index;
|
|
|
|
-
|
|
|
|
- p = kmalloc(sizeof(ext_int_info_t), GFP_ATOMIC);
|
|
|
|
- if (p == NULL)
|
|
|
|
- return -ENOMEM;
|
|
|
|
- p->code = code;
|
|
|
|
- p->handler = handler;
|
|
|
|
- index = ext_hash(code);
|
|
|
|
- p->next = ext_int_hash[index];
|
|
|
|
- ext_int_hash[index] = p;
|
|
|
|
- return 0;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-int register_early_external_interrupt(__u16 code, ext_int_handler_t handler,
|
|
|
|
- ext_int_info_t *p)
|
|
|
|
-{
|
|
|
|
- int index;
|
|
|
|
|
|
+ struct ext_int_info *p;
|
|
|
|
+ int index;
|
|
|
|
|
|
- if (p == NULL)
|
|
|
|
- return -EINVAL;
|
|
|
|
- p->code = code;
|
|
|
|
- p->handler = handler;
|
|
|
|
|
|
+ p = kmalloc(sizeof(*p), GFP_ATOMIC);
|
|
|
|
+ if (!p)
|
|
|
|
+ return -ENOMEM;
|
|
|
|
+ p->code = code;
|
|
|
|
+ p->handler = handler;
|
|
index = ext_hash(code);
|
|
index = ext_hash(code);
|
|
- p->next = ext_int_hash[index];
|
|
|
|
- ext_int_hash[index] = p;
|
|
|
|
- return 0;
|
|
|
|
|
|
+ p->next = ext_int_hash[index];
|
|
|
|
+ ext_int_hash[index] = p;
|
|
|
|
+ return 0;
|
|
}
|
|
}
|
|
|
|
+EXPORT_SYMBOL(register_external_interrupt);
|
|
|
|
|
|
int unregister_external_interrupt(__u16 code, ext_int_handler_t handler)
|
|
int unregister_external_interrupt(__u16 code, ext_int_handler_t handler)
|
|
{
|
|
{
|
|
- ext_int_info_t *p, *q;
|
|
|
|
- int index;
|
|
|
|
-
|
|
|
|
- index = ext_hash(code);
|
|
|
|
- q = NULL;
|
|
|
|
- p = ext_int_hash[index];
|
|
|
|
- while (p != NULL) {
|
|
|
|
- if (p->code == code && p->handler == handler)
|
|
|
|
- break;
|
|
|
|
- q = p;
|
|
|
|
- p = p->next;
|
|
|
|
- }
|
|
|
|
- if (p == NULL)
|
|
|
|
- return -ENOENT;
|
|
|
|
- if (q != NULL)
|
|
|
|
- q->next = p->next;
|
|
|
|
- else
|
|
|
|
- ext_int_hash[index] = p->next;
|
|
|
|
- kfree(p);
|
|
|
|
- return 0;
|
|
|
|
-}
|
|
|
|
-
|
|
|
|
-int unregister_early_external_interrupt(__u16 code, ext_int_handler_t handler,
|
|
|
|
- ext_int_info_t *p)
|
|
|
|
-{
|
|
|
|
- ext_int_info_t *q;
|
|
|
|
|
|
+ struct ext_int_info *p, *q;
|
|
int index;
|
|
int index;
|
|
|
|
|
|
- if (p == NULL || p->code != code || p->handler != handler)
|
|
|
|
- return -EINVAL;
|
|
|
|
index = ext_hash(code);
|
|
index = ext_hash(code);
|
|
- q = ext_int_hash[index];
|
|
|
|
- if (p != q) {
|
|
|
|
- while (q != NULL) {
|
|
|
|
- if (q->next == p)
|
|
|
|
- break;
|
|
|
|
- q = q->next;
|
|
|
|
- }
|
|
|
|
- if (q == NULL)
|
|
|
|
- return -ENOENT;
|
|
|
|
|
|
+ q = NULL;
|
|
|
|
+ p = ext_int_hash[index];
|
|
|
|
+ while (p) {
|
|
|
|
+ if (p->code == code && p->handler == handler)
|
|
|
|
+ break;
|
|
|
|
+ q = p;
|
|
|
|
+ p = p->next;
|
|
|
|
+ }
|
|
|
|
+ if (!p)
|
|
|
|
+ return -ENOENT;
|
|
|
|
+ if (q)
|
|
q->next = p->next;
|
|
q->next = p->next;
|
|
- } else
|
|
|
|
|
|
+ else
|
|
ext_int_hash[index] = p->next;
|
|
ext_int_hash[index] = p->next;
|
|
|
|
+ kfree(p);
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
+EXPORT_SYMBOL(unregister_external_interrupt);
|
|
|
|
|
|
void __irq_entry do_extint(struct pt_regs *regs, unsigned int ext_int_code,
|
|
void __irq_entry do_extint(struct pt_regs *regs, unsigned int ext_int_code,
|
|
unsigned int param32, unsigned long param64)
|
|
unsigned int param32, unsigned long param64)
|
|
{
|
|
{
|
|
struct pt_regs *old_regs;
|
|
struct pt_regs *old_regs;
|
|
unsigned short code;
|
|
unsigned short code;
|
|
- ext_int_info_t *p;
|
|
|
|
- int index;
|
|
|
|
|
|
+ struct ext_int_info *p;
|
|
|
|
+ int index;
|
|
|
|
|
|
code = (unsigned short) ext_int_code;
|
|
code = (unsigned short) ext_int_code;
|
|
old_regs = set_irq_regs(regs);
|
|
old_regs = set_irq_regs(regs);
|
|
@@ -132,7 +98,7 @@ void __irq_entry do_extint(struct pt_regs *regs, unsigned int ext_int_code,
|
|
kstat_cpu(smp_processor_id()).irqs[EXTERNAL_INTERRUPT]++;
|
|
kstat_cpu(smp_processor_id()).irqs[EXTERNAL_INTERRUPT]++;
|
|
if (code != 0x1004)
|
|
if (code != 0x1004)
|
|
__get_cpu_var(s390_idle).nohz_delay = 1;
|
|
__get_cpu_var(s390_idle).nohz_delay = 1;
|
|
- index = ext_hash(code);
|
|
|
|
|
|
+ index = ext_hash(code);
|
|
for (p = ext_int_hash[index]; p; p = p->next) {
|
|
for (p = ext_int_hash[index]; p; p = p->next) {
|
|
if (likely(p->code == code))
|
|
if (likely(p->code == code))
|
|
p->handler(ext_int_code, param32, param64);
|
|
p->handler(ext_int_code, param32, param64);
|
|
@@ -140,6 +106,3 @@ void __irq_entry do_extint(struct pt_regs *regs, unsigned int ext_int_code,
|
|
irq_exit();
|
|
irq_exit();
|
|
set_irq_regs(old_regs);
|
|
set_irq_regs(old_regs);
|
|
}
|
|
}
|
|
-
|
|
|
|
-EXPORT_SYMBOL(register_external_interrupt);
|
|
|
|
-EXPORT_SYMBOL(unregister_external_interrupt);
|
|
|