forked from KolibriOS/kolibrios
479 lines
11 KiB
NASM
479 lines
11 KiB
NASM
|
||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||
;; ;;
|
||
;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;
|
||
;; Distributed under terms of the GNU General Public License ;;
|
||
;; ;;
|
||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||
|
||
include "../macros.inc"
|
||
include "../proc32.inc"
|
||
include "../const.inc"
|
||
|
||
$Revision: 847 $
|
||
|
||
sel_tss equ 0x08
|
||
|
||
sel_os_code equ 0x10
|
||
sel_os_stack equ 0x18
|
||
|
||
sel_app_code equ 0x23
|
||
sel_app_data equ 0x2B
|
||
|
||
sel_srv_code equ 0x31
|
||
sel_srv_stack equ 0x39
|
||
|
||
sel_code_16 equ 0x70
|
||
|
||
format MS COFF
|
||
|
||
use32
|
||
|
||
public __os_stack
|
||
public _pg_balloc
|
||
|
||
|
||
public high_code
|
||
|
||
public core_init
|
||
|
||
public test_cpu
|
||
|
||
public cpu_vendor
|
||
public cpu_sign
|
||
public cpu_info
|
||
public cpu_caps
|
||
|
||
extrn _parse_mbi
|
||
|
||
extrn _16bit_start
|
||
extrn _16bit_end
|
||
extrn _enter_bootscreen
|
||
|
||
extrn init_fpu
|
||
extrn init_idt
|
||
extrn _init_mm
|
||
extrn _slab_cache_init
|
||
extrn @init_heap@8
|
||
extrn init_malloc
|
||
extrn _init_core_dll
|
||
extrn _init_threads
|
||
extrn init_mtrr
|
||
extrn system_init
|
||
|
||
extrn sysenter_entry
|
||
extrn syscall_entry
|
||
|
||
|
||
extrn @create_systhread@4
|
||
|
||
extrn _sys_pdbr
|
||
extrn _current_thread
|
||
extrn _k_reenter:dword
|
||
|
||
extrn scr_mode:dword
|
||
extrn LFBAddress:dword
|
||
extrn LFBSize:dword
|
||
|
||
section '.text' code readable align 16
|
||
|
||
high_code:
|
||
|
||
mov ax, sel_os_stack
|
||
mov dx, sel_app_data
|
||
mov ss, ax
|
||
mov esp, __os_stack
|
||
|
||
mov ds, dx
|
||
mov es, dx
|
||
mov fs, dx
|
||
mov gs, dx
|
||
|
||
|
||
; bt [cpu_caps], CAPS_PGE
|
||
; jnc @F
|
||
|
||
; or dword [sys_pgdir-OS_BASE+(OS_BASE shr 20)], PG_GLOBAL
|
||
|
||
; mov ebx, cr4
|
||
; or ebx, CR4_PGE
|
||
; mov cr4, ebx
|
||
@@:
|
||
; mov eax, cr3
|
||
; mov cr3, eax ; flush TLB
|
||
|
||
mov edx, 0x3fB
|
||
mov eax, 3
|
||
out dx, al
|
||
|
||
call test_cpu
|
||
call _parse_mbi
|
||
|
||
; mov eax, [_pg_balloc]
|
||
; mov [_copy_pg_balloc], eax
|
||
|
||
__core_restart:
|
||
|
||
mov esi, _16bit_start
|
||
mov ecx, _16bit_end
|
||
shr ecx, 2
|
||
mov edi, _16BIT_BASE
|
||
cld
|
||
rep movsd
|
||
|
||
jmp far sel_code_16:_enter_bootscreen;
|
||
|
||
align 16
|
||
core_init:
|
||
cld
|
||
|
||
mov ax, sel_os_stack
|
||
mov dx, sel_app_data
|
||
mov ss, ax
|
||
mov esp, __os_stack
|
||
|
||
mov ds, dx
|
||
mov es, dx
|
||
mov fs, dx
|
||
mov gs, dx
|
||
|
||
mov [tss._ss0], sel_os_stack
|
||
mov [tss._esp0], __os_stack
|
||
mov [tss._esp], __os_stack
|
||
mov [tss._cs], sel_os_code
|
||
mov [tss._ss], sel_os_stack
|
||
mov [tss._ds], sel_app_data
|
||
mov [tss._es], sel_app_data
|
||
mov [tss._fs], sel_app_data
|
||
mov [tss._gs], sel_app_data
|
||
mov [tss._io], 128
|
||
;Add IO access table - bit array of permitted ports
|
||
mov edi, tss._io_map_0
|
||
xor eax, eax
|
||
; not eax
|
||
mov ecx, 8192/4
|
||
rep stosd ; access to 4096*8=65536 ports
|
||
|
||
mov ax, sel_tss
|
||
ltr ax
|
||
|
||
; -------- Fast System Call init ----------
|
||
; Intel SYSENTER/SYSEXIT (AMD CPU support it too)
|
||
bt [cpu_caps], CAPS_SEP
|
||
jnc .SEnP ; SysEnter not Present
|
||
|
||
xor edx, edx
|
||
mov ecx, MSR_SYSENTER_CS
|
||
mov eax, sel_os_code
|
||
wrmsr
|
||
mov ecx, MSR_SYSENTER_ESP
|
||
; mov eax, sysenter_stack ; Check it
|
||
xor eax, eax
|
||
wrmsr
|
||
mov ecx, MSR_SYSENTER_EIP
|
||
mov eax, sysenter_entry
|
||
wrmsr
|
||
|
||
.SEnP:
|
||
; AMD SYSCALL/SYSRET
|
||
cmp byte[cpu_vendor], 'A'
|
||
jne .noSYSCALL
|
||
mov eax, 0x80000001
|
||
cpuid
|
||
test edx, 0x800 ; bit_11 - SYSCALL/SYSRET support
|
||
jz .noSYSCALL
|
||
mov ecx, MSR_AMD_EFER
|
||
rdmsr
|
||
or eax, 1 ; bit_0 - System Call Extension (SCE)
|
||
wrmsr
|
||
|
||
; Bits of EDX :
|
||
; Bit 31<33>16 During the SYSRET instruction, this field is copied into the CS register
|
||
; and the contents of this field, plus 8, are copied into the SS register.
|
||
; Bit 15<31>0 During the SYSCALL instruction, this field is copied into the CS register
|
||
; and the contents of this field, plus 8, are copied into the SS register.
|
||
|
||
mov edx, ((sel_os_code + 16) shl 16) + sel_os_code
|
||
|
||
mov eax, syscall_entry
|
||
mov ecx, MSR_AMD_STAR
|
||
wrmsr
|
||
.noSYSCALL:
|
||
|
||
call init_fpu
|
||
|
||
call init_idt
|
||
|
||
call _init_mm
|
||
|
||
call init_malloc
|
||
call _slab_cache_init
|
||
|
||
mov ecx, 0x80000000
|
||
mov edx, 0x40000000
|
||
call @init_heap@8
|
||
|
||
call _init_core_dll
|
||
call _init_threads
|
||
|
||
; SAVE & CLEAR 0-0xffff
|
||
|
||
cld
|
||
xor esi, esi
|
||
mov edi,BOOT_VAR
|
||
mov ecx,0x10000 / 4
|
||
rep movsd
|
||
|
||
xor edi, edi
|
||
xor eax, eax
|
||
mov ecx,0x10000 / 4
|
||
rep stosd
|
||
|
||
mov edi, 0x40000
|
||
mov ecx, (0x90000-0x40000)/4
|
||
rep stosd
|
||
|
||
mov dword [_sys_pdbr], eax
|
||
mov dword [_sys_pdbr+4], eax
|
||
|
||
xchg bx, bx
|
||
|
||
movzx eax,word [BOOT_VAR+0x9008] ; screen mode
|
||
mov [scr_mode],eax
|
||
|
||
mov eax,[BOOT_VAR+0x9018]
|
||
call map_LFB
|
||
|
||
mov eax, cr3
|
||
mov cr3, eax
|
||
|
||
|
||
jmp system_init
|
||
|
||
if 0
|
||
mov ecx, system_init
|
||
call @create_systhread@4
|
||
|
||
mov [_current_thread], eax
|
||
|
||
xchg bx, bx
|
||
|
||
mov ebx, [eax+THR.pdir]
|
||
mov ecx, cr3
|
||
cmp ebx, ecx
|
||
je .skip
|
||
mov cr3, ebx
|
||
.skip:
|
||
mov esp, [_current_thread]
|
||
; lea eax, [esp+THR.pl0_stack]
|
||
; mov [tss._esp0], eax
|
||
restart1:
|
||
dec [_k_reenter]
|
||
popad
|
||
add esp, 4 ; skip return adr
|
||
iretd ; continue process
|
||
end if
|
||
|
||
align 4
|
||
map_LFB:
|
||
cmp eax, -1
|
||
jne @f
|
||
|
||
ret
|
||
@@:
|
||
test [scr_mode], 0100000000000000b
|
||
jnz @f
|
||
mov [BOOT_VAR+0x901c],byte 2
|
||
ret
|
||
@@:
|
||
mov [LFBAddress], eax
|
||
mov [LFBSize], 0x800000
|
||
call init_mtrr
|
||
|
||
mov eax, [LFBAddress]
|
||
or eax, PG_LARGE+PG_UW
|
||
mov [_sys_pdbr+(LFB_BASE shr 20)], eax
|
||
add eax, 0x00400000
|
||
mov [_sys_pdbr+4+(LFB_BASE shr 20)], eax
|
||
if SHADOWFB
|
||
mov ecx, 11
|
||
call @core_alloc@4
|
||
or eax, PG_LARGE+PG_UW
|
||
mov [_sys_pdbr+(SHADOWFB shr 20)], eax
|
||
add eax, 0x00400000
|
||
mov [_sys_pdbr+4+(SHADOWFB shr 20)], eax
|
||
end if
|
||
|
||
bt [cpu_caps], CAPS_PGE
|
||
jnc @F
|
||
or dword [_sys_pdbr+(LFB_BASE shr 20)], PG_GLOBAL
|
||
@@:
|
||
mov dword [LFBAddress], LFB_BASE
|
||
ret
|
||
|
||
|
||
align 4
|
||
proc test_cpu
|
||
locals
|
||
cpu_type dd ?
|
||
cpu_id dd ?
|
||
cpu_Intel dd ?
|
||
cpu_AMD dd ?
|
||
endl
|
||
|
||
mov [cpu_type], 0
|
||
xor eax, eax
|
||
mov [cpu_caps], eax
|
||
mov [cpu_caps+4], eax
|
||
|
||
xor eax, eax
|
||
cpuid
|
||
|
||
mov [cpu_vendor], ebx
|
||
mov [cpu_vendor+4], edx
|
||
mov [cpu_vendor+8], ecx
|
||
cmp ebx, dword [intel_str]
|
||
jne .check_AMD
|
||
cmp edx, dword [intel_str+4]
|
||
jne .check_AMD
|
||
cmp ecx, dword [intel_str+8]
|
||
jne .check_AMD
|
||
mov [cpu_Intel], 1
|
||
cmp eax, 1
|
||
jl .end_cpuid
|
||
mov eax, 1
|
||
cpuid
|
||
mov [cpu_sign], eax
|
||
mov [cpu_info], ebx
|
||
mov [cpu_caps], edx
|
||
mov [cpu_caps+4],ecx
|
||
|
||
shr eax, 8
|
||
and eax, 0x0f
|
||
ret
|
||
.end_cpuid:
|
||
mov eax, [cpu_type]
|
||
ret
|
||
|
||
.check_AMD:
|
||
cmp ebx, dword [AMD_str]
|
||
jne .unknown
|
||
cmp edx, dword [AMD_str+4]
|
||
jne .unknown
|
||
cmp ecx, dword [AMD_str+8]
|
||
jne .unknown
|
||
mov [cpu_AMD], 1
|
||
cmp eax, 1
|
||
jl .unknown
|
||
mov eax, 1
|
||
cpuid
|
||
mov [cpu_sign], eax
|
||
mov [cpu_info], ebx
|
||
mov [cpu_caps], edx
|
||
mov [cpu_caps+4],ecx
|
||
shr eax, 8
|
||
and eax, 0x0f
|
||
ret
|
||
.unknown:
|
||
mov eax, 1
|
||
cpuid
|
||
mov [cpu_sign], eax
|
||
mov [cpu_info], ebx
|
||
mov [cpu_caps], edx
|
||
mov [cpu_caps+4],ecx
|
||
shr eax, 8
|
||
and eax, 0x0f
|
||
ret
|
||
endp
|
||
|
||
intel_str db "GenuineIntel",0
|
||
AMD_str db "AuthenticAMD",0
|
||
|
||
|
||
|
||
if 0
|
||
align 4
|
||
|
||
init_BIOS32:
|
||
mov edi, 0xE0000
|
||
.pcibios_nxt:
|
||
cmp dword[edi], '_32_' ; "magic" word
|
||
je .BIOS32_found
|
||
.pcibios_nxt2:
|
||
add edi, 0x10
|
||
cmp edi, 0xFFFF0
|
||
je .BIOS32_not_found
|
||
jmp .pcibios_nxt
|
||
.BIOS32_found: ; magic word found, check control summ
|
||
|
||
movzx ecx, byte[edi + 9]
|
||
shl ecx, 4
|
||
mov esi, edi
|
||
xor eax, eax
|
||
cld ; paranoia
|
||
@@: lodsb
|
||
add ah, al
|
||
loop @b
|
||
jnz .pcibios_nxt2 ; control summ must be zero
|
||
; BIOS32 service found !
|
||
mov ebp, [edi + 4]
|
||
mov [bios32_entry], ebp
|
||
; check PCI BIOS present
|
||
mov eax, '$PCI'
|
||
xor ebx, ebx
|
||
push cs ; special for 'ret far' from BIOS
|
||
call ebp
|
||
test al, al
|
||
jnz .PCI_BIOS32_not_found
|
||
|
||
; <20><><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD> PCI BIOS
|
||
|
||
add ebx, OS_BASE
|
||
dec ecx
|
||
mov [(pci_code_32-OS_BASE)], cx ;limit 0-15
|
||
mov [(pci_data_32-OS_BASE)], cx ;limit 0-15
|
||
|
||
mov [(pci_code_32-OS_BASE)+2], bx ;base 0-15
|
||
mov [(pci_data_32-OS_BASE)+2], bx ;base 0-15
|
||
|
||
shr ebx, 16
|
||
mov [(pci_code_32-OS_BASE)+4], bl ;base 16-23
|
||
mov [(pci_data_32-OS_BASE)+4], bl ;base 16-23
|
||
|
||
shr ecx, 16
|
||
and cl, 0x0F
|
||
mov ch, bh
|
||
add cx, D32
|
||
mov [(pci_code_32-OS_BASE)+6], cx ;lim 16-19 &
|
||
mov [(pci_data_32-OS_BASE)+6], cx ;base 24-31
|
||
|
||
mov [(pci_bios_entry-OS_BASE)], edx
|
||
; jmp .end
|
||
.PCI_BIOS32_not_found:
|
||
; <20><><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> pci_emu_dat
|
||
.BIOS32_not_found:
|
||
.end:
|
||
ret
|
||
|
||
end if
|
||
|
||
section '.data' data writeable align 16
|
||
|
||
_pg_balloc dd LAST_PAGE
|
||
|
||
section '.bss' data writeable align 16
|
||
|
||
rb 8192-512
|
||
|
||
__os_stack rb 512
|
||
|
||
;CPUID information
|
||
|
||
cpu_vendor rd 3
|
||
cpu_sign rd 1
|
||
cpu_info rd 1
|
||
cpu_caps rd 4
|
||
|
||
|
||
|