WebSVN – Kolibri OS – Diff – /kernel/trunk/init.inc


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                              ;;
;; Copyright (C) KolibriOS team 2004-2008. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License    ;;
;;                                                              ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
$Revision: 2129 $
 
 
MEM_WB     equ 6               ;write-back memory
MEM_WC     equ 1               ;write combined memory
MEM_UC     equ 0               ;uncached memory
 
align 4
proc mem_test
; if we have BIOS with fn E820, skip the test
           cmp dword [BOOT_VAR-OS_BASE + 0x9100], 0
           jnz .ret
 
           mov eax, cr0
           and eax, not (CR0_CD+CR0_NW)
           or eax, CR0_CD         ;disable caching
           mov cr0, eax
           wbinvd                 ;invalidate cache
 
           xor edi, edi
           mov ebx, 'TEST'
@@:
           add edi, 0x100000
           xchg ebx, dword [edi]
           cmp dword [edi], 'TEST'
           xchg ebx, dword [edi]
           je @b
 
           and eax, not (CR0_CD+CR0_NW)  ;enable caching
           mov cr0, eax
           inc dword [BOOT_VAR-OS_BASE + 0x9100]
           xor eax, eax
           mov [BOOT_VAR-OS_BASE + 0x9104], eax
           mov [BOOT_VAR-OS_BASE + 0x9108], eax
           mov [BOOT_VAR-OS_BASE + 0x910C], edi
           mov [BOOT_VAR-OS_BASE + 0x9110], eax
.ret:
           ret
endp
 
align 4
proc init_mem
; calculate maximum allocatable address and number of allocatable pages
           mov edi, BOOT_VAR-OS_BASE + 0x9104
           mov ecx, [edi-4]
           xor esi, esi ; esi will hold total amount of memory
           xor edx, edx ; edx will hold maximum allocatable address
.calcmax:
; round all to pages
           mov eax, [edi]
           test eax, 0xFFF
           jz @f
           neg eax
           and eax, 0xFFF
           add [edi], eax
           adc dword [edi+4], 0
           sub [edi+8], eax
           sbb dword [edi+12], 0
           jc .unusable
@@:
           and dword [edi+8], not 0xFFF
           jz .unusable
; ignore memory after 4 Gb
           cmp dword [edi+4], 0
           jnz .unusable
           mov eax, [edi]
           cmp dword [edi+12], 0
           jnz .overflow
           add eax, [edi+8]
           jnc @f
.overflow:
           mov eax, 0xFFFFF000
@@:
           cmp edx, eax
           jae @f
           mov edx, eax
@@:
           sub eax, [edi]
           mov [edi+8], eax
           add esi, eax
           jmp .usable
.unusable:
           and dword [edi+8], 0
.usable:
           add edi, 20
           loop .calcmax
.calculated:
           mov [MEM_AMOUNT-OS_BASE], esi
           mov [pg_data.mem_amount-OS_BASE], esi
           shr esi, 12
           mov [pg_data.pages_count-OS_BASE], esi
 
           shr edx, 12
           add edx, 31
           and edx, not 31
           shr edx, 3
           mov [pg_data.pagemap_size-OS_BASE], edx
 
           add edx, (sys_pgmap-OS_BASE)+4095
           and edx, not 4095
           mov [tmp_page_tabs], edx
 
           mov edx, esi
           and edx, -1024
           cmp edx, (OS_BASE/4096)
           jbe @F
           mov edx, (OS_BASE/4096)
           jmp .set
@@:
           cmp edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096
           jae .set
           mov edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096
.set:
           mov [pg_data.kernel_pages-OS_BASE], edx
           shr edx, 10
           mov [pg_data.kernel_tables-OS_BASE], edx
 
           xor eax, eax
           mov edi, sys_pgdir-OS_BASE
           mov ecx, 4096/4
           cld
           rep stosd
 
           mov edx, (sys_pgdir-OS_BASE)+ 0x800; (OS_BASE shr 20)
           bt [cpu_caps-OS_BASE], CAPS_PSE
           jnc .no_PSE
 
           mov ebx, cr4
           or ebx, CR4_PSE
           mov eax, PG_LARGE+PG_SW
           mov cr4, ebx
           dec [pg_data.kernel_tables-OS_BASE]
 
           mov [edx], eax
           add edx, 4
 
           mov edi, [tmp_page_tabs]
           jmp .map_kernel_heap		; new kernel fits to the first 4Mb - nothing to do with ".map_low"
.no_PSE:
           mov eax, PG_SW
           mov ecx, [tmp_page_tabs]
           shr ecx, 12
.map_low:
           mov edi, [tmp_page_tabs]
@@:                                   ;
           stosd
           add eax, 0x1000
           dec ecx
           jnz @B
 
.map_kernel_heap:
           mov ecx, [pg_data.kernel_tables-OS_BASE]
           shl ecx, 10
           xor eax, eax
           rep stosd
 
           mov ecx, [pg_data.kernel_tables-OS_BASE]
           mov eax, [tmp_page_tabs]
           or  eax, PG_SW
           mov edi, edx
 
.map_kernel_tabs:
           stosd
           add eax, 0x1000
           dec ecx
           jnz .map_kernel_tabs
 
           mov dword [sys_pgdir-OS_BASE+(page_tabs shr 20)], sys_pgdir+PG_SW-OS_BASE
 
           mov edi, (sys_pgdir-OS_BASE)
           lea esi, [edi+(OS_BASE shr 20)]
           movsd
           movsd
           ret
endp
 
align 4
proc init_page_map
; mark all memory as unavailable
           mov edi, sys_pgmap-OS_BASE
           mov ecx, [pg_data.pagemap_size-OS_BASE]
           shr ecx, 2
           xor eax, eax
           cld
           rep stosd
 
; scan through memory map and mark free areas as available
           mov ebx, BOOT_VAR-OS_BASE + 0x9104
           mov edx, [ebx-4]
.scanmap:
           mov ecx, [ebx+8]
           shr ecx, 12 ; ecx = number of pages
           jz .next
           mov edi, [ebx]
           shr edi, 12 ; edi = first page
           mov eax, edi
           shr edi, 5
           shl edi, 2
           add edi, sys_pgmap-OS_BASE
           and eax, 31
           jz .startok
           add ecx, eax
           sub ecx, 32
           jbe .onedword
           push ecx
           mov ecx, eax
           or eax, -1
           shl eax, cl
           or [edi], eax
           add edi, 4
           pop ecx
.startok:
           push ecx
           shr ecx, 5
           or eax, -1
           rep stosd
           pop ecx
           and ecx, 31
           neg eax
           shl eax, cl
           dec eax
           or [edi], eax
           jmp .next
.onedword:
           add ecx, 32
           sub ecx, eax
@@:
           bts [edi], eax
           inc eax
           loop @b
.next:
           add ebx, 20
           dec edx
           jnz .scanmap
 
; mark kernel memory as allocated (unavailable)
           mov ecx, [tmp_page_tabs]
           mov edx, [pg_data.pages_count-OS_BASE]
           shr ecx, 12
           add ecx, [pg_data.kernel_tables-OS_BASE]
           sub edx, ecx
           mov [pg_data.pages_free-OS_BASE], edx
 
           mov edi, sys_pgmap-OS_BASE
           mov ebx, ecx
           shr ecx, 5
           xor eax, eax
           rep stosd
 
           not eax
           mov ecx, ebx
           and ecx, 31
           shl eax, cl
           and [edi], eax
           add edi, OS_BASE
           mov [page_start-OS_BASE], edi;
 
           mov ebx, sys_pgmap
           add ebx, [pg_data.pagemap_size-OS_BASE]
           mov [page_end-OS_BASE], ebx
 
 
           ret
endp
 
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
 
 ; çäåñü ñîçäàþòñÿ äèñêðèïòîðû äëÿ 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:
	; çäåñü äîëæíà çàïîëíÿòñÿ pci_emu_dat
.BIOS32_not_found:
.end:
           ret
 
align 4
proc test_cpu
           locals
              cpu_type   dd ?
              cpu_id     dd ?
              cpu_Intel  dd ?
              cpu_AMD    dd ?
           endl
 
           xor eax, eax
           mov [cpu_type], eax
           mov [cpu_caps-OS_BASE], eax
           mov [cpu_caps+4-OS_BASE], eax
 
           pushfd
           pop eax
           mov ecx, eax
           xor eax, 0x40000
           push eax
           popfd
           pushfd
           pop eax
           xor eax, ecx
           mov [cpu_type], CPU_386
           jz .end_cpuid
           push ecx
           popfd
 
           mov [cpu_type], CPU_486
           mov eax, ecx
           xor eax, 0x200000
           push eax
           popfd
           pushfd
           pop eax
           xor eax, ecx
           je .end_cpuid
           mov [cpu_id], 1
 
           xor eax, eax
           cpuid
 
           mov [cpu_vendor-OS_BASE], ebx
           mov [cpu_vendor+4-OS_BASE], edx
           mov [cpu_vendor+8-OS_BASE], ecx
           cmp ebx, dword [intel_str-OS_BASE]
           jne .check_AMD
           cmp edx, dword [intel_str+4-OS_BASE]
           jne .check_AMD
           cmp ecx, dword [intel_str+8-OS_BASE]
           jne .check_AMD
           mov [cpu_Intel], 1
           cmp eax, 1
           jl .end_cpuid
           mov eax, 1
           cpuid
           mov [cpu_sign-OS_BASE], eax
           mov [cpu_info-OS_BASE],  ebx
           mov [cpu_caps-OS_BASE],  edx
           mov [cpu_caps+4-OS_BASE],ecx
 
           shr eax, 8
           and eax, 0x0f
           ret
.end_cpuid:
           mov eax, [cpu_type]
           ret
 
.check_AMD:
           cmp ebx, dword [AMD_str-OS_BASE]
           jne .unknown
           cmp edx, dword [AMD_str+4-OS_BASE]
           jne .unknown
           cmp ecx, dword [AMD_str+8-OS_BASE]
           jne .unknown
           mov [cpu_AMD], 1
           cmp eax, 1
           jl .unknown
           mov eax, 1
           cpuid
           mov [cpu_sign-OS_BASE], eax
           mov [cpu_info-OS_BASE],  ebx
           mov [cpu_caps-OS_BASE],  edx
           mov [cpu_caps+4-OS_BASE],ecx
           shr eax, 8
           and eax, 0x0f
           ret
.unknown:
           mov eax, 1
           cpuid
           mov [cpu_sign-OS_BASE], eax
           mov [cpu_info-OS_BASE],  ebx
           mov [cpu_caps-OS_BASE],  edx
           mov [cpu_caps+4-OS_BASE],ecx
           shr eax, 8
           and eax, 0x0f
           ret
endp

Rev 1455	Rev 2129
1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2	;; ;;	2	;; ;;
3	;; Copyright (C) KolibriOS team 2004-2008. All rights reserved. ;;	3	;; Copyright (C) KolibriOS team 2004-2008. All rights reserved. ;;
4	;; Distributed under terms of the GNU General Public License ;;	4	;; Distributed under terms of the GNU General Public License ;;
5	;; ;;	5	;; ;;
6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
7		7
8	$Revision: 1455 $	8	$Revision: 2129 $
9		9
10		10
11	MEM_WB equ 6 ;write-back memory	11	MEM_WB equ 6 ;write-back memory
12	MEM_WC equ 1 ;write combined memory	12	MEM_WC equ 1 ;write combined memory
13	MEM_UC equ 0 ;uncached memory	13	MEM_UC equ 0 ;uncached memory
14		14
15	align 4	15	align 4
16	proc mem_test	16	proc mem_test
17	; if we have BIOS with fn E820, skip the test	17	; if we have BIOS with fn E820, skip the test
18	cmp dword [BOOT_VAR-OS_BASE + 0x9100], 0	18	cmp dword [BOOT_VAR-OS_BASE + 0x9100], 0
19	jnz .ret	19	jnz .ret
20		20
21	mov eax, cr0	21	mov eax, cr0
22	and eax, not (CR0_CD+CR0_NW)	22	and eax, not (CR0_CD+CR0_NW)
23	or eax, CR0_CD ;disable caching	23	or eax, CR0_CD ;disable caching
24	mov cr0, eax	24	mov cr0, eax
25	wbinvd ;invalidate cache	25	wbinvd ;invalidate cache
26		26
27	xor edi, edi	27	xor edi, edi
28	mov ebx, 'TEST'	28	mov ebx, 'TEST'
29	@@:	29	@@:
30	add edi, 0x100000	30	add edi, 0x100000
31	xchg ebx, dword [edi]	31	xchg ebx, dword [edi]
32	cmp dword [edi], 'TEST'	32	cmp dword [edi], 'TEST'
33	xchg ebx, dword [edi]	33	xchg ebx, dword [edi]
34	je @b	34	je @b
35		35
36	and eax, not (CR0_CD+CR0_NW) ;enable caching	36	and eax, not (CR0_CD+CR0_NW) ;enable caching
37	mov cr0, eax	37	mov cr0, eax
38	inc dword [BOOT_VAR-OS_BASE + 0x9100]	38	inc dword [BOOT_VAR-OS_BASE + 0x9100]
39	xor eax, eax	39	xor eax, eax
40	mov [BOOT_VAR-OS_BASE + 0x9104], eax	40	mov [BOOT_VAR-OS_BASE + 0x9104], eax
41	mov [BOOT_VAR-OS_BASE + 0x9108], eax	41	mov [BOOT_VAR-OS_BASE + 0x9108], eax
42	mov [BOOT_VAR-OS_BASE + 0x910C], edi	42	mov [BOOT_VAR-OS_BASE + 0x910C], edi
43	mov [BOOT_VAR-OS_BASE + 0x9110], eax	43	mov [BOOT_VAR-OS_BASE + 0x9110], eax
44	.ret:	44	.ret:
45	ret	45	ret
46	endp	46	endp
47		47
48	align 4	48	align 4
49	proc init_mem	49	proc init_mem
50	; calculate maximum allocatable address and number of allocatable pages	50	; calculate maximum allocatable address and number of allocatable pages
51	mov edi, BOOT_VAR-OS_BASE + 0x9104	51	mov edi, BOOT_VAR-OS_BASE + 0x9104
52	mov ecx, [edi-4]	52	mov ecx, [edi-4]
53	xor esi, esi ; esi will hold total amount of memory	53	xor esi, esi ; esi will hold total amount of memory
54	xor edx, edx ; edx will hold maximum allocatable address	54	xor edx, edx ; edx will hold maximum allocatable address
55	.calcmax:	55	.calcmax:
56	; round all to pages	56	; round all to pages
57	mov eax, [edi]	57	mov eax, [edi]
58	test eax, 0xFFF	58	test eax, 0xFFF
59	jz @f	59	jz @f
60	neg eax	60	neg eax
61	and eax, 0xFFF	61	and eax, 0xFFF
62	add [edi], eax	62	add [edi], eax
63	adc dword [edi+4], 0	63	adc dword [edi+4], 0
64	sub [edi+8], eax	64	sub [edi+8], eax
65	sbb dword [edi+12], 0	65	sbb dword [edi+12], 0
66	jc .unusable	66	jc .unusable
67	@@:	67	@@:
68	and dword [edi+8], not 0xFFF	68	and dword [edi+8], not 0xFFF
69	jz .unusable	69	jz .unusable
70	; ignore memory after 4 Gb	70	; ignore memory after 4 Gb
71	cmp dword [edi+4], 0	71	cmp dword [edi+4], 0
72	jnz .unusable	72	jnz .unusable
73	mov eax, [edi]	73	mov eax, [edi]
74	cmp dword [edi+12], 0	74	cmp dword [edi+12], 0
75	jnz .overflow	75	jnz .overflow
76	add eax, [edi+8]	76	add eax, [edi+8]
77	jnc @f	77	jnc @f
78	.overflow:	78	.overflow:
79	mov eax, 0xFFFFF000	79	mov eax, 0xFFFFF000
80	@@:	80	@@:
81	cmp edx, eax	81	cmp edx, eax
82	jae @f	82	jae @f
83	mov edx, eax	83	mov edx, eax
84	@@:	84	@@:
85	sub eax, [edi]	85	sub eax, [edi]
86	mov [edi+8], eax	86	mov [edi+8], eax
87	add esi, eax	87	add esi, eax
88	jmp .usable	88	jmp .usable
89	.unusable:	89	.unusable:
90	and dword [edi+8], 0	90	and dword [edi+8], 0
91	.usable:	91	.usable:
92	add edi, 20	92	add edi, 20
93	loop .calcmax	93	loop .calcmax
94	.calculated:	94	.calculated:
95	mov [MEM_AMOUNT-OS_BASE], esi	95	mov [MEM_AMOUNT-OS_BASE], esi
96	mov [pg_data.mem_amount-OS_BASE], esi	96	mov [pg_data.mem_amount-OS_BASE], esi
97	shr esi, 12	97	shr esi, 12
98	mov [pg_data.pages_count-OS_BASE], esi	98	mov [pg_data.pages_count-OS_BASE], esi
99		99
100	shr edx, 12	100	shr edx, 12
101	add edx, 31	101	add edx, 31
102	and edx, not 31	102	and edx, not 31
103	shr edx, 3	103	shr edx, 3
104	mov [pg_data.pagemap_size-OS_BASE], edx	104	mov [pg_data.pagemap_size-OS_BASE], edx
105		105
106	add edx, (sys_pgmap-OS_BASE)+4095	106	add edx, (sys_pgmap-OS_BASE)+4095
107	and edx, not 4095	107	and edx, not 4095
108	mov [tmp_page_tabs], edx	108	mov [tmp_page_tabs], edx
109		109
110	mov edx, esi	110	mov edx, esi
111	and edx, -1024	111	and edx, -1024
112	cmp edx, (OS_BASE/4096)	112	cmp edx, (OS_BASE/4096)
113	jbe @F	113	jbe @F
114	mov edx, (OS_BASE/4096)	114	mov edx, (OS_BASE/4096)
115	jmp .set	115	jmp .set
116	@@:	116	@@:
117	cmp edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096	117	cmp edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096
118	jae .set	118	jae .set
119	mov edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096	119	mov edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096
120	.set:	120	.set:
121	mov [pg_data.kernel_pages-OS_BASE], edx	121	mov [pg_data.kernel_pages-OS_BASE], edx
122	shr edx, 10	122	shr edx, 10
123	mov [pg_data.kernel_tables-OS_BASE], edx	123	mov [pg_data.kernel_tables-OS_BASE], edx
124		124
125	xor eax, eax	125	xor eax, eax
126	mov edi, sys_pgdir-OS_BASE	126	mov edi, sys_pgdir-OS_BASE
127	mov ecx, 4096/4	127	mov ecx, 4096/4
128	cld	128	cld
129	rep stosd	129	rep stosd
130		130
131	mov edx, (sys_pgdir-OS_BASE)+ 0x800; (OS_BASE shr 20)	131	mov edx, (sys_pgdir-OS_BASE)+ 0x800; (OS_BASE shr 20)
132	bt [cpu_caps-OS_BASE], CAPS_PSE	132	bt [cpu_caps-OS_BASE], CAPS_PSE
133	jnc .no_PSE	133	jnc .no_PSE
134		134
135	mov ebx, cr4	135	mov ebx, cr4
136	or ebx, CR4_PSE	136	or ebx, CR4_PSE
137	mov eax, PG_LARGE+PG_SW	137	mov eax, PG_LARGE+PG_SW
138	mov cr4, ebx	138	mov cr4, ebx
139	dec [pg_data.kernel_tables-OS_BASE]	139	dec [pg_data.kernel_tables-OS_BASE]
140		140
141	mov [edx], eax	141	mov [edx], eax
142	add edx, 4	142	add edx, 4
143		143
144	mov edi, [tmp_page_tabs]	144	mov edi, [tmp_page_tabs]
145	jmp .map_kernel_heap ; new kernel fits to the first 4Mb - nothing to do with ".map_low"	145	jmp .map_kernel_heap ; new kernel fits to the first 4Mb - nothing to do with ".map_low"
146	.no_PSE:	146	.no_PSE:
147	mov eax, PG_SW	147	mov eax, PG_SW
148	mov ecx, [tmp_page_tabs]	148	mov ecx, [tmp_page_tabs]
149	shr ecx, 12	149	shr ecx, 12
150	.map_low:	150	.map_low:
151	mov edi, [tmp_page_tabs]	151	mov edi, [tmp_page_tabs]
152	@@: ;	152	@@: ;
153	stosd	153	stosd
154	add eax, 0x1000	154	add eax, 0x1000
155	dec ecx	155	dec ecx
156	jnz @B	156	jnz @B
157		157
158	.map_kernel_heap:	158	.map_kernel_heap:
159	mov ecx, [pg_data.kernel_tables-OS_BASE]	159	mov ecx, [pg_data.kernel_tables-OS_BASE]
160	shl ecx, 10	160	shl ecx, 10
161	xor eax, eax	161	xor eax, eax
162	rep stosd	162	rep stosd
163		163
164	mov ecx, [pg_data.kernel_tables-OS_BASE]	164	mov ecx, [pg_data.kernel_tables-OS_BASE]
165	mov eax, [tmp_page_tabs]	165	mov eax, [tmp_page_tabs]
166	or eax, PG_SW	166	or eax, PG_SW
167	mov edi, edx	167	mov edi, edx
168		168
169	.map_kernel_tabs:	169	.map_kernel_tabs:
170	stosd	170	stosd
171	add eax, 0x1000	171	add eax, 0x1000
172	dec ecx	172	dec ecx
173	jnz .map_kernel_tabs	173	jnz .map_kernel_tabs
174		174
175	mov dword [sys_pgdir-OS_BASE+(page_tabs shr 20)], sys_pgdir+PG_SW-OS_BASE	175	mov dword [sys_pgdir-OS_BASE+(page_tabs shr 20)], sys_pgdir+PG_SW-OS_BASE
176		176
177	mov edi, (sys_pgdir-OS_BASE)	177	mov edi, (sys_pgdir-OS_BASE)
178	lea esi, [edi+(OS_BASE shr 20)]	178	lea esi, [edi+(OS_BASE shr 20)]
179	movsd	179	movsd
180	movsd	180	movsd
181	ret	181	ret
182	endp	182	endp
183		183
184	align 4	184	align 4
185	proc init_page_map	185	proc init_page_map
186	; mark all memory as unavailable	186	; mark all memory as unavailable
187	mov edi, sys_pgmap-OS_BASE	187	mov edi, sys_pgmap-OS_BASE
188	mov ecx, [pg_data.pagemap_size-OS_BASE]	188	mov ecx, [pg_data.pagemap_size-OS_BASE]
189	shr ecx, 2	189	shr ecx, 2
190	xor eax, eax	190	xor eax, eax
191	cld	191	cld
192	rep stosd	192	rep stosd
193		193
194	; scan through memory map and mark free areas as available	194	; scan through memory map and mark free areas as available
195	mov ebx, BOOT_VAR-OS_BASE + 0x9104	195	mov ebx, BOOT_VAR-OS_BASE + 0x9104
196	mov edx, [ebx-4]	196	mov edx, [ebx-4]
197	.scanmap:	197	.scanmap:
198	mov ecx, [ebx+8]	198	mov ecx, [ebx+8]
199	shr ecx, 12 ; ecx = number of pages	199	shr ecx, 12 ; ecx = number of pages
200	jz .next	200	jz .next
201	mov edi, [ebx]	201	mov edi, [ebx]
202	shr edi, 12 ; edi = first page	202	shr edi, 12 ; edi = first page
203	mov eax, edi	203	mov eax, edi
204	shr edi, 5	204	shr edi, 5
205	shl edi, 2	205	shl edi, 2
206	add edi, sys_pgmap-OS_BASE	206	add edi, sys_pgmap-OS_BASE
207	and eax, 31	207	and eax, 31
208	jz .startok	208	jz .startok
209	add ecx, eax	209	add ecx, eax
210	sub ecx, 32	210	sub ecx, 32
211	jbe .onedword	211	jbe .onedword
212	push ecx	212	push ecx
213	mov ecx, eax	213	mov ecx, eax
214	or eax, -1	214	or eax, -1
215	shl eax, cl	215	shl eax, cl
216	or [edi], eax	216	or [edi], eax
217	add edi, 4	217	add edi, 4
218	pop ecx	218	pop ecx
219	.startok:	219	.startok:
220	push ecx	220	push ecx
221	shr ecx, 5	221	shr ecx, 5
222	or eax, -1	222	or eax, -1
223	rep stosd	223	rep stosd
224	pop ecx	224	pop ecx
225	and ecx, 31	225	and ecx, 31
226	neg eax	226	neg eax
227	shl eax, cl	227	shl eax, cl
228	dec eax	228	dec eax
229	or [edi], eax	229	or [edi], eax
230	jmp .next	230	jmp .next
231	.onedword:	231	.onedword:
232	add ecx, 32	232	add ecx, 32
233	sub ecx, eax	233	sub ecx, eax
234	@@:	234	@@:
235	bts [edi], eax	235	bts [edi], eax
236	inc eax	236	inc eax
237	loop @b	237	loop @b
238	.next:	238	.next:
239	add ebx, 20	239	add ebx, 20
240	dec edx	240	dec edx
241	jnz .scanmap	241	jnz .scanmap
242		242
243	; mark kernel memory as allocated (unavailable)	243	; mark kernel memory as allocated (unavailable)
244	mov ecx, [tmp_page_tabs]	244	mov ecx, [tmp_page_tabs]
245	mov edx, [pg_data.pages_count-OS_BASE]	245	mov edx, [pg_data.pages_count-OS_BASE]
246	shr ecx, 12	246	shr ecx, 12
247	add ecx, [pg_data.kernel_tables-OS_BASE]	247	add ecx, [pg_data.kernel_tables-OS_BASE]
248	sub edx, ecx	248	sub edx, ecx
249	mov [pg_data.pages_free-OS_BASE], edx	249	mov [pg_data.pages_free-OS_BASE], edx
250		250
251	mov edi, sys_pgmap-OS_BASE	251	mov edi, sys_pgmap-OS_BASE
252	mov ebx, ecx	252	mov ebx, ecx
253	shr ecx, 5	253	shr ecx, 5
254	xor eax, eax	254	xor eax, eax
255	rep stosd	255	rep stosd
256		256
257	not eax	257	not eax
258	mov ecx, ebx	258	mov ecx, ebx
259	and ecx, 31	259	and ecx, 31
260	shl eax, cl	260	shl eax, cl
261	and [edi], eax	261	and [edi], eax
262	add edi, OS_BASE	262	add edi, OS_BASE
263	mov [page_start-OS_BASE], edi;	263	mov [page_start-OS_BASE], edi;
264		264
265	mov ebx, sys_pgmap	265	mov ebx, sys_pgmap
266	add ebx, [pg_data.pagemap_size-OS_BASE]	266	add ebx, [pg_data.pagemap_size-OS_BASE]
267	mov [page_end-OS_BASE], ebx	267	mov [page_end-OS_BASE], ebx
268		-
269	mov [pg_data.pg_mutex-OS_BASE], 0	268
270	ret	269	ret
271	endp	270	endp
272		271
273	align 4	272	align 4
274		273
275	init_BIOS32:	274	init_BIOS32:
276	mov edi, 0xE0000	275	mov edi, 0xE0000
277	.pcibios_nxt:	276	.pcibios_nxt:
278	cmp dword[edi], '_32_' ; "magic" word	277	cmp dword[edi], '_32_' ; "magic" word
279	je .BIOS32_found	278	je .BIOS32_found
280	.pcibios_nxt2:	279	.pcibios_nxt2:
281	add edi, 0x10	280	add edi, 0x10
282	cmp edi, 0xFFFF0	281	cmp edi, 0xFFFF0
283	je .BIOS32_not_found	282	je .BIOS32_not_found
284	jmp .pcibios_nxt	283	jmp .pcibios_nxt
285	.BIOS32_found: ; magic word found, check control summ	284	.BIOS32_found: ; magic word found, check control summ
286		285
287	movzx ecx, byte[edi + 9]	286	movzx ecx, byte[edi + 9]
288	shl ecx, 4	287	shl ecx, 4
289	mov esi, edi	288	mov esi, edi
290	xor eax, eax	289	xor eax, eax
291	cld ; paranoia	290	cld ; paranoia
292	@@: lodsb	291	@@: lodsb
293	add ah, al	292	add ah, al
294	loop @b	293	loop @b
295	jnz .pcibios_nxt2 ; control summ must be zero	294	jnz .pcibios_nxt2 ; control summ must be zero
296	; BIOS32 service found !	295	; BIOS32 service found !
297	mov ebp, [edi + 4]	296	mov ebp, [edi + 4]
298	mov [bios32_entry], ebp	297	mov [bios32_entry], ebp
299	; check PCI BIOS present	298	; check PCI BIOS present
300	mov eax, '$PCI'	299	mov eax, '$PCI'
301	xor ebx, ebx	300	xor ebx, ebx
302	push cs ; special for 'ret far' from BIOS	301	push cs ; special for 'ret far' from BIOS
303	call ebp	302	call ebp
304	test al, al	303	test al, al
305	jnz .PCI_BIOS32_not_found	304	jnz .PCI_BIOS32_not_found
306		305
307	; çäåñü ñîçäàþòñÿ äèñêðèïòîðû äëÿ PCI BIOS	306	; çäåñü ñîçäàþòñÿ äèñêðèïòîðû äëÿ PCI BIOS
308		307
309	add ebx, OS_BASE	308	add ebx, OS_BASE
310	dec ecx	309	dec ecx
311	mov [(pci_code_32-OS_BASE)], cx ;limit 0-15	310	mov [(pci_code_32-OS_BASE)], cx ;limit 0-15
312	mov [(pci_data_32-OS_BASE)], cx ;limit 0-15	311	mov [(pci_data_32-OS_BASE)], cx ;limit 0-15
313		312
314	mov [(pci_code_32-OS_BASE)+2], bx ;base 0-15	313	mov [(pci_code_32-OS_BASE)+2], bx ;base 0-15
315	mov [(pci_data_32-OS_BASE)+2], bx ;base 0-15	314	mov [(pci_data_32-OS_BASE)+2], bx ;base 0-15
316		315
317	shr ebx, 16	316	shr ebx, 16
318	mov [(pci_code_32-OS_BASE)+4], bl ;base 16-23	317	mov [(pci_code_32-OS_BASE)+4], bl ;base 16-23
319	mov [(pci_data_32-OS_BASE)+4], bl ;base 16-23	318	mov [(pci_data_32-OS_BASE)+4], bl ;base 16-23
320		319
321	shr ecx, 16	320	shr ecx, 16
322	and cl, 0x0F	321	and cl, 0x0F
323	mov ch, bh	322	mov ch, bh
324	add cx, D32	323	add cx, D32
325	mov [(pci_code_32-OS_BASE)+6], cx ;lim 16-19 &	324	mov [(pci_code_32-OS_BASE)+6], cx ;lim 16-19 &
326	mov [(pci_data_32-OS_BASE)+6], cx ;base 24-31	325	mov [(pci_data_32-OS_BASE)+6], cx ;base 24-31
327		326
328	mov [(pci_bios_entry-OS_BASE)], edx	327	mov [(pci_bios_entry-OS_BASE)], edx
329	; jmp .end	328	; jmp .end
330	.PCI_BIOS32_not_found:	329	.PCI_BIOS32_not_found:
331	; çäåñü äîëæíà çàïîëíÿòñÿ pci_emu_dat	330	; çäåñü äîëæíà çàïîëíÿòñÿ pci_emu_dat
332	.BIOS32_not_found:	331	.BIOS32_not_found:
333	.end:	332	.end:
334	ret	333	ret
335		334
336	align 4	335	align 4
337	proc test_cpu	336	proc test_cpu
338	locals	337	locals
339	cpu_type dd ?	338	cpu_type dd ?
340	cpu_id dd ?	339	cpu_id dd ?
341	cpu_Intel dd ?	340	cpu_Intel dd ?
342	cpu_AMD dd ?	341	cpu_AMD dd ?
343	endl	342	endl
344		343
345	xor eax, eax	344	xor eax, eax
346	mov [cpu_type], eax	345	mov [cpu_type], eax
347	mov [cpu_caps-OS_BASE], eax	346	mov [cpu_caps-OS_BASE], eax
348	mov [cpu_caps+4-OS_BASE], eax	347	mov [cpu_caps+4-OS_BASE], eax
349		348
350	pushfd	349	pushfd
351	pop eax	350	pop eax
352	mov ecx, eax	351	mov ecx, eax
353	xor eax, 0x40000	352	xor eax, 0x40000
354	push eax	353	push eax
355	popfd	354	popfd
356	pushfd	355	pushfd
357	pop eax	356	pop eax
358	xor eax, ecx	357	xor eax, ecx
359	mov [cpu_type], CPU_386	358	mov [cpu_type], CPU_386
360	jz .end_cpuid	359	jz .end_cpuid
361	push ecx	360	push ecx
362	popfd	361	popfd
363		362
364	mov [cpu_type], CPU_486	363	mov [cpu_type], CPU_486
365	mov eax, ecx	364	mov eax, ecx
366	xor eax, 0x200000	365	xor eax, 0x200000
367	push eax	366	push eax
368	popfd	367	popfd
369	pushfd	368	pushfd
370	pop eax	369	pop eax
371	xor eax, ecx	370	xor eax, ecx
372	je .end_cpuid	371	je .end_cpuid
373	mov [cpu_id], 1	372	mov [cpu_id], 1
374		373
375	xor eax, eax	374	xor eax, eax
376	cpuid	375	cpuid
377		376
378	mov [cpu_vendor-OS_BASE], ebx	377	mov [cpu_vendor-OS_BASE], ebx
379	mov [cpu_vendor+4-OS_BASE], edx	378	mov [cpu_vendor+4-OS_BASE], edx
380	mov [cpu_vendor+8-OS_BASE], ecx	379	mov [cpu_vendor+8-OS_BASE], ecx
381	cmp ebx, dword [intel_str-OS_BASE]	380	cmp ebx, dword [intel_str-OS_BASE]
382	jne .check_AMD	381	jne .check_AMD
383	cmp edx, dword [intel_str+4-OS_BASE]	382	cmp edx, dword [intel_str+4-OS_BASE]
384	jne .check_AMD	383	jne .check_AMD
385	cmp ecx, dword [intel_str+8-OS_BASE]	384	cmp ecx, dword [intel_str+8-OS_BASE]
386	jne .check_AMD	385	jne .check_AMD
387	mov [cpu_Intel], 1	386	mov [cpu_Intel], 1
388	cmp eax, 1	387	cmp eax, 1
389	jl .end_cpuid	388	jl .end_cpuid
390	mov eax, 1	389	mov eax, 1
391	cpuid	390	cpuid
392	mov [cpu_sign-OS_BASE], eax	391	mov [cpu_sign-OS_BASE], eax
393	mov [cpu_info-OS_BASE], ebx	392	mov [cpu_info-OS_BASE], ebx
394	mov [cpu_caps-OS_BASE], edx	393	mov [cpu_caps-OS_BASE], edx
395	mov [cpu_caps+4-OS_BASE],ecx	394	mov [cpu_caps+4-OS_BASE],ecx
396		395
397	shr eax, 8	396	shr eax, 8
398	and eax, 0x0f	397	and eax, 0x0f
399	ret	398	ret
400	.end_cpuid:	399	.end_cpuid:
401	mov eax, [cpu_type]	400	mov eax, [cpu_type]
402	ret	401	ret
403		402
404	.check_AMD:	403	.check_AMD:
405	cmp ebx, dword [AMD_str-OS_BASE]	404	cmp ebx, dword [AMD_str-OS_BASE]
406	jne .unknown	405	jne .unknown
407	cmp edx, dword [AMD_str+4-OS_BASE]	406	cmp edx, dword [AMD_str+4-OS_BASE]
408	jne .unknown	407	jne .unknown
409	cmp ecx, dword [AMD_str+8-OS_BASE]	408	cmp ecx, dword [AMD_str+8-OS_BASE]
410	jne .unknown	409	jne .unknown
411	mov [cpu_AMD], 1	410	mov [cpu_AMD], 1
412	cmp eax, 1	411	cmp eax, 1
413	jl .unknown	412	jl .unknown
414	mov eax, 1	413	mov eax, 1
415	cpuid	414	cpuid
416	mov [cpu_sign-OS_BASE], eax	415	mov [cpu_sign-OS_BASE], eax
417	mov [cpu_info-OS_BASE], ebx	416	mov [cpu_info-OS_BASE], ebx
418	mov [cpu_caps-OS_BASE], edx	417	mov [cpu_caps-OS_BASE], edx
419	mov [cpu_caps+4-OS_BASE],ecx	418	mov [cpu_caps+4-OS_BASE],ecx
420	shr eax, 8	419	shr eax, 8
421	and eax, 0x0f	420	and eax, 0x0f
422	ret	421	ret
423	.unknown:	422	.unknown:
424	mov eax, 1	423	mov eax, 1
425	cpuid	424	cpuid
426	mov [cpu_sign-OS_BASE], eax	425	mov [cpu_sign-OS_BASE], eax
427	mov [cpu_info-OS_BASE], ebx	426	mov [cpu_info-OS_BASE], ebx
428	mov [cpu_caps-OS_BASE], edx	427	mov [cpu_caps-OS_BASE], edx
429	mov [cpu_caps+4-OS_BASE],ecx	428	mov [cpu_caps+4-OS_BASE],ecx
430	shr eax, 8	429	shr eax, 8
431	and eax, 0x0f	430	and eax, 0x0f
432	ret	431	ret
433	endp	432	endp

Subversion Repositories Kolibri OS

(root)/kernel/trunk/init.inc – Rev 1455 → 2129