Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
4429 | Serge | 1 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
2 | ;; ;; |
||
3 | ;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;; |
||
4 | ;; Distributed under terms of the GNU General Public License ;; |
||
5 | ;; ;; |
||
6 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
||
7 | |||
8 | $Revision: 4390 $ |
||
9 | |||
10 | |||
11 | MEM_WB equ 6 ;write-back memory |
||
12 | MEM_WC equ 1 ;write combined memory |
||
13 | MEM_UC equ 0 ;uncached memory |
||
14 | |||
15 | align 4 |
||
16 | proc mem_test |
||
17 | ; if we have BIOS with fn E820, skip the test |
||
18 | cmp dword [BOOT_VARS-OS_BASE + 0x9100], 0 |
||
19 | jnz .ret |
||
20 | |||
21 | mov eax, cr0 |
||
22 | and eax, not (CR0_CD+CR0_NW) |
||
23 | or eax, CR0_CD ;disable caching |
||
24 | mov cr0, eax |
||
25 | wbinvd ;invalidate cache |
||
26 | |||
27 | xor edi, edi |
||
28 | mov ebx, 'TEST' |
||
29 | @@: |
||
30 | add edi, 0x100000 |
||
31 | xchg ebx, dword [edi] |
||
32 | cmp dword [edi], 'TEST' |
||
33 | xchg ebx, dword [edi] |
||
34 | je @b |
||
35 | |||
36 | and eax, not (CR0_CD+CR0_NW) ;enable caching |
||
37 | mov cr0, eax |
||
38 | inc dword [BOOT_VARS-OS_BASE + 0x9100] |
||
39 | xor eax, eax |
||
40 | mov [BOOT_VARS-OS_BASE + 0x9104], eax |
||
41 | mov [BOOT_VARS-OS_BASE + 0x9108], eax |
||
42 | mov [BOOT_VARS-OS_BASE + 0x910C], edi |
||
43 | mov [BOOT_VARS-OS_BASE + 0x9110], eax |
||
44 | inc eax |
||
45 | mov [BOOT_VARS-OS_BASE + 0x9114], eax |
||
46 | .ret: |
||
47 | ret |
||
48 | endp |
||
49 | |||
50 | align 4 |
||
51 | proc init_mem |
||
52 | ; calculate maximum allocatable address and number of allocatable pages |
||
53 | mov edi, BOOT_VARS-OS_BASE + 0x9104 |
||
54 | mov ecx, [edi-4] |
||
55 | xor esi, esi; esi will hold total amount of memory |
||
56 | xor edx, edx; edx will hold maximum allocatable address |
||
57 | .calcmax: |
||
58 | ; round all to pages |
||
59 | mov eax, [edi] |
||
60 | cmp [edi+16], byte 1 |
||
61 | jne .unusable |
||
62 | |||
63 | test eax, 0xFFF |
||
64 | jz @f |
||
65 | neg eax |
||
66 | and eax, 0xFFF |
||
67 | add [edi], eax |
||
68 | adc dword [edi+4], 0 |
||
69 | sub [edi+8], eax |
||
70 | sbb dword [edi+12], 0 |
||
71 | jc .unusable |
||
72 | @@: |
||
73 | and dword [edi+8], not 0xFFF |
||
74 | jz .unusable |
||
75 | ; ignore memory after 4 Gb |
||
76 | cmp dword [edi+4], 0 |
||
77 | jnz .unusable |
||
78 | mov eax, [edi] |
||
79 | cmp dword [edi+12], 0 |
||
80 | jnz .overflow |
||
81 | add eax, [edi+8] |
||
82 | jnc @f |
||
83 | .overflow: |
||
84 | mov eax, 0xFFFFF000 |
||
85 | @@: |
||
86 | cmp edx, eax |
||
87 | jae @f |
||
88 | mov edx, eax |
||
89 | @@: |
||
90 | sub eax, [edi] |
||
91 | mov [edi+8], eax |
||
92 | add esi, eax |
||
93 | jmp .usable |
||
94 | .unusable: |
||
95 | ; and dword [edi+8], 0 |
||
96 | .usable: |
||
97 | add edi, 20 |
||
98 | loop .calcmax |
||
99 | .calculated: |
||
100 | mov [MEM_AMOUNT-OS_BASE], esi |
||
101 | mov [pg_data.mem_amount-OS_BASE], esi |
||
102 | shr esi, 12 |
||
103 | mov [pg_data.pages_count-OS_BASE], esi |
||
104 | |||
105 | shr edx, 12 |
||
106 | add edx, 31 |
||
107 | and edx, not 31 |
||
108 | shr edx, 3 |
||
109 | mov [pg_data.pagemap_size-OS_BASE], edx |
||
110 | |||
111 | add edx, (sys_pgmap-OS_BASE)+4095 |
||
112 | and edx, not 4095 |
||
113 | mov [tmp_page_tabs], edx |
||
114 | |||
115 | mov edx, esi |
||
116 | and edx, -1024 |
||
117 | cmp edx, (OS_BASE/4096) |
||
118 | jbe @F |
||
119 | mov edx, (OS_BASE/4096) |
||
120 | jmp .set |
||
121 | @@: |
||
122 | cmp edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096 |
||
123 | jae .set |
||
124 | mov edx, (HEAP_BASE-OS_BASE+HEAP_MIN_SIZE)/4096 |
||
125 | .set: |
||
126 | mov [pg_data.kernel_pages-OS_BASE], edx |
||
127 | shr edx, 10 |
||
128 | mov [pg_data.kernel_tables-OS_BASE], edx |
||
129 | |||
130 | xor eax, eax |
||
131 | mov edi, sys_proc-OS_BASE |
||
132 | mov ecx, 8192/4 |
||
133 | cld |
||
134 | rep stosd |
||
135 | |||
136 | mov edx, (sys_proc-OS_BASE+PROC.pdt_0)+ 0x800; (OS_BASE shr 20) |
||
137 | bt [cpu_caps-OS_BASE], CAPS_PSE |
||
138 | jnc .no_PSE |
||
139 | |||
140 | mov ebx, cr4 |
||
141 | or ebx, CR4_PSE |
||
142 | mov eax, PG_LARGE+PG_SW |
||
143 | mov cr4, ebx |
||
144 | dec [pg_data.kernel_tables-OS_BASE] |
||
145 | |||
146 | mov [edx], eax |
||
147 | add edx, 4 |
||
148 | |||
149 | mov edi, [tmp_page_tabs] |
||
150 | jmp .map_kernel_heap ; new kernel fits to the first 4Mb - nothing to do with ".map_low" |
||
151 | .no_PSE: |
||
152 | mov eax, PG_SW |
||
153 | mov ecx, [tmp_page_tabs] |
||
154 | shr ecx, 12 |
||
155 | .map_low: |
||
156 | mov edi, [tmp_page_tabs] |
||
157 | @@: ; |
||
158 | stosd |
||
159 | add eax, 0x1000 |
||
160 | dec ecx |
||
161 | jnz @B |
||
162 | |||
163 | .map_kernel_heap: |
||
164 | mov ecx, [pg_data.kernel_tables-OS_BASE] |
||
165 | shl ecx, 10 |
||
166 | xor eax, eax |
||
167 | rep stosd |
||
168 | |||
169 | mov ecx, [pg_data.kernel_tables-OS_BASE] |
||
170 | mov eax, [tmp_page_tabs] |
||
171 | or eax, PG_SW |
||
172 | mov edi, edx |
||
173 | |||
174 | .map_kernel_tabs: |
||
175 | stosd |
||
176 | add eax, 0x1000 |
||
177 | dec ecx |
||
178 | jnz .map_kernel_tabs |
||
179 | |||
180 | mov dword [sys_proc-OS_BASE+PROC.pdt_0+(page_tabs shr 20)], sys_proc+PROC.pdt_0+PG_SW-OS_BASE |
||
181 | |||
182 | mov edi, (sys_proc+PROC.pdt_0-OS_BASE) |
||
183 | lea esi, [edi+(OS_BASE shr 20)] |
||
184 | movsd |
||
185 | movsd |
||
186 | ret |
||
187 | endp |
||
188 | |||
189 | align 4 |
||
190 | proc init_page_map |
||
191 | ; mark all memory as unavailable |
||
192 | mov edi, sys_pgmap-OS_BASE |
||
193 | mov ecx, [pg_data.pagemap_size-OS_BASE] |
||
194 | shr ecx, 2 |
||
195 | xor eax, eax |
||
196 | cld |
||
197 | rep stosd |
||
198 | |||
199 | ; scan through memory map and mark free areas as available |
||
200 | mov ebx, BOOT_VARS-OS_BASE + 0x9104 |
||
201 | mov edx, [ebx-4] |
||
202 | .scanmap: |
||
203 | cmp [ebx+16], byte 1 |
||
204 | jne .next |
||
205 | |||
206 | mov ecx, [ebx+8] |
||
207 | shr ecx, 12; ecx = number of pages |
||
208 | jz .next |
||
209 | mov edi, [ebx] |
||
210 | shr edi, 12; edi = first page |
||
211 | mov eax, edi |
||
212 | shr edi, 5 |
||
213 | shl edi, 2 |
||
214 | add edi, sys_pgmap-OS_BASE |
||
215 | and eax, 31 |
||
216 | jz .startok |
||
217 | add ecx, eax |
||
218 | sub ecx, 32 |
||
219 | jbe .onedword |
||
220 | push ecx |
||
221 | mov ecx, eax |
||
222 | or eax, -1 |
||
223 | shl eax, cl |
||
224 | or [edi], eax |
||
225 | add edi, 4 |
||
226 | pop ecx |
||
227 | .startok: |
||
228 | push ecx |
||
229 | shr ecx, 5 |
||
230 | or eax, -1 |
||
231 | rep stosd |
||
232 | pop ecx |
||
233 | and ecx, 31 |
||
234 | neg eax |
||
235 | shl eax, cl |
||
236 | dec eax |
||
237 | or [edi], eax |
||
238 | jmp .next |
||
239 | .onedword: |
||
240 | add ecx, 32 |
||
241 | sub ecx, eax |
||
242 | @@: |
||
243 | bts [edi], eax |
||
244 | inc eax |
||
245 | loop @b |
||
246 | .next: |
||
247 | add ebx, 20 |
||
248 | dec edx |
||
249 | jnz .scanmap |
||
250 | |||
251 | ; mark kernel memory as allocated (unavailable) |
||
252 | mov ecx, [tmp_page_tabs] |
||
253 | mov edx, [pg_data.pages_count-OS_BASE] |
||
254 | shr ecx, 12 |
||
255 | add ecx, [pg_data.kernel_tables-OS_BASE] |
||
256 | sub edx, ecx |
||
257 | mov [pg_data.pages_free-OS_BASE], edx |
||
258 | |||
259 | mov edi, sys_pgmap-OS_BASE |
||
260 | mov ebx, ecx |
||
261 | shr ecx, 5 |
||
262 | xor eax, eax |
||
263 | rep stosd |
||
264 | |||
265 | not eax |
||
266 | mov ecx, ebx |
||
267 | and ecx, 31 |
||
268 | shl eax, cl |
||
269 | and [edi], eax |
||
270 | add edi, OS_BASE |
||
271 | mov [page_start-OS_BASE], edi; |
||
272 | |||
273 | mov ebx, sys_pgmap |
||
274 | add ebx, [pg_data.pagemap_size-OS_BASE] |