351 lines
4.6 KiB
NASM
Executable File
351 lines
4.6 KiB
NASM
Executable File
GLOBAL _cli
|
|
GLOBAL _sti
|
|
GLOBAL picMasterMask
|
|
GLOBAL picSlaveMask
|
|
GLOBAL haltcpu
|
|
GLOBAL _hlt
|
|
|
|
GLOBAL _irq00Handler
|
|
GLOBAL _irq01Handler
|
|
GLOBAL _irq02Handler
|
|
GLOBAL _irq03Handler
|
|
GLOBAL _irq04Handler
|
|
GLOBAL _irq05Handler
|
|
GLOBAL _systemCallsHandler
|
|
|
|
GLOBAL _exception0Handler
|
|
GLOBAL _exception6Handler
|
|
|
|
EXTERN irqDispatcher
|
|
EXTERN exceptionDispatcher
|
|
EXTERN systemCallsDispatcher
|
|
; EXTERN preserveStack
|
|
; EXTERN newStack
|
|
EXTERN changeWindow
|
|
EXTERN updateRSP
|
|
EXTERN nextProcess
|
|
|
|
GLOBAL switchContext
|
|
GLOBAL loadProcess
|
|
GLOBAL _initialize_stack_frame
|
|
GLOBAL _switchContext
|
|
|
|
EXTERN getFPUaddress, getSSEaddress
|
|
|
|
SECTION .text
|
|
|
|
%macro pushState 0
|
|
push rax
|
|
push rbx
|
|
push rcx
|
|
push rdx
|
|
push rbp
|
|
push rdi
|
|
push rsi
|
|
push r8
|
|
push r9
|
|
push r10
|
|
push r11
|
|
push r12
|
|
push r13
|
|
push r14
|
|
push r15
|
|
%endmacro
|
|
|
|
%macro popState 0
|
|
pop r15
|
|
pop r14
|
|
pop r13
|
|
pop r12
|
|
pop r11
|
|
pop r10
|
|
pop r9
|
|
pop r8
|
|
pop rsi
|
|
pop rdi
|
|
pop rbp
|
|
pop rdx
|
|
pop rcx
|
|
pop rbx
|
|
pop rax
|
|
%endmacro
|
|
|
|
%macro irqHandlerMaster 1
|
|
pushState
|
|
fsave [bytesForFPU]
|
|
fxsave [bytesForSSEAligned]
|
|
|
|
mov rdi, %1 ; pasaje de parametro
|
|
call irqDispatcher
|
|
|
|
; signal pic EOI (End of Interrupt)
|
|
mov al, 20h
|
|
out 20h, al
|
|
|
|
fxrstor [bytesForSSEAligned]
|
|
frstor [bytesForFPU]
|
|
popState
|
|
iretq
|
|
%endmacro
|
|
|
|
|
|
%macro exceptionHandler 1
|
|
mov [insPointer], rsp
|
|
push rax
|
|
lea rax, [rsp + 4 * 8]
|
|
mov [rspPointer], rax
|
|
pop rax
|
|
|
|
pushState
|
|
|
|
mov rdi, %1 ; pasaje de parametro
|
|
mov rsi, [insPointer]
|
|
mov rdx, [rspPointer]
|
|
mov rcx, rsp
|
|
call exceptionDispatcher
|
|
|
|
popState
|
|
|
|
iretq
|
|
%endmacro
|
|
|
|
_hlt:
|
|
sti
|
|
hlt
|
|
ret
|
|
|
|
_cli:
|
|
cli
|
|
ret
|
|
|
|
_sti:
|
|
sti
|
|
ret
|
|
|
|
picMasterMask:
|
|
push rbp
|
|
mov rbp, rsp
|
|
mov ax, di
|
|
out 21h,al
|
|
pop rbp
|
|
retn
|
|
|
|
picSlaveMask:
|
|
push rbp
|
|
mov rbp, rsp
|
|
mov ax, di ; ax = mascara de 16 bits
|
|
out 0A1h,al
|
|
pop rbp
|
|
retn
|
|
|
|
; getFPUaddress:
|
|
; push rcx
|
|
; mov ecx, [auxi]
|
|
; mov ecx, 1
|
|
; xor ecx, [auxi]
|
|
; cmp ecx, 0
|
|
; jne .getSecond
|
|
; mov rax, bytesForFPU1
|
|
; jmp .finish
|
|
; .getSecond:
|
|
; mov rax, bytesForFPU2
|
|
; .finish:
|
|
; mov dword [auxi], ecx
|
|
; pop rcx
|
|
; ret
|
|
|
|
; getSSEaddress:
|
|
; push rcx
|
|
; mov ecx, [auxi]
|
|
; cmp ecx, 0
|
|
; jne .getSecond
|
|
; mov rax, bytesForSSEAligned1
|
|
; jmp .finish
|
|
; .getSecond:
|
|
; mov rax, bytesForSSEAligned2
|
|
; .finish:
|
|
; pop rcx
|
|
; ret
|
|
|
|
;8254 Timer (Timer Tick)
|
|
_irq00Handler:
|
|
pushState
|
|
|
|
; mov rsi, rsp
|
|
; and rsp, -16
|
|
; sub rsp, 108
|
|
; fsave [rsp]
|
|
; push rsi
|
|
|
|
; push rax
|
|
; call getFPUaddress
|
|
; fsave [rax]
|
|
; call getSSEaddress
|
|
; fxsave [rax]
|
|
; pop rax
|
|
; fsave [bytesForFPU]
|
|
; fxsave [bytesForSSEAligned]
|
|
|
|
mov rdi, 0
|
|
call irqDispatcher
|
|
|
|
mov rdi, rsp
|
|
call updateRSP
|
|
|
|
call nextProcess
|
|
mov rsp, rax
|
|
|
|
mov al, 20h
|
|
out 20h, al
|
|
|
|
; fxrstor [bytesForSSEAligned]
|
|
; frstor [bytesForFPU]
|
|
; push rax
|
|
; call getFPUaddress
|
|
; frstor [rax]
|
|
; call getSSEaddress
|
|
; fxrstor [rax]
|
|
; pop rax
|
|
|
|
; mov rax, rsp
|
|
; pop rsp
|
|
; and rsp, -16
|
|
; sub rsp, 108
|
|
; frstor [rsp]
|
|
; mov rsp, rax
|
|
|
|
popState
|
|
iretq
|
|
|
|
;Keyboard
|
|
_irq01Handler:
|
|
irqHandlerMaster 1
|
|
|
|
;Cascade pic never called
|
|
_irq02Handler:
|
|
irqHandlerMaster 2
|
|
|
|
;Serial Port 2 and 4
|
|
_irq03Handler:
|
|
irqHandlerMaster 3
|
|
|
|
;Serial Port 1 and 3
|
|
_irq04Handler:
|
|
irqHandlerMaster 4
|
|
|
|
;USB
|
|
_irq05Handler:
|
|
irqHandlerMaster 5
|
|
|
|
;Zero Division Exception
|
|
_exception0Handler:
|
|
exceptionHandler 0
|
|
|
|
;Invalid OPCODE Exc
|
|
_exception6Handler:
|
|
exceptionHandler 6
|
|
|
|
haltcpu:
|
|
sti
|
|
hlt
|
|
cli
|
|
ret
|
|
|
|
%macro pushStateNoRax 0
|
|
push rbx
|
|
push rcx
|
|
push rdx
|
|
push rbp
|
|
push rdi
|
|
push rsi
|
|
push r8
|
|
push r9
|
|
push r10
|
|
push r11
|
|
push r12
|
|
push r13
|
|
push r14
|
|
push r15
|
|
%endmacro
|
|
|
|
%macro popStateNoRax 0
|
|
pop r15
|
|
pop r14
|
|
pop r13
|
|
pop r12
|
|
pop r11
|
|
pop r10
|
|
pop r9
|
|
pop r8
|
|
pop rsi
|
|
pop rdi
|
|
pop rbp
|
|
pop rdx
|
|
pop rcx
|
|
pop rbx
|
|
%endmacro
|
|
|
|
_initialize_stack_frame:
|
|
mov r10, rsp
|
|
mov rsp, rsi
|
|
|
|
push 0x0 ; ss
|
|
push rsi ; sp
|
|
push 0x202 ; rflags
|
|
push 0x08 ; cs
|
|
push rdi ; IP
|
|
|
|
mov rsi, rcx
|
|
mov rdi, rdx
|
|
|
|
pushState
|
|
|
|
; mov rsi, rsp
|
|
; and rsp, -16
|
|
; sub rsp, 108
|
|
; fsave [rsp]
|
|
; push rsi
|
|
|
|
; fsave [bytesForFPU]
|
|
; push rax
|
|
; mov dword [auxi], 1
|
|
; call getFPUaddress
|
|
; call getSSEaddress
|
|
; pop rax
|
|
; fxsave [bytesForSSEAligned]
|
|
|
|
; fsave [r8]
|
|
; fxsave [r9]
|
|
|
|
mov rsp, r10
|
|
ret
|
|
|
|
; System calls (int 80h)
|
|
_systemCallsHandler:
|
|
pushStateNoRax
|
|
fsave [bytesForFPU]
|
|
fxsave [bytesForSSEAligned]
|
|
|
|
call systemCallsDispatcher
|
|
|
|
fxrstor [bytesForSSEAligned]
|
|
frstor [bytesForFPU]
|
|
popStateNoRax
|
|
iretq
|
|
|
|
SECTION .data
|
|
align 16
|
|
bytesForSSEAligned times 512 db 0
|
|
; bytesForSSEAligned1 times 512 db 0
|
|
; bytesForSSEAligned2 times 512 db 0
|
|
; counter dd 1
|
|
|
|
SECTION .bss
|
|
aux resq 1
|
|
bytesForSSE resb 512
|
|
bytesForFPU resb 108
|
|
; bytesForFPU1 resb 108
|
|
; bytesForFPU2 resb 108
|
|
insPointer resb 8
|
|
rspPointer resb 8
|
|
; auxi resb 4 |