Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- NMI_Task_Switcher:
- INCLUDE "PUSH_ALL.asm"
- ;LD IY, _KRNL_out_byte_std_RS232
- ;LD C, 'I'
- ;RST 10h
- LD A, (TASK_SCHEDULE.NMI_RUNNING_FLAG)
- CP A, 0
- JP NZ, .nmi_already_running
- LD A, 1
- LD (TASK_SCHEDULE.NMI_RUNNING_FLAG), A
- LD A, (TASK_SCHEDULE.ENABLE_TASK_SWITCHING)
- CP A, 0
- JP Z, .task_switching_disabled
- LD A, (TASK_SCHEDULE.ATOMIC_FLAGS)
- CP A, 0
- JP Z, .task_switching_enabled
- LD A, 2
- LD (TASK_SCHEDULE.ATOMIC_FLAGS), A
- JP .task_switching_disabled
- .task_switching_enabled:
- ;Schritt 1: PROCESS_LIST-Pointer des aktuellen Prozesses berechnen
- LD IX, PROCESS_LIST
- ;PID * 12 aufaddieren
- LD A, (TASK_SCHEDULE.THISPROCESS_PID)
- LD H, 0
- LD L, A
- EX DE, HL
- LD HL, 0
- ADD HL, DE
- ADD HL, DE
- ADD HL, DE
- ADD HL, HL
- ADD HL, HL
- EX DE, HL
- ADD IX, DE
- LD A, (TASK_SCHEDULE.THISPROCESS_PID)
- LD E, A
- ;Schritt 2: Stackpointer sichern
- LD HL, 0
- ADD HL, SP ;Stackpointer irgendwie nach HL bekommen.
- LD (IX + 1), L
- LD (IX + 2), H
- ;Schritt 3: Neuen Prozess suchen
- .p_searchloop:
- ;PID und Prozessstruktur-Pointer auf den nächsten Prozess der Liste setzen
- LD BC, 12
- ADD IX, BC
- INC E
- ;Prüfen, ob der Prozess noch im Maximum liegt
- LD A, (TASK_SCHEDULE.MAX_PID)
- CP A, E
- JP NC, .p_searchloop_under_max_pid
- LD E, 0 ;ansonsten zurück auf Prozess 0
- .p_searchloop_under_max_pid:
- LD A, E
- CP A, 0
- JP NZ, .p_searchloop_no_IX_reset
- LD IX, PROCESS_LIST
- .p_searchloop_no_IX_reset:
- ;Prüfen, ob aktuell gewählter Prozess CPU-Zeit benötigt
- LD A, (IX + 0)
- AND A, 0000 0011b
- CP A, 0000 0001b
- JP NZ, .p_searchloop
- ;Schritt 4: Neue PID merken
- LD A, E
- LD (TASK_SCHEDULE.THISPROCESS_PID), A
- ;Schritt 5: Speicherkonfiguration wiederherstellen
- LD B, 64
- LD D, (IX + 5)
- LD C, 0
- OUT (C), D
- LD B, 128
- LD D, (IX + 6)
- LD C, 0
- OUT (C), D
- LD B, 192
- LD D, (IX + 7)
- LD C, 0
- OUT (C), D
- ;Schritt 6: Stack wiederherstellen
- LD L, (IX + 1)
- LD H, (IX + 2)
- LD SP, HL
- .task_switching_disabled:
- LD A, 0
- LD (TASK_SCHEDULE.NMI_RUNNING_FLAG), A
- .nmi_already_running:
- INCLUDE "POP_ALL.asm"
- RETN
Advertisement
Add Comment
Please, Sign In to add comment