Guest User

Z80 Motherboard Task Switcher

a guest
Jun 17th, 2013
208
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. NMI_Task_Switcher:
  2.   INCLUDE "PUSH_ALL.asm"
  3.  
  4.   ;LD IY, _KRNL_out_byte_std_RS232
  5.   ;LD C, 'I'
  6.   ;RST 10h
  7.  
  8.   LD A, (TASK_SCHEDULE.NMI_RUNNING_FLAG)
  9.   CP A, 0
  10.   JP NZ, .nmi_already_running
  11.  
  12.   LD A, 1
  13.   LD (TASK_SCHEDULE.NMI_RUNNING_FLAG), A
  14.  
  15.   LD A, (TASK_SCHEDULE.ENABLE_TASK_SWITCHING)
  16.   CP A, 0
  17.   JP Z, .task_switching_disabled
  18.  
  19.   LD A, (TASK_SCHEDULE.ATOMIC_FLAGS)
  20.   CP A, 0
  21.   JP Z, .task_switching_enabled
  22.   LD A, 2
  23.   LD (TASK_SCHEDULE.ATOMIC_FLAGS), A
  24.   JP .task_switching_disabled
  25.  
  26.   .task_switching_enabled:
  27.     ;Schritt 1: PROCESS_LIST-Pointer des aktuellen Prozesses berechnen
  28.     LD IX, PROCESS_LIST
  29.    
  30.     ;PID * 12 aufaddieren
  31.     LD A, (TASK_SCHEDULE.THISPROCESS_PID)
  32.     LD H, 0
  33.     LD L, A
  34.     EX DE, HL
  35.     LD HL, 0
  36.     ADD HL, DE
  37.     ADD HL, DE
  38.     ADD HL, DE
  39.     ADD HL, HL
  40.     ADD HL, HL
  41.     EX DE, HL
  42.     ADD IX, DE
  43.    
  44.     LD A, (TASK_SCHEDULE.THISPROCESS_PID)
  45.     LD E, A
  46.    
  47.     ;Schritt 2: Stackpointer sichern
  48.     LD HL, 0
  49.     ADD HL, SP ;Stackpointer irgendwie nach HL bekommen.
  50.     LD (IX + 1), L
  51.     LD (IX + 2), H
  52.    
  53.     ;Schritt 3: Neuen Prozess suchen
  54.     .p_searchloop:
  55.       ;PID und Prozessstruktur-Pointer auf den nächsten Prozess der Liste setzen
  56.       LD BC, 12
  57.       ADD IX, BC
  58.       INC E
  59.      
  60.       ;Prüfen, ob der Prozess noch im Maximum liegt
  61.       LD A, (TASK_SCHEDULE.MAX_PID)
  62.       CP A, E
  63.       JP NC, .p_searchloop_under_max_pid
  64.         LD E, 0 ;ansonsten zurück auf Prozess 0
  65.       .p_searchloop_under_max_pid:
  66.       LD A, E
  67.       CP A, 0
  68.       JP NZ, .p_searchloop_no_IX_reset
  69.         LD IX, PROCESS_LIST
  70.       .p_searchloop_no_IX_reset:
  71.      
  72.       ;Prüfen, ob aktuell gewählter Prozess CPU-Zeit benötigt
  73.       LD A, (IX + 0)
  74.       AND A, 0000 0011b
  75.       CP A, 0000 0001b
  76.     JP NZ, .p_searchloop
  77.    
  78.     ;Schritt 4: Neue PID merken
  79.     LD A, E
  80.     LD (TASK_SCHEDULE.THISPROCESS_PID), A
  81.    
  82.     ;Schritt 5: Speicherkonfiguration wiederherstellen
  83.     LD B, 64
  84.     LD D, (IX + 5)
  85.     LD C, 0
  86.     OUT (C), D
  87.     LD B, 128
  88.     LD D, (IX + 6)
  89.     LD C, 0
  90.     OUT (C), D
  91.     LD B, 192
  92.     LD D, (IX + 7)
  93.     LD C, 0
  94.     OUT (C), D
  95.    
  96.     ;Schritt 6: Stack wiederherstellen
  97.     LD L, (IX + 1)
  98.     LD H, (IX + 2)
  99.     LD SP, HL
  100.    
  101.   .task_switching_disabled:
  102.  
  103.   LD A, 0
  104.   LD (TASK_SCHEDULE.NMI_RUNNING_FLAG), A
  105.  
  106.   .nmi_already_running:
  107.   INCLUDE "POP_ALL.asm"
  108. RETN
Advertisement
Add Comment
Please, Sign In to add comment