A2osX/SYS/KERNEL.S.CORE.txt
2021-02-17 17:15:43 +01:00

653 lines
12 KiB
Plaintext
Raw Blame History

This file contains invisible Unicode characters

This file contains invisible Unicode characters that are indistinguishable to humans but may be processed differently by a computer. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.

NEW
AUTO 3,1
*--------------------------------------
CORE.Run ldx #1
bra .80 Skip PS0
.1 stx CORE.PSIndex
lda PS.Table.hPS,x
beq .8
jsr K.GetMemPtr
>STYA pPs
lda (pPS) get S.PS.F
* bit #S.PS.F.HOLD Waiting for Another Task to Terminate?
* beq .2
bpl .2
ldy #S.PS.CPID
lda (pPS),y
jsr CORE.GetPS
bcc .8 yes, still running....
lda (pPS) get S.PS.F again
eor #S.PS.F.HOLD unmark as HOLD
sta (pPS)
.2 jsr CORE.PSSelect Restore ZP & Ptrs
.3 jsr CORE.PSExec INIT/RUN/QUIT/RESUME
dec IRQ.InKernel
bcc .4 INIT/RUN Exit ?
jsr CORE.UpdateParentPS
ldy #S.PS.S
lda #S.PS.S.QUIT
sta (pPS),y
bra .3 try executing QUIT now...
.4 lda (pPS)
bit #S.PS.F.SLEEP
bne .7
ldy #S.PS.S
lda (pPS),y
bne .5
lda #S.PS.S.RUN go from INIT to RUN
sta (pPS),y
bra .7
.5 cmp #S.PS.S.QUIT
bne .7
>PUSHBI 2
ldy #S.PS.PID
lda (pPS),y
cmp #1 INITD ?
bne .6
jmp CORE.Quit
.6 >SYSCALL2 Kill
bra .8
.7 jsr CORE.PSLeave Save ZP & Ptrs
.8 ldx CORE.PSIndex
inx
.80 cpx CORE.PSCount
bne .1
*--------------------------------------
CORE.Events jsr CORE.GetEvents
bcs .4 CS=no event
jsr CORE.Dispatch
bcc .4 CC=All Events Dispatched
lda PS.Table.PID Select PS0
jsr K.GetMemPtr
>STYA pPs
>LDYAI K.STACKTOP
>STYA pStack
lda #Evt.Table
sta pEvent
.1 lda (pEvent)
beq .3
bmi .2 Ignore & Discard any timer event
* jsr CORE.DumpEvent
.2 jsr CORE.DestroyEvent
.3 lda pEvent
clc
adc #S.EVT
sta pEvent
lda CORE.EvtCount
bne .1
*--------------------------------------
.4 bit OPENAPPLE
bpl .8
lda KBD
bpl .8
cmp #"0"
bcc .8
cmp #"9"+1
bcs .8
sta KBDSTROBE
and #$0F
tax
lda A2osX.SCRNDEVS,x Get DevID
beq .8 No device claimed this screen
cmp A2osX.ASCREEN Same as active screen...nothing to do
beq .8
>PUSHA
>PUSHBI IOCTL.CONTROL request
>PUSHWZ Param
>SYSCALL2 IOCTL
.8 jmp CORE.Run
*--------------------------------------
CORE.Quit php
sei
jsr CORE.IRQ.None.Off
plp
lda IRQ.INTNUM
sta K.MLI.PARAMS+1
>MLICALL MLIDEALLOCIRQ
ldx #5
.1 stz K.MLI.PARAMS+1,x
dex
bpl .1
lda #4
ldx #MLIQUIT
jmp GP.MLICall
*--------------------------------------
CORE.UpdateParentPS
tax save RC From INIT or RUN
ldy #S.PS.PPID Notify Parent Process for exit code...
lda (pPS),y
beq .8 no parent process
jsr CORE.GetPSByID X unmodified
bcs .8 parent is dead.....skipping...
>STYA ZPPtr1
lda (ZPPtr1) Parent PS is HOLD?
bit #S.PS.F.HOLD
beq .8 no...
ldy #S.PS.CPID
lda (ZPPtr1),y
dey #S.PS.PID
cmp (pPS),y
bne .8 Hold, but not waiting this PS
txa waiting for this PS to terminate....
ldy #S.PS.RC give it RC
sta (ZPPtr1),y
lda (ZPPtr1)
eor #S.PS.F.HOLD release Parent PS HOLD...
sta (ZPPtr1)
* clc
.8 rts
*--------------------------------------
* CORE.GetEvents :
* IN :
* OUT :
* CS = no event, A = ERROR
* CC * event in YA
* (pEvent)
*--------------------------------------
CORE.GetEvents lda #Evt.Table
sta pEvent point to start of event list
stz CORE.EvtCount reset Size
bit A2osX.IRQMode do we have IRQ enabled for Ticks ?
bpl .1 no, regular poll
lda IRQ.Tick a Tick ?
beq .8 no, no event
dec IRQ.Tick
bra .2
.1 lda VBL get VLINE status
tax
eor CORE.VBLState
bpl .8 no change,no tick
txa
sta CORE.VBLState save new
bpl .8 Up2down transition,no tick
.2 lda #0
dec CORE.TickSec
bne .3 not yet One Sec
lda IRQ.Mode
eor #$C0
sta IRQ.Mode
ldx A2osX.ASCREEN
cpx #3 devID 3 is /DEV/CONSOLE
bne .22
sta SYS.BASL0+38
.22 ldx CORE.TickPerSec
stx CORE.TickSec
lda #S.EVT.F.T1SEC
bra .4 Force Resync T1 & T10...
.3 dec CORE.Tick10t
bne .6
.4 inc DevMgr.Timer
inc A2osX.TIMER16
bne .5
inc A2osX.TIMER16+1
.5 ldx CORE.TickPer10t
stx CORE.Tick10t
ora #S.EVT.F.T10TH
.6 tax Finally, do we have an event ?
beq .8 no....
sta (pEvent)
inc CORE.EvtCount Add one event to Queue
* lda pEvent
* clc
* adc #S.EVT
* sta pEvent if CS, EVT queue full!!! ($100)
* MORE EVENT PROCESSING HERE
.8 lda CORE.EvtCount if 0, exit with CS (from cmp), and A=0 "no event"
beq .9
clc
rts
.9 sec
rts
*--------------------------------------
* CORE.Dispatch
* IN:
* OUT:
* CS: Not Dispatched
* CC: Event Cleared
*--------------------------------------
CORE.Dispatch ldx #1 skip PS0
bra .80
.1 stx CORE.PSIndex
lda PS.Table.hPS,x
beq .5
jsr K.GetMemPtr
>STYA pPS
lda (pPS)
bit #S.PS.F.EVENT Accept Events ?
beq .5
ldy #S.PS.S
lda (pPS),y
cmp #S.PS.S.RUN
bne .5
lda #S.PS.S.DOEVENT Flag this PS for IRQ Mgr
sta (pPS),y
jsr CORE.PSSelect
lda #Evt.Table
sta pEvent Select first event in list
lda CORE.EvtCount
sta CORE.EvtIndex
.2 lda (pEvent) Empty event, select next
beq .3
ldx #S.PS.S.DOEVENT
jsr CORE.PSExecX
dec IRQ.InKernel
bcs .3 not for this PS, try next event in list
jsr CORE.DestroyEvent this PS handled the EVT, destroy it...
lda CORE.EvtCount
beq .4 no more event, exit
.3 dec CORE.EvtIndex
beq .4 all EVT submitted to this PS, try other PS
lda pEvent try next EVT to this PS
clc
adc #S.EVT
sta pEvent
bra .2
.4 ldy #S.PS.S
lda #S.PS.S.RUN
sta (pPS),y
jsr CORE.PSLeave
.5 ldx CORE.PSIndex
inx
.80 cpx CORE.PSCount
bne .1
* sec
rts
*--------------------------------------
* X unmodified
*--------------------------------------
CORE.GetPSByID jsr CORE.GetPS
bcs CORE.GetPS.RTS
lda PS.TABLE.hPS,y
jmp K.GetMemPtr
*--------------------------------------
* X,A unmodified
*--------------------------------------
CORE.GetPS tay
beq CORE.GetPS.8 PS0 requested
ldy #0
bra .2 Skip PS0
.1 cmp PS.Table.PID,y
beq CORE.GetPS.8
.2 iny
cpy CORE.PSCount
bne .1
.9 lda #E.NSP
* sec
rts
CORE.GetPS.8
clc
CORE.GetPS.RTS rts
*--------------------------------------
*CORE.DumpEvent ldy #S.EVT-1
*.1 >PUSHB (pEvent),y
* dey
* bpl .1
* >LDYAI .2
* jmp K.printf
*.2 .AZ "!Evt:F=%b,Dev=$%h,LO=$%h,HI=$%h,W1=$%H,W2=$%H\n"
*--------------------------------------
CORE.DestroyEvent
lda (pEvent)
beq .9
bit #S.EVT.F.hMEM1
beq .1
pha
ldy #S.EVT.B1
lda (pEvent),y
jsr K.FreeMem
pla
.1 bit #S.EVT.F.hMEM2
beq .2
ldy #S.EVT.B2
lda (pEvent),y
jsr K.FreeMem
.2 lda #0
sta (pEvent)
dec CORE.EvtCount
.9 rts
*--------------------------------------
CORE.PSSelect ldy #S.PS.ZP.CODE+PSCTX.SIZE-1
ldx #PSCTX.SIZE-1
.1 lda (pPS),y
sta pCode,x
dey
dex
bpl .1
rts
*--------------------------------------
CORE.PSLeave ldx #PSCTX.SIZE-1
ldy #S.PS.ZP.CODE+PSCTX.SIZE-1
.1 lda pCode,x
sta (pPS),y
dey
dex
bpl .1
rts
*--------------------------------------
CORE.PSExec lda (pPS)
bit #S.PS.F.SLEEP
bne CORE.PSResume
ldy #S.PS.S
lda (pPS),y
tax
CORE.PSExecX lda pCode+1
pha
lda pCode
pha
php
sei
inc IRQ.InKernel
rti
*--------------------------------------
CORE.PSResume sei
eor #S.PS.F.SLEEP unmark as SLEEP
sta (pPS)
>PULLA Get !BC
tax
beq .2
.1 >PULLA
pha
inx
bne .1
.2 ldy #S.PS.PC+1
lda (pPS),y
pha
dey #S.PS.PC
lda (pPS),y
pha
dey #S.PS.P
lda (pPS),y
pha
dey #S.PS.Y
lda (pPS),y
pha
dey #S.PS.X
lda (pPS),y
tax
dey #S.PS.A
lda (pPS),y
ply
inc IRQ.InKernel
rti
*--------------------------------------
GP.RomCall.JmpX jmp (.1-FPU.FADD,x)
*--------------------------------------
* http://www.txbobsc.com/scsc/scdocumentor/E7A0.html
*--------------------------------------
.1 .DA $E7C1 FADDT
.DA $E7AA FSUBT
.DA $E987 FMULTT.1
.DA $EA6B FDIVT+2
.DA $EE97 FPWRT
.DA $E941 LOG
.DA $EE8D SQR
.DA $EF09 EXP
.DA $EFEA COS
.DA $EFF1 SIN
.DA $F03A TAN
.DA $F09E ATN
*--------------------------------------
.DA $E9E3 LOAD.ARG.FROM.YA
.DA $EAF9 LOAD.FAC.FROM.YA
.DA $EB27 SETFOR (GETFAC)
.DA $EBB2 FCOMP (Y,A with FAC)
.DA $E82E NORMALIZE.FAC.2 (L->F)
.DA $EBF2 QINT (F->L)
.DA $EC4A FIN AToF
.DA $ED36 FOUT.1 PrintF
*--------------------------------------
CORE.VBLState .BS 1
CORE.TickPerSec .BS 1
CORE.TickPer10t .BS 1
CORE.TickSec .BS 1
CORE.Tick10t .BS 1
CORE.CPUStatCnt .DA #100
CORE.LastPSID .DA #0
*--------------------------------------
CORE.EvtIndex .BS 1
CORE.EvtCount .BS 1
*--------------------------------------
* Called by :
* - Kernel IRQ Manager (AuxLC)
* - ProDOS IRQ Manager (GP)
*--------------------------------------
CORE.IRQ.IIGS lda IO.IIGS.INTFLAG
and #$08
beq CORE.IRQ.DEV
stz IO.IIGS.CLRVBLINT
bra CORE.IRQ.Switch
*--------------------------------------
CORE.IRQ.TCLOCK ldy IRQ.n0
lda $c080,y
and #$20
beq CORE.IRQ.DEV
lda $c088,y
lda $c080,y
bra CORE.IRQ.Switch
*--------------------------------------
CORE.IRQ.MOUSE jsr $FFFF SELF MODIFIED,SERVEMOUSE
bcs CORE.IRQ.DEV Not From Mouse
ldx IRQ.0n
lda MOUSESTSx,x
and #MOUSESTSx.INTVBL IRQ was caused by VBL ?
beq CORE.IRQ.DEV
ldx CORE.IRQ.MOUSE.2+2 $Cn
ldy IRQ.n0
CORE.IRQ.MOUSE.2
jsr $FFFF SELF MODIFIED,READMOUSE
*--------------------------------------
CORE.IRQ.Switch inc IRQ.Tick
dec CORE.CPUStatCnt
bne .2
lda #100
sta CORE.CPUStatCnt
ldx #K.PS.MAX-1
.1 lda PS.Table.Hits,x
stz PS.Table.Hits,x
sta PS.Table.Stats,x
dex
bpl .1
.2 lda IRQ.InKernel
bpl .3
inc PS.Table.Hits
.9 clv
clc
rts
.3 ldx CORE.PSIndex
inc PS.Table.Hits,x
bit A2osX.F A2osX.F.PMODE .EQ %01000000
bvc .8
ldy #S.PS.S
lda (pPS),y
eor #S.PS.S.RUN
bne .9
lda IRQ.InLib
bmi .9 we are in LIB, no switching
.8 clc exit with V flag set
rts
*--------------------------------------
CORE.IRQ.DEV ldx #0
.1 lda IRQ.Vectors+1,x
beq .9
sta .10+2
lda IRQ.Vectors,x
sta .10+1
phx
.10 jsr $ffff SELF MODIFIED
plx
bcc .8 CC, IRQ cleared by device
.2 inx
inx
.3 cpx #K.IRQDEV.MAX*2
bne .1
.9 sec
.8 clv clear V (no task switching)
rts
*--------------------------------------
CORE.IRQ.IIGS.Off
lda #$08
trb IO.IIGS.INTEN
rts
*--------------------------------------
CORE.IRQ.TCLOCK.Off
ldx IRQ.n0
stz $c080,x
lda $c088,x
lda $c080,x
ldx IRQ.0n
sta CLRPAGE2
stz $478,x
stz $7f8,x
sta SETPAGE2
stz $478,x
stz $7f8,x
rts
*--------------------------------------
CORE.IRQ.MOUSE.Off
ldy CORE.IRQ.MOUSE.Off.1+2 Cn
ldy IRQ.n0
lda #0
CORE.IRQ.MOUSE.Off.1
jmp $ffff SELF MODIFIED
CORE.IRQ.None.Off
rts
*--------------------------------------
IRQ.InKernel .BS 1
IRQ.InLib .BS 1
IRQ.Skip .BS 1
IRQ.IntNum .BS 1
IRQ.n0 .BS 1
IRQ.0n .BS 1
IRQ.Mode .BS 1
IRQ.Tick .BS 1
*--------------------------------------
IRQ.Vectors .BS K.IRQDEV.MAX*2
*--------------------------------------
MAN
SAVE usr/src/sys/kernel.s.core
LOAD usr/src/sys/kernel.s
ASM