Subversion Repositories Kolibri OS

Rev

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]