142 lines
2.6 KiB
NASM
142 lines
2.6 KiB
NASM
section .data
|
||
|
||
global io_hlt, io_cli, io_sti, io_stihlt
|
||
global io_in8, io_in16, io_in32
|
||
global io_out8, io_out16, io_out32
|
||
global io_load_eflags, io_store_eflags
|
||
global load_gdtr, load_idtr
|
||
global tss_flush, gdt_flush, switch_to
|
||
|
||
section .text
|
||
|
||
switch_to:
|
||
mov eax, [esp+4]
|
||
|
||
mov [eax+0], esp
|
||
mov [eax+4], ebp
|
||
mov [eax+8], ebx
|
||
mov [eax+12], esi
|
||
mov [eax+16], edi
|
||
pushf
|
||
pop ecx
|
||
mov [eax+20], ecx
|
||
|
||
mov eax, [esp+8]
|
||
|
||
mov esp, [eax+0]
|
||
mov ebp, [eax+4]
|
||
mov ebx, [eax+8]
|
||
mov esi, [eax+12]
|
||
mov edi, [eax+16]
|
||
mov eax, [eax+20]
|
||
push eax
|
||
popf
|
||
|
||
ret
|
||
|
||
[global read_port]
|
||
|
||
read_port:
|
||
mov edx, [esp + 4]
|
||
in al, dx
|
||
ret
|
||
|
||
[global idt_flush]
|
||
|
||
idt_flush: ; void idt_flush(uint32_t);
|
||
mov eax, [esp + 4]
|
||
lidt [eax]
|
||
ret
|
||
|
||
[global gdt_flush]
|
||
|
||
gdt_flush: ; void gdt_flush(uint32_t gdtr);
|
||
mov eax, [esp + 4] ; [esp+4]按规定是第一个参数，即gdtr
|
||
lgdt [eax] ; 加载新gdt指针，传入的是地址
|
||
|
||
mov ax, 0x10 ; 新数据段
|
||
mov ds, ax
|
||
mov es, ax
|
||
mov fs, ax
|
||
mov gs, ax
|
||
mov ss, ax ; 各数据段全部划给这一数据段
|
||
jmp 0x08:.flush ; cs没法mov，只能用farjmp/farcall，这里用farjmp刷新cs
|
||
.flush:
|
||
ret ; 刷新完毕，返回
|
||
|
||
tss_flush:
|
||
mov ax, 0x2B
|
||
ltr ax
|
||
ret
|
||
|
||
io_hlt: ; void io_hlt(void);
|
||
HLT
|
||
RET
|
||
|
||
io_cli: ; void io_cli(void);
|
||
CLI
|
||
RET
|
||
io_sti: ; void io_sti(void);
|
||
STI
|
||
RET
|
||
io_stihlt: ; void io_stihlt(void);
|
||
STI
|
||
HLT
|
||
RET
|
||
|
||
io_in8: ; int io_in8(int port);
|
||
MOV EDX,[ESP+4] ; port
|
||
MOV EAX,0
|
||
IN AL,DX
|
||
RET
|
||
io_in16: ; int io_in16(int port);
|
||
MOV EDX,[ESP+4] ; port
|
||
MOV EAX,0
|
||
IN AX,DX
|
||
RET
|
||
|
||
io_in32: ; int io_in32(int port);
|
||
MOV EDX,[ESP+4] ; port
|
||
IN EAX,DX
|
||
RET
|
||
|
||
io_out8: ; void io_out8(int port, int data);
|
||
MOV EDX,[ESP+4] ; port
|
||
MOV AL,[ESP+8] ; data
|
||
OUT DX,AL
|
||
RET
|
||
|
||
io_out16: ; void io_out16(int port, int data);
|
||
MOV EDX,[ESP+4] ; port
|
||
MOV EAX,[ESP+8] ; data
|
||
OUT DX,AX
|
||
RET
|
||
|
||
io_out32: ; void io_out32(int port, int data);
|
||
MOV EDX,[ESP+4] ; port
|
||
MOV EAX,[ESP+8] ; data
|
||
OUT DX,EAX
|
||
RET
|
||
|
||
io_load_eflags: ; int io_load_eflags(void);
|
||
PUSHFD ; PUSH EFLAGS
|
||
POP EAX
|
||
RET
|
||
|
||
io_store_eflags: ; void io_store_eflags(int eflags);
|
||
MOV EAX,[ESP+4]
|
||
PUSH EAX
|
||
POPFD ; POP EFLAGS
|
||
RET
|
||
|
||
load_gdtr: ; void load_gdtr(int limit, int addr);
|
||
MOV AX,[ESP+4] ; limit
|
||
MOV [ESP+6],AX
|
||
LGDT [ESP+6]
|
||
RET
|
||
|
||
load_idtr: ; void load_idtr(int limit, int addr);
|
||
MOV AX,[ESP+4] ; limit
|
||
MOV [ESP+6],AX
|
||
LIDT [ESP+6]
|
||
RET |