361 lines
12 KiB
ArmAsm
361 lines
12 KiB
ArmAsm
/*
|
|
* Copyright (c) 1993, 1994 Charles Hannum. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by Charles Hannum.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* $Id: vector.s,v 1.17 1994/04/18 22:23:32 mycroft Exp $
|
|
*/
|
|
|
|
#include <i386/isa/icu.h>
|
|
#include <i386/isa/isa.h>
|
|
|
|
/*
|
|
* These macros are fairly self explanatory. If SPECIAL_MASK_MODE is defined,
|
|
* we try to take advantage of the ICU's `special mask mode' by only EOIing
|
|
* the interrupts on return. This avoids the requirement of masking and
|
|
* unmasking. We can't do this without special mask mode, because the ICU
|
|
* would also hold interrupts that it thinks are of lower priority.
|
|
*
|
|
* Many machines do not support special mask mode, so by default we don't try
|
|
* to use it.
|
|
*/
|
|
|
|
#define IRQ_BIT(irq_num) (1 << ((irq_num) % 8))
|
|
#define IRQ_BYTE(irq_num) ((irq_num) / 8)
|
|
|
|
#ifdef SPECIAL_MASK_MODE
|
|
|
|
#define ENABLE_ICU1(irq_num)
|
|
#define ENABLE_ICU1_AND_2(irqnum) \
|
|
movb $(0x60|2),%al /* specific EOI for IRQ2 */ ;\
|
|
outb %al,$IO_ICU1
|
|
#define MASK(irq_num, icu)
|
|
#define UNMASK(irq_num, icu) \
|
|
movb $(0x60|(irq_num%8)),%al /* specific EOI */ ;\
|
|
outb %al,$icu
|
|
|
|
#else /* SPECIAL_MASK_MODE */
|
|
|
|
#ifndef AUTO_EOI_1
|
|
#define ENABLE_ICU1(irq_num) \
|
|
movb $(0x60|(irq_num%8)),%al /* specific EOI */ ;\
|
|
outb %al,$IO_ICU1
|
|
#else
|
|
#define ENABLE_ICU1(irq_num)
|
|
#endif
|
|
|
|
#ifndef AUTO_EOI_2
|
|
#define ENABLE_ICU1_AND_2(irq_num) \
|
|
movb $(0x60|(irq_num%8)),%al /* specific EOI */ ;\
|
|
outb %al,$IO_ICU2 /* do the second ICU first */ ;\
|
|
movb $(0x60|2),%al /* specific EOI for IRQ2 */ ;\
|
|
outb %al,$IO_ICU1
|
|
#else
|
|
#define ENABLE_ICU1_AND_2(irq_num)
|
|
#endif
|
|
|
|
#define MASK(irq_num, icu) \
|
|
movb _imen + IRQ_BYTE(irq_num),%al ;\
|
|
orb $IRQ_BIT(irq_num),%al ;\
|
|
movb %al,_imen + IRQ_BYTE(irq_num) ;\
|
|
FASTER_NOP ;\
|
|
outb %al,$(icu+1)
|
|
|
|
#define UNMASK(irq_num, icu) \
|
|
cli ;\
|
|
movb _imen + IRQ_BYTE(irq_num),%al ;\
|
|
andb $~IRQ_BIT(irq_num),%al ;\
|
|
movb %al,_imen + IRQ_BYTE(irq_num) ;\
|
|
FASTER_NOP ;\
|
|
outb %al,$(icu+1) ;\
|
|
sti
|
|
|
|
#endif /* SPECIAL_MASK_MODE */
|
|
|
|
/*
|
|
* Macros for interrupt entry, call to handler, and exit.
|
|
*
|
|
* XXX
|
|
* The interrupt frame is set up to look like a trap frame. This may be a
|
|
* waste. The only handler which needs a frame is the clock handler, and it
|
|
* only needs a few bits. doreti() needs a trap frame for handling ASTs, but
|
|
* it could easily convert the frame on demand.
|
|
*
|
|
* The direct costs of setting up a trap frame are two pushl's (error code and
|
|
* trap number), an addl to get rid of these, and pushing and popping the
|
|
* callee-saved registers %esi, %edi, %ebx, and %ebp twice.
|
|
*
|
|
* If the interrupt frame is made more flexible, INTR can push %eax first and
|
|
* decide the ipending case with less overhead, e.g., by avoiding loading the
|
|
* segment registers.
|
|
*
|
|
* XXX
|
|
* Should we do a cld on every system entry to avoid the requirement for
|
|
* scattered cld's?
|
|
*/
|
|
|
|
.globl _isa_strayintr
|
|
|
|
/*
|
|
* Handle exceptions on vectors we don't expect.
|
|
*/
|
|
IDTVEC(wild)
|
|
sti
|
|
pushl $0 /* fake interrupt frame */
|
|
pushl $0
|
|
INTRENTRY
|
|
pushl $-1
|
|
call _isa_strayintr
|
|
addl $4,%esp
|
|
INTRFASTEXIT
|
|
|
|
/*
|
|
* Fast vectors.
|
|
*
|
|
* Like a normal vector, but run with all interrupts off. The handler is
|
|
* expected to be as fast as possible, and is expected to not change the
|
|
* interrupt flag. We pass an argument in like normal vectors, but we assume
|
|
* that a pointer to the frame is never required. There can be only one
|
|
* handler on a fast vector.
|
|
*
|
|
* XXX
|
|
* Note that we assume fast vectors don't do anything that would cause an AST
|
|
* or softintr; if so, it will be deferred until the next clock tick (or
|
|
* possibly sooner).
|
|
*/
|
|
#define FAST(irq_num, icu, enable_icus) \
|
|
IDTVEC(fast/**/irq_num) ;\
|
|
pushl %eax /* save call-used registers */ ;\
|
|
pushl %ecx ;\
|
|
pushl %edx ;\
|
|
pushl %ds ;\
|
|
pushl %es ;\
|
|
movl $KDSEL,%eax ;\
|
|
movl %ax,%ds ;\
|
|
movl %ax,%es ;\
|
|
/* have to do this here because %eax is lost on call */ ;\
|
|
movl _intrhand + (irq_num) * 4,%eax ;\
|
|
incl IH_COUNT(%eax) ;\
|
|
pushl IH_ARG(%eax) ;\
|
|
call IH_FUN(%eax) ;\
|
|
enable_icus(irq_num) ;\
|
|
addl $4,%esp ;\
|
|
incl _cnt+V_INTR /* statistical info */ ;\
|
|
popl %es ;\
|
|
popl %ds ;\
|
|
popl %edx ;\
|
|
popl %ecx ;\
|
|
popl %eax ;\
|
|
iret
|
|
|
|
FAST(0, IO_ICU1, ENABLE_ICU1)
|
|
FAST(1, IO_ICU1, ENABLE_ICU1)
|
|
FAST(2, IO_ICU1, ENABLE_ICU1)
|
|
FAST(3, IO_ICU1, ENABLE_ICU1)
|
|
FAST(4, IO_ICU1, ENABLE_ICU1)
|
|
FAST(5, IO_ICU1, ENABLE_ICU1)
|
|
FAST(6, IO_ICU1, ENABLE_ICU1)
|
|
FAST(7, IO_ICU1, ENABLE_ICU1)
|
|
FAST(8, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
FAST(9, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
FAST(10, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
FAST(11, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
FAST(12, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
FAST(13, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
FAST(14, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
FAST(15, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
|
|
/*
|
|
* Normal vectors.
|
|
*
|
|
* We cdr down the intrhand chain, calling each handler with its appropriate
|
|
* argument (0 meaning a pointer to the frame, for clock interrupts).
|
|
*
|
|
* The handler returns one of three values:
|
|
* 0 - This interrupt wasn't for me.
|
|
* 1 - This interrupt was for me.
|
|
* -1 - This interrupt might have been for me, but I don't know.
|
|
* If there are no handlers, or they all return 0, we flags it as a `stray'
|
|
* interrupt. On a system with level-triggered interrupts, we could terminate
|
|
* immediately when one of them returns 1; but this is a PC.
|
|
*
|
|
* On exit, we jump to doreti, to process soft interrupts and ASTs.
|
|
*/
|
|
#define INTR(irq_num, icu, enable_icus) \
|
|
IDTVEC(intr/**/irq_num) ;\
|
|
pushl $0 /* dummy error code */ ;\
|
|
pushl $T_ASTFLT /* trap # for doing ASTs */ ;\
|
|
INTRENTRY ;\
|
|
MASK(irq_num, icu) /* mask it in hardware */ ;\
|
|
enable_icus(irq_num) /* and allow other intrs */ ;\
|
|
testb $IRQ_BIT(irq_num),_cpl + IRQ_BYTE(irq_num) ;\
|
|
jnz _Xhold/**/irq_num /* currently masked; hold it */ ;\
|
|
_Xresume/**/irq_num/**/: ;\
|
|
movl _cpl,%eax /* cpl to restore on exit */ ;\
|
|
pushl %eax ;\
|
|
orl _intrmask + (irq_num) * 4,%eax ;\
|
|
movl %eax,_cpl /* add in this intr's mask */ ;\
|
|
sti /* safe to take intrs now */ ;\
|
|
movl _intrhand + (irq_num) * 4,%ebx /* head of chain */ ;\
|
|
testl %ebx,%ebx ;\
|
|
jz _Xstray/**/irq_num /* no handlears; we're stray */ ;\
|
|
STRAY_INITIALIZE ;\
|
|
7: movl IH_ARG(%ebx),%eax /* get handler arg */ ;\
|
|
testl %eax,%eax ;\
|
|
jnz 4f ;\
|
|
movl %esp,%eax /* 0 means frame pointer */ ;\
|
|
4: pushl %eax ;\
|
|
call IH_FUN(%ebx) /* call it */ ;\
|
|
addl $4,%esp /* toss the arg */ ;\
|
|
STRAY_INTEGRATE ;\
|
|
incl IH_COUNT(%ebx) /* count the intrs */ ;\
|
|
movl IH_NEXT(%ebx),%ebx /* next handler in chain */ ;\
|
|
testl %ebx,%ebx ;\
|
|
jnz 7b ;\
|
|
STRAY_TEST ;\
|
|
5: UNMASK(irq_num, icu) /* unmask it in hardware */ ;\
|
|
INTREXIT /* lower spl and do ASTs */ ;\
|
|
IDTVEC(stray/**/irq_num) ;\
|
|
pushl $irq_num ;\
|
|
call _isa_strayintr ;\
|
|
addl $4,%esp ;\
|
|
jmp 5b ;\
|
|
IDTVEC(hold/**/irq_num) ;\
|
|
orb $IRQ_BIT(irq_num),_ipending + IRQ_BYTE(irq_num) ;\
|
|
INTRFASTEXIT
|
|
|
|
#ifdef DEBUG
|
|
#define STRAY_INITIALIZE \
|
|
xorl %esi,%esi /* nobody claimed it yet */
|
|
#define STRAY_INTEGRATE \
|
|
orl %eax,%esi /* maybe he claimed it */
|
|
#define STRAY_TEST \
|
|
testl %esi,%esi /* no more handlers */ ;\
|
|
jz _Xstray/**/irq_num /* nobody claimed it */
|
|
#else
|
|
#define STRAY_INITIALIZE
|
|
#define STRAY_INTEGRATE
|
|
#define STRAY_TEST
|
|
#endif /* DEBUG */
|
|
|
|
INTR(0, IO_ICU1, ENABLE_ICU1)
|
|
INTR(1, IO_ICU1, ENABLE_ICU1)
|
|
INTR(2, IO_ICU1, ENABLE_ICU1)
|
|
INTR(3, IO_ICU1, ENABLE_ICU1)
|
|
INTR(4, IO_ICU1, ENABLE_ICU1)
|
|
INTR(5, IO_ICU1, ENABLE_ICU1)
|
|
INTR(6, IO_ICU1, ENABLE_ICU1)
|
|
INTR(7, IO_ICU1, ENABLE_ICU1)
|
|
INTR(8, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
INTR(9, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
INTR(10, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
INTR(11, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
INTR(12, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
INTR(13, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
INTR(14, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
INTR(15, IO_ICU2, ENABLE_ICU1_AND_2)
|
|
|
|
/*
|
|
* Recursive interrupts.
|
|
*
|
|
* This is a somewhat nasty hack to deal with resuming interrupts from splx().
|
|
* We can't just jump to the resume point, because some handlers require an
|
|
* interrupt frame. Instead, we just recursively interrupt.
|
|
*
|
|
* On entry, %esi contains a pointer to where we need to return. This is a
|
|
* bit faster than a call/ret/jmp to continue the loop.
|
|
*
|
|
* XXX
|
|
* It might be a little faster to build the interrupt frame manually and jump
|
|
* to the resume point. The code would be larger, though.
|
|
*/
|
|
#define RECURSE(irq_num) \
|
|
IDTVEC(recurse/**/irq_num) ;\
|
|
int $(ICU_OFFSET + irq_num) ;\
|
|
jmp %esi
|
|
|
|
RECURSE(0)
|
|
RECURSE(1)
|
|
RECURSE(2)
|
|
RECURSE(3)
|
|
RECURSE(4)
|
|
RECURSE(5)
|
|
RECURSE(6)
|
|
RECURSE(7)
|
|
RECURSE(8)
|
|
RECURSE(9)
|
|
RECURSE(10)
|
|
RECURSE(11)
|
|
RECURSE(12)
|
|
RECURSE(13)
|
|
RECURSE(14)
|
|
RECURSE(15)
|
|
|
|
/*
|
|
* These tables are used by the ISA configuration code.
|
|
*/
|
|
/* interrupt service routine entry points */
|
|
IDTVEC(intr)
|
|
.long _Xintr0, _Xintr1, _Xintr2, _Xintr3, _Xintr4, _Xintr5, _Xintr6
|
|
.long _Xintr7, _Xintr8, _Xintr9, _Xintr10, _Xintr11, _Xintr12
|
|
.long _Xintr13, _Xintr14, _Xintr15
|
|
/* fast interrupt routine entry points */
|
|
IDTVEC(fast)
|
|
.long _Xfast0, _Xfast1, _Xfast2, _Xfast3, _Xfast4, _Xfast5, _Xfast6
|
|
.long _Xfast7, _Xfast8, _Xfast9, _Xfast10, _Xfast11, _Xfast12
|
|
.long _Xfast13, _Xfast14, _Xfast15
|
|
|
|
/*
|
|
* These tables are used by doreti() and spllower().
|
|
*/
|
|
/* resume points for suspended interrupts */
|
|
IDTVEC(resume)
|
|
.long _Xresume0, _Xresume1, _Xresume2, _Xresume3, _Xresume4
|
|
.long _Xresume5, _Xresume6, _Xresume7, _Xresume8, _Xresume9
|
|
.long _Xresume10, _Xresume11, _Xresume12, _Xresume13, _Xresume14
|
|
.long _Xresume15
|
|
/* for soft interrupts */
|
|
.long 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
|
|
.long _Xsofttty, _Xsoftnet, _Xsoftclock
|
|
/* fake interrupts to resume from splx() */
|
|
IDTVEC(recurse)
|
|
.long _Xrecurse0, _Xrecurse1, _Xrecurse2, _Xrecurse3, _Xrecurse4
|
|
.long _Xrecurse5, _Xrecurse6, _Xrecurse7, _Xrecurse8, _Xrecurse9
|
|
.long _Xrecurse10, _Xrecurse11, _Xrecurse12, _Xrecurse13, _Xrecurse14
|
|
.long _Xrecurse15
|
|
/* for soft interrupts */
|
|
.long 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
|
|
.long _Xsofttty, _Xsoftnet, _Xsoftclock
|
|
|
|
/* Some bogus data, to keep vmstat happy, for now. */
|
|
.globl _intrnames, _eintrnames, _intrcnt, _eintrcnt
|
|
_intrnames:
|
|
.long 0
|
|
_eintrnames:
|
|
_intrcnt:
|
|
.long 0
|
|
_eintrcnt:
|