Rev 2434 | Rev 2441 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2434 | Rev 2439 | ||
---|---|---|---|
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: 2434 $ |
8 | $Revision: 2439 $ |
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 | 268 | ||
269 | ret |
269 | ret |
270 | endp |
270 | endp |
271 | 271 | ||
272 | align 4 |
272 | align 4 |
273 | 273 | ||
274 | init_BIOS32: |
274 | init_BIOS32: |
275 | mov edi, 0xE0000 |
275 | mov edi, 0xE0000 |
276 | .pcibios_nxt: |
276 | .pcibios_nxt: |
277 | cmp dword[edi], '_32_'; "magic" word |
277 | cmp dword[edi], '_32_'; "magic" word |
278 | je .BIOS32_found |
278 | je .BIOS32_found |
279 | .pcibios_nxt2: |
279 | .pcibios_nxt2: |
280 | add edi, 0x10 |
280 | add edi, 0x10 |
281 | cmp edi, 0xFFFF0 |
281 | cmp edi, 0xFFFF0 |
282 | je .BIOS32_not_found |
282 | je .BIOS32_not_found |
283 | jmp .pcibios_nxt |
283 | jmp .pcibios_nxt |
284 | .BIOS32_found: ; magic word found, check control summ |
284 | .BIOS32_found: ; magic word found, check control summ |
285 | 285 | ||
286 | movzx ecx, byte[edi + 9] |
286 | movzx ecx, byte[edi + 9] |
287 | shl ecx, 4 |
287 | shl ecx, 4 |
288 | mov esi, edi |
288 | mov esi, edi |
289 | xor eax, eax |
289 | xor eax, eax |
290 | cld ; paranoia |
290 | cld ; paranoia |
291 | @@: |
291 | @@: |
292 | lodsb |
292 | lodsb |
293 | add ah, al |
293 | add ah, al |
294 | loop @b |
294 | loop @b |
295 | jnz .pcibios_nxt2; control summ must be zero |
295 | jnz .pcibios_nxt2; control summ must be zero |
296 | ; BIOS32 service found ! |
296 | ; BIOS32 service found ! |
297 | mov ebp, [edi + 4] |
297 | mov ebp, [edi + 4] |
298 | mov [bios32_entry], ebp |
298 | mov [bios32_entry], ebp |
299 | ; check PCI BIOS present |
299 | ; check PCI BIOS present |
300 | mov eax, '$PCI' |
300 | mov eax, '$PCI' |
301 | xor ebx, ebx |
301 | xor ebx, ebx |
302 | push cs ; special for 'ret far' from BIOS |
302 | push cs ; special for 'ret far' from BIOS |
303 | call ebp |
303 | call ebp |
304 | test al, al |
304 | test al, al |
305 | jnz .PCI_BIOS32_not_found |
305 | jnz .PCI_BIOS32_not_found |
306 | 306 | ||
307 | ; çäåñü ñîçäà þòñÿ äèñêðèïòîðû äëÿ PCI BIOS |
307 | ; çäåñü ñîçäà þòñÿ äèñêðèïòîðû äëÿ PCI BIOS |
308 | 308 | ||
309 | add ebx, OS_BASE |
309 | add ebx, OS_BASE |
310 | dec ecx |
310 | dec ecx |
311 | mov [(pci_code_32-OS_BASE)], cx ;limit 0-15 |
311 | mov [(pci_code_32-OS_BASE)], cx ;limit 0-15 |
312 | mov [(pci_data_32-OS_BASE)], cx ;limit 0-15 |
312 | mov [(pci_data_32-OS_BASE)], cx ;limit 0-15 |
313 | 313 | ||
314 | mov [(pci_code_32-OS_BASE)+2], bx ;base 0-15 |
314 | mov [(pci_code_32-OS_BASE)+2], bx ;base 0-15 |
315 | mov [(pci_data_32-OS_BASE)+2], bx ;base 0-15 |
315 | mov [(pci_data_32-OS_BASE)+2], bx ;base 0-15 |
316 | 316 | ||
317 | shr ebx, 16 |
317 | shr ebx, 16 |
318 | mov [(pci_code_32-OS_BASE)+4], bl ;base 16-23 |
318 | mov [(pci_code_32-OS_BASE)+4], bl ;base 16-23 |
319 | mov [(pci_data_32-OS_BASE)+4], bl ;base 16-23 |
319 | mov [(pci_data_32-OS_BASE)+4], bl ;base 16-23 |
320 | 320 | ||
321 | shr ecx, 16 |
321 | shr ecx, 16 |
322 | and cl, 0x0F |
322 | and cl, 0x0F |
323 | mov ch, bh |
323 | mov ch, bh |
324 | add cx, D32 |
324 | add cx, D32 |
325 | mov [(pci_code_32-OS_BASE)+6], cx ;lim 16-19 & |
325 | mov [(pci_code_32-OS_BASE)+6], cx ;lim 16-19 & |
326 | mov [(pci_data_32-OS_BASE)+6], cx ;base 24-31 |
326 | mov [(pci_data_32-OS_BASE)+6], cx ;base 24-31 |
327 | 327 | ||
328 | mov [(pci_bios_entry-OS_BASE)], edx |
328 | mov [(pci_bios_entry-OS_BASE)], edx |
329 | ; jmp .end |
329 | ; jmp .end |
330 | .PCI_BIOS32_not_found: |
330 | .PCI_BIOS32_not_found: |
331 | ; çäåñü äîëæÃà çà ïîëÃÿòñÿ pci_emu_dat |
331 | ; çäåñü äîëæÃà çà ïîëÃÿòñÿ pci_emu_dat |
332 | .BIOS32_not_found: |
332 | .BIOS32_not_found: |
333 | .end: |
333 | .end: |
334 | ret |
334 | ret |
335 | 335 | ||
336 | align 4 |
336 | align 4 |
337 | proc test_cpu |
337 | proc test_cpu |
338 | locals |
338 | locals |
339 | cpu_type dd ? |
339 | cpu_type dd ? |
340 | cpu_id dd ? |
340 | cpu_id dd ? |
341 | cpu_Intel dd ? |
341 | cpu_Intel dd ? |
342 | cpu_AMD dd ? |
342 | cpu_AMD dd ? |
343 | endl |
343 | endl |
344 | 344 | ||
345 | xor eax, eax |
345 | xor eax, eax |
346 | mov [cpu_type], eax |
346 | mov [cpu_type], eax |
347 | mov [cpu_caps-OS_BASE], eax |
347 | mov [cpu_caps-OS_BASE], eax |
348 | mov [cpu_caps+4-OS_BASE], eax |
348 | mov [cpu_caps+4-OS_BASE], eax |
349 | 349 | ||
350 | pushfd |
350 | pushfd |
351 | pop eax |
351 | pop eax |
352 | mov ecx, eax |
352 | mov ecx, eax |
353 | xor eax, 0x40000 |
353 | xor eax, 0x40000 |
354 | push eax |
354 | push eax |
355 | popfd |
355 | popfd |
356 | pushfd |
356 | pushfd |
357 | pop eax |
357 | pop eax |
358 | xor eax, ecx |
358 | xor eax, ecx |
359 | mov [cpu_type], CPU_386 |
359 | mov [cpu_type], CPU_386 |
360 | jz .end_cpuid |
360 | jz .end_cpuid |
361 | push ecx |
361 | push ecx |
362 | popfd |
362 | popfd |
363 | 363 | ||
364 | mov [cpu_type], CPU_486 |
364 | mov [cpu_type], CPU_486 |
365 | mov eax, ecx |
365 | mov eax, ecx |
366 | xor eax, 0x200000 |
366 | xor eax, 0x200000 |
367 | push eax |
367 | push eax |
368 | popfd |
368 | popfd |
369 | pushfd |
369 | pushfd |
370 | pop eax |
370 | pop eax |
371 | xor eax, ecx |
371 | xor eax, ecx |
372 | je .end_cpuid |
372 | je .end_cpuid |
373 | mov [cpu_id], 1 |
373 | mov [cpu_id], 1 |
374 | 374 | ||
375 | xor eax, eax |
375 | xor eax, eax |
376 | cpuid |
376 | cpuid |
377 | 377 | ||
378 | mov [cpu_vendor-OS_BASE], ebx |
378 | mov [cpu_vendor-OS_BASE], ebx |
379 | mov [cpu_vendor+4-OS_BASE], edx |
379 | mov [cpu_vendor+4-OS_BASE], edx |
380 | mov [cpu_vendor+8-OS_BASE], ecx |
380 | mov [cpu_vendor+8-OS_BASE], ecx |
381 | cmp ebx, dword [intel_str-OS_BASE] |
381 | cmp ebx, dword [intel_str-OS_BASE] |
382 | jne .check_AMD |
382 | jne .check_AMD |
383 | cmp edx, dword [intel_str+4-OS_BASE] |
383 | cmp edx, dword [intel_str+4-OS_BASE] |
384 | jne .check_AMD |
384 | jne .check_AMD |
385 | cmp ecx, dword [intel_str+8-OS_BASE] |
385 | cmp ecx, dword [intel_str+8-OS_BASE] |
386 | jne .check_AMD |
386 | jne .check_AMD |
387 | mov [cpu_Intel], 1 |
387 | mov [cpu_Intel], 1 |
388 | cmp eax, 1 |
388 | cmp eax, 1 |
389 | jl .end_cpuid |
389 | jl .end_cpuid |
390 | mov eax, 1 |
390 | mov eax, 1 |
391 | cpuid |
391 | cpuid |
392 | mov [cpu_sign-OS_BASE], eax |
392 | mov [cpu_sign-OS_BASE], eax |
393 | mov [cpu_info-OS_BASE], ebx |
393 | mov [cpu_info-OS_BASE], ebx |
394 | mov [cpu_caps-OS_BASE], edx |
394 | mov [cpu_caps-OS_BASE], edx |
395 | mov [cpu_caps+4-OS_BASE], ecx |
395 | mov [cpu_caps+4-OS_BASE], ecx |
396 | 396 | ||
397 | shr eax, 8 |
397 | shr eax, 8 |
398 | and eax, 0x0f |
398 | and eax, 0x0f |
399 | ret |
399 | ret |
400 | .end_cpuid: |
400 | .end_cpuid: |
401 | mov eax, [cpu_type] |
401 | mov eax, [cpu_type] |
402 | ret |
402 | ret |
403 | 403 | ||
404 | .check_AMD: |
404 | .check_AMD: |
405 | cmp ebx, dword [AMD_str-OS_BASE] |
405 | cmp ebx, dword [AMD_str-OS_BASE] |
406 | jne .unknown |
406 | jne .unknown |
407 | cmp edx, dword [AMD_str+4-OS_BASE] |
407 | cmp edx, dword [AMD_str+4-OS_BASE] |
408 | jne .unknown |
408 | jne .unknown |
409 | cmp ecx, dword [AMD_str+8-OS_BASE] |
409 | cmp ecx, dword [AMD_str+8-OS_BASE] |
410 | jne .unknown |
410 | jne .unknown |
411 | mov [cpu_AMD], 1 |
411 | mov [cpu_AMD], 1 |
412 | cmp eax, 1 |
412 | cmp eax, 1 |
413 | jl .unknown |
413 | jl .unknown |
414 | mov eax, 1 |
414 | mov eax, 1 |
415 | cpuid |
415 | cpuid |
416 | mov [cpu_sign-OS_BASE], eax |
416 | mov [cpu_sign-OS_BASE], eax |
417 | mov [cpu_info-OS_BASE], ebx |
417 | mov [cpu_info-OS_BASE], ebx |
418 | mov [cpu_caps-OS_BASE], edx |
418 | mov [cpu_caps-OS_BASE], edx |
419 | mov [cpu_caps+4-OS_BASE], ecx |
419 | mov [cpu_caps+4-OS_BASE], ecx |
420 | shr eax, 8 |
420 | shr eax, 8 |
421 | and eax, 0x0f |
421 | and eax, 0x0f |
422 | ret |
422 | ret |
423 | .unknown: |
423 | .unknown: |
424 | mov eax, 1 |
424 | mov eax, 1 |
425 | cpuid |
425 | cpuid |
426 | mov [cpu_sign-OS_BASE], eax |
426 | mov [cpu_sign-OS_BASE], eax |
427 | mov [cpu_info-OS_BASE], ebx |
427 | mov [cpu_info-OS_BASE], ebx |
428 | mov [cpu_caps-OS_BASE], edx |
428 | mov [cpu_caps-OS_BASE], edx |
429 | mov [cpu_caps+4-OS_BASE], ecx |
429 | mov [cpu_caps+4-OS_BASE], ecx |
430 | shr eax, 8 |
430 | shr eax, 8 |
431 | and eax, 0x0f |
431 | and eax, 0x0f |
432 | ret |
432 | ret |
433 | endp |
433 | endp |
- | 434 | ||
- | 435 | iglobal |
|
- | 436 | align 4 |
|
- | 437 | acpi_lapic_base dd 0xfee00000 ; default local apic base |
|
- | 438 | endg |
|
434 | 439 | ||
435 | uglobal |
440 | uglobal |
436 | align 4 |
441 | align 4 |
437 | acpi_rsdp rd 1 |
442 | acpi_rsdp rd 1 |
438 | acpi_rsdt rd 1 |
443 | acpi_rsdt rd 1 |
439 | acpi_madt rd 1 |
444 | acpi_madt rd 1 |
440 | 445 | ||
441 | acpi_dev_data rd 1 |
446 | acpi_dev_data rd 1 |
442 | acpi_dev_size rd 1 |
447 | acpi_dev_size rd 1 |
443 | 448 | ||
444 | acpi_rsdt_base rd 1 |
449 | acpi_rsdt_base rd 1 |
445 | acpi_madt_base rd 1 |
450 | acpi_madt_base rd 1 |
446 | acpi_lapic_base rd 1 |
- | |
447 | acpi_ioapic_base rd 1 |
451 | acpi_ioapic_base rd 1 |
- | 452 | ||
- | 453 | cpu_count rd 1 |
|
- | 454 | smpt rd 16 |
|
448 | endg |
455 | endg |
449 | 456 | ||
450 | ACPI_HI_RSDP_WINDOW_START equ 0x000E0000 |
457 | ACPI_HI_RSDP_WINDOW_START equ 0x000E0000 |
451 | ACPI_HI_RSDP_WINDOW_END equ 0x00100000 |
458 | ACPI_HI_RSDP_WINDOW_END equ 0x00100000 |
452 | ACPI_RSDP_CHECKSUM_LENGTH equ 20 |
459 | ACPI_RSDP_CHECKSUM_LENGTH equ 20 |
453 | ACPI_MADT_SIGN equ 0x43495041 |
460 | ACPI_MADT_SIGN equ 0x43495041 |
454 | 461 | ||
455 | 462 | ||
456 | acpi_locate: |
463 | acpi_locate: |
457 | push ebx |
464 | push ebx |
458 | mov ebx, ACPI_HI_RSDP_WINDOW_START |
465 | mov ebx, ACPI_HI_RSDP_WINDOW_START |
459 | .check: |
466 | .check: |
460 | cmp [ebx], dword 0x20445352 |
467 | cmp [ebx], dword 0x20445352 |
461 | jne .next |
468 | jne .next |
462 | cmp [ebx+4], dword 0x20525450 |
469 | cmp [ebx+4], dword 0x20525450 |
463 | jne .next |
470 | jne .next |
464 | 471 | ||
465 | mov edx, ebx |
472 | mov edx, ebx |
466 | mov ecx, ACPI_RSDP_CHECKSUM_LENGTH |
473 | mov ecx, ACPI_RSDP_CHECKSUM_LENGTH |
467 | xor eax, eax |
474 | xor eax, eax |
468 | .sum: |
475 | .sum: |
469 | add al, [edx] |
476 | add al, [edx] |
470 | inc edx |
477 | inc edx |
471 | loop .sum |
478 | loop .sum |
472 | 479 | ||
473 | test al, al |
480 | test al, al |
474 | jnz .next |
481 | jnz .next |
475 | 482 | ||
476 | mov eax, ebx |
483 | mov eax, ebx |
477 | pop ebx |
484 | pop ebx |
478 | ret |
485 | ret |
479 | .next: |
486 | .next: |
480 | add ebx, 16 |
487 | add ebx, 16 |
481 | cmp ebx, ACPI_HI_RSDP_WINDOW_END |
488 | cmp ebx, ACPI_HI_RSDP_WINDOW_END |
482 | jb .check |
489 | jb .check |
483 | 490 | ||
484 | pop ebx |
491 | pop ebx |
485 | xor eax, eax |
492 | xor eax, eax |
486 | ret |
493 | ret |
487 | 494 | ||
488 | align 4 |
495 | align 4 |
489 | rsdt_find: ;ecx= rsdt edx= SIG |
496 | rsdt_find: ;ecx= rsdt edx= SIG |
490 | push ebx |
497 | push ebx |
491 | push esi |
498 | push esi |
492 | 499 | ||
493 | lea ebx, [ecx+36] |
500 | lea ebx, [ecx+36] |
494 | mov esi, [ecx+4] |
501 | mov esi, [ecx+4] |
495 | add esi, ecx |
502 | add esi, ecx |
- | 503 | align 4 |
|
496 | .next: |
504 | .next: |
497 | mov eax, [ebx] |
505 | mov eax, [ebx] |
498 | cmp [eax], edx |
506 | cmp [eax], edx |
499 | je .done |
507 | je .done |
500 | 508 | ||
501 | add ebx, 4 |
509 | add ebx, 4 |
502 | cmp ebx, esi |
510 | cmp ebx, esi |
503 | jb .next |
511 | jb .next |
504 | 512 | ||
505 | xor eax, eax |
513 | xor eax, eax |
506 | pop esi |
514 | pop esi |
507 | pop ebx |
515 | pop ebx |
508 | ret |
516 | ret |
509 | 517 | ||
510 | .done: |
518 | .done: |
511 | mov eax, [ebx] |
519 | mov eax, [ebx] |
512 | pop esi |
520 | pop esi |
513 | pop ebx |
521 | pop ebx |
514 | ret |
522 | ret |
515 | - | ||
516 | 523 | ||
- | 524 | align 4 |
|
- | 525 | madt_find: |
|
- | 526 | ||
- | 527 | ||
- | 528 | ||
- | 529 | ||
- | 530 | ||
- | 531 | ret |
|
517 | align 4 |
532 | |
518 | 533 | align 4 |
|
519 | check_acpi: |
534 | check_acpi: |
520 | 535 | ||
521 | call acpi_locate |
536 | call acpi_locate |
522 | test eax, eax |
537 | test eax, eax |
523 | jz .done |
538 | jz .done |
524 | 539 | ||
525 | mov ecx, [eax+16] |
540 | mov ecx, [eax+16] |
526 | mov edx, ACPI_MADT_SIGN |
541 | mov edx, ACPI_MADT_SIGN |
527 | mov [acpi_rsdt_base-OS_BASE], ecx |
542 | mov [acpi_rsdt_base-OS_BASE], ecx |
528 | call rsdt_find |
543 | call rsdt_find |
529 | test eax, eax |
544 | test eax, eax |
530 | jz .done |
545 | jz .done |
- | 546 | ||
- | 547 | xchg bx, bx |
|
531 | 548 | ||
532 | mov [acpi_madt_base-OS_BASE], eax |
549 | mov [acpi_madt_base-OS_BASE], eax |
533 | mov ecx, [eax+36] |
550 | mov ecx, [eax+36] |
534 | mov [acpi_lapic_base-OS_BASE], ecx |
551 | mov [acpi_lapic_base-OS_BASE], ecx |
- | 552 | ||
- | 553 | mov edi, smpt-OS_BASE |
|
- | 554 | mov ebx, [ecx+0x20] |
|
- | 555 | shr ebx, 24 ; read APIC ID |
|
- | 556 | ||
- | 557 | mov [edi], ebx ; bootstrap always first |
|
- | 558 | inc [cpu_count] |
|
- | 559 | add edi, 4 |
|
535 | 560 | ||
536 | lea edx, [eax+44] |
561 | lea edx, [eax+44] |
537 | mov ecx, [eax+4] |
562 | mov ecx, [eax+4] |
538 | add ecx, eax |
563 | add ecx, eax |
539 | .check: |
564 | .check: |
540 | mov eax, [edx] |
565 | mov eax, [edx] |
541 | cmp al, 1 |
566 | cmp al, 0 |
542 | je .ioapic |
567 | jne .io_apic |
- | 568 | ||
- | 569 | shr eax, 24 ; get APIC ID |
|
- | 570 | cmp eax, ebx ; skip self |
|
- | 571 | je .next |
|
- | 572 | ||
- | 573 | test [edx+4], byte 1 ; is enabled ? |
|
- | 574 | jz .next |
|
- | 575 | ||
- | 576 | cmp [cpu_count-OS_BASE], 16 |
|
- | 577 | jae .next |
|
- | 578 | ||
- | 579 | stosd ; store APIC ID |
|
543 | 580 | inc [cpu_count-OS_BASE] |
|
- | 581 | .next: |
|
544 | .next: |
582 | mov eax, [edx] |
545 | movzx eax, ah |
583 | movzx eax, ah |
546 | add edx, eax |
584 | add edx, eax |
547 | cmp edx, ecx |
585 | cmp edx, ecx |
548 | jb .check |
586 | jb .check |
549 | .done: |
587 | .done: |
550 | ret |
588 | ret |
- | 589 | ||
551 | .ioapic: |
590 | .io_apic: |
- | 591 | cmp al, 1 |
|
- | 592 | jne .next |
|
- | 593 | ||
552 | mov eax, [edx+4] |
594 | mov eax, [edx+4] |
553 | mov [acpi_ioapic_base-OS_BASE], eax |
595 | mov [acpi_ioapic_base-OS_BASE], eax |
554 | ret |
596 | jmp .next |