1
0
mirror of https://github.com/cc65/cc65.git synced 2024-12-24 11:31:31 +00:00

Added support for chained interrupt handlers installed with .condes type 2.

git-svn-id: svn://svn.cc65.org/cc65/trunk@3953 b7a2c559-68d2-44c3-8de9-860c34a00d81
This commit is contained in:
uz 2009-02-22 18:16:13 +00:00
parent 0aea6d28dc
commit 81c7457e04

View File

@ -8,9 +8,10 @@
; ;
.export _exit .export _exit
.import initlib, donelib .import initlib, donelib, callirq
.import push0, callmain, zerobss .import callmain, zerobss
.import MEMTOP, RESTOR, BSOUT, CLRCH .import MEMTOP, RESTOR, BSOUT, CLRCH
.import __INTERRUPTOR_COUNT__
.include "zeropage.inc" .include "zeropage.inc"
.include "../plus4/plus4.inc" .include "../plus4/plus4.inc"
@ -66,9 +67,24 @@ L1: lda sp,x
MemOk: stx sp MemOk: stx sp
sty sp+1 ; set argument stack ptr sty sp+1 ; set argument stack ptr
; If we have IRQ functions, chain our stub into the IRQ vector
lda #<__INTERRUPTOR_COUNT__
beq NoIRQ1
lda IRQVec
ldx IRQVec+1
sta IRQInd+1
stx IRQInd+2
lda #<IRQStub
ldx #>IRQStub
sei
sta IRQVec
stx IRQVec+1
cli
; Call module constructors ; Call module constructors
jsr initlib NoIRQ1: jsr initlib
; Push arguments and call main() ; Push arguments and call main()
@ -79,9 +95,21 @@ MemOk: stx sp
_exit: pha ; Save the return code on stack _exit: pha ; Save the return code on stack
jsr donelib ; Run module destructors jsr donelib ; Run module destructors
; Reset the IRQ vector if we chained it.
pha ; Save the return code on stack
lda #<__INTERRUPTOR_COUNT__
beq NoIRQ2
lda IRQInd+1
ldx IRQInd+2
sei
sta IRQVec
stx IRQVec+1
cli
; Copy back the zero page stuff ; Copy back the zero page stuff
ldx #zpspace-1 NoIRQ2: ldx #zpspace-1
L2: lda zpsave,x L2: lda zpsave,x
sta sp,x sta sp,x
dex dex
@ -101,6 +129,20 @@ L2: lda zpsave,x
jmp RESTOR jmp RESTOR
; ------------------------------------------------------------------------
; The IRQ vector jumps here, if condes routines are defined with type 2.
IRQStub:
cld ; Just to be sure
jsr callirq ; Call the functions
jmp IRQInd ; Jump to the saved IRQ vector
; ------------------------------------------------------------------------
; Data
.data
IRQInd: jmp $0000
.segment "ZPSAVE" .segment "ZPSAVE"