9,17 → 9,17 |
|
|
struc MEM_BLOCK |
{ |
.list LHEAD |
.next_block dd ? ;+8 |
{ .next_block dd ? |
.prev_block dd ? ;+4 |
.list_fd dd ? ;+8 |
.list_bk dd ? ;+12 |
.base dd ? ;+16 |
.size dd ? ;+20 |
.flags dd ? ;+24 |
.handle dd ? ;+28 |
.sizeof: |
} |
|
MEM_LIST_OFFSET equ 8 |
FREE_BLOCK equ 4 |
USED_BLOCK equ 8 |
DONT_FREE_BLOCK equ 10h |
28,11 → 28,12 |
MEM_BLOCK MEM_BLOCK |
end virtual |
|
MEM_BLOCK_SIZE equ 8*4 |
|
block_next equ MEM_BLOCK.next_block |
block_prev equ MEM_BLOCK.prev_block |
list_fd equ MEM_BLOCK.list.next |
list_bk equ MEM_BLOCK.list.prev |
list_fd equ MEM_BLOCK.list_fd |
list_bk equ MEM_BLOCK.list_bk |
block_base equ MEM_BLOCK.base |
block_size equ MEM_BLOCK.size |
block_flags equ MEM_BLOCK.flags |
46,6 → 47,37 |
@@: |
} |
|
macro remove_from_list op |
{ mov edx, [op+list_fd] |
mov ecx, [op+list_bk] |
test edx, edx |
jz @f |
mov [edx+list_bk], ecx |
@@: |
test ecx, ecx |
jz @f |
mov [ecx+list_fd], edx |
@@: |
mov [op+list_fd],0 |
mov [op+list_bk],0 |
} |
|
macro remove_from_free op |
{ |
remove_from_list op |
|
mov eax, [op+block_size] |
calc_index eax |
cmp [mem_block_list+eax*4], op |
jne @f |
mov [mem_block_list+eax*4], edx |
@@: |
cmp [mem_block_list+eax*4], 0 |
jne @f |
btr [mem_block_mask], eax |
@@: |
} |
|
macro remove_from_used op |
{ |
mov edx, [op+list_fd] |
56,25 → 88,25 |
mov [op+list_bk], 0 |
} |
|
;Initial heap state |
; |
;+heap_size terminator USED_BLOCK |
;+4096*MEM_BLOCK.sizeof free space FREE_BLOCK |
;HEAP_BASE heap_descriptors USED_BLOCK |
; |
|
align 4 |
proc init_kernel_heap |
|
mov ecx, 64 |
mov edi, mem_block_list |
@@: |
mov eax, edi |
stosd |
stosd |
loop @B |
xor eax, eax |
cld |
rep stosd |
|
mov eax, mem_used.fd |
mov ecx, 512/4 |
mov edi, mem_block_map |
not eax |
rep stosd |
|
mov [mem_block_start], mem_block_map |
mov [mem_block_end], mem_block_map+512 |
mov [mem_block_arr], HEAP_BASE |
|
mov eax, mem_used.fd-MEM_LIST_OFFSET |
mov [mem_used.fd], eax |
mov [mem_used.bk], eax |
|
89,10 → 121,8 |
dec ecx |
jnz .l1 |
|
mov edi, HEAP_BASE ;descriptors |
mov ebx, HEAP_BASE+MEM_BLOCK.sizeof ;free space |
mov ecx, HEAP_BASE+MEM_BLOCK.sizeof*2 ;terminator |
|
mov edi, HEAP_BASE |
mov ebx, HEAP_BASE+MEM_BLOCK_SIZE |
xor eax, eax |
mov [edi+block_next], ebx |
mov [edi+block_prev], eax |
99,24 → 129,18 |
mov [edi+list_fd], eax |
mov [edi+list_bk], eax |
mov [edi+block_base], HEAP_BASE |
mov [edi+block_size], 4096*MEM_BLOCK.sizeof |
mov [edi+block_size], 4096*MEM_BLOCK_SIZE |
mov [edi+block_flags], USED_BLOCK |
|
mov [ecx+block_next], eax |
mov [ecx+block_prev], ebx |
mov [edi+list_fd], eax |
mov [edi+list_bk], eax |
mov [edi+block_base], eax |
mov [edi+block_size], eax |
mov [edi+block_flags], USED_BLOCK |
mov [ebx+block_next], eax |
mov [ebx+block_prev], eax |
mov [ebx+list_fd], eax |
mov [ebx+list_bk], eax |
mov [ebx+block_base], HEAP_BASE+4096*MEM_BLOCK_SIZE |
|
mov [ebx+block_next], ecx |
mov [ebx+block_prev], edi |
mov [ebx+block_base], HEAP_BASE+4096*MEM_BLOCK.sizeof |
|
mov ecx, [pg_data.kernel_pages] |
shl ecx, 12 |
sub ecx, HEAP_BASE-OS_BASE+4096*MEM_BLOCK.sizeof |
sub ecx, HEAP_BASE-OS_BASE+4096*MEM_BLOCK_SIZE |
mov [heap_size], ecx |
mov [heap_free], ecx |
mov [ebx+block_size], ecx |
125,25 → 149,12 |
mov [mem_block_mask], eax |
mov [mem_block_mask+4],0x80000000 |
|
mov ecx, mem_block_list+63*8 |
list_add ebx, ecx |
|
mov ecx, 4096-3-1 |
mov eax, HEAP_BASE+MEM_BLOCK.sizeof*4 |
|
mov [next_memblock], HEAP_BASE+MEM_BLOCK.sizeof*3 |
@@: |
mov [eax-MEM_BLOCK.sizeof], eax |
add eax, MEM_BLOCK.sizeof |
loop @B |
|
mov [eax-MEM_BLOCK.sizeof], dword 0 |
|
|
mov [mem_block_list+63*4], ebx |
mov byte [mem_block_map], 0xFC |
mov ecx, heap_mutex |
call mutex_init |
mov [heap_blocks], 4094 |
mov [free_blocks], 4093 |
mov [heap_blocks], 4095 |
mov [free_blocks], 4094 |
ret |
endp |
|
180,18 → 191,11 |
bsf edi, edx |
jz .high_mask |
add ebx, edi |
lea ecx, [mem_block_list+ebx*8] |
mov edi, ecx |
.next: |
mov edi, [edi+list_fd] |
cmp edi, ecx |
je .err |
mov edi, [mem_block_list+ebx*4] |
.check_size: |
cmp eax, [edi+block_size] |
ja .next |
ret |
.err: |
xor edi, edi |
ret |
|
.high_mask: |
add esi, 4 |
200,24 → 204,66 |
add ebx, 32 |
mov edx, [esi] |
jmp .find |
.next: |
mov edi, [edi+list_fd] |
test edi, edi |
jnz .check_size |
.err: |
xor edi, edi |
ret |
|
align 4 |
alloc_mem_block: |
|
mov ebx, [mem_block_start] |
mov ecx, [mem_block_end] |
.l1: |
bsf eax,[ebx]; |
jnz found |
add ebx,4 |
cmp ebx, ecx |
jb .l1 |
xor eax,eax |
ret |
|
found: |
btr [ebx], eax |
mov [mem_block_start],ebx |
sub ebx, mem_block_map |
lea eax,[eax+ebx*8] |
shl eax, 5 |
add eax, [mem_block_arr] |
dec [free_blocks] |
ret |
align 4 |
free_mem_block: |
mov ebx, [next_memblock] |
mov [eax], ebx |
mov [next_memblock], eax |
xor ebx, ebx |
mov dword [eax], 0 |
mov dword [eax+4], 0 |
mov dword [eax+8], 0 |
mov dword [eax+12], 0 |
mov dword [eax+16], 0 |
; mov dword [eax+20], 0 |
mov dword [eax+24], 0 |
mov dword [eax+28], 0 |
|
mov dword [eax+4], ebx |
mov dword [eax+8], ebx |
mov dword [eax+12], ebx |
mov dword [eax+16], ebx |
; mov dword [eax+20], 0 ;don't clear block size |
mov dword [eax+24], ebx |
mov dword [eax+28], ebx |
sub eax, [mem_block_arr] |
shr eax, 5 |
|
mov ebx, mem_block_map |
bts [ebx], eax |
inc [free_blocks] |
shr eax, 3 |
and eax, not 3 |
add eax, ebx |
cmp [mem_block_start], eax |
ja @f |
ret |
@@: |
mov [mem_block_start], eax |
ret |
.err: |
xor eax, eax |
ret |
|
align 4 |
proc alloc_kernel_space stdcall, size:dword |
227,6 → 273,9 |
push esi |
push edi |
|
mov ecx, heap_mutex |
call mutex_lock |
|
mov eax, [size] |
add eax, 4095 |
and eax, not 4095 |
235,17 → 284,12 |
cmp eax, [heap_free] |
ja .error |
|
mov ecx, heap_mutex |
call mutex_lock |
|
mov eax, [size] |
|
call get_small_block ; eax |
test edi, edi |
jz .error_unlock |
jz .error |
|
cmp [edi+block_flags], FREE_BLOCK |
jne .error_unlock |
jne .error |
|
mov [block_ind], ebx ;index of allocated block |
|
253,13 → 297,11 |
cmp eax, [size] |
je .m_eq_size |
|
mov esi, [next_memblock] ;new memory block |
test esi, esi |
jz .error_unlock |
call alloc_mem_block |
and eax, eax |
jz .error |
|
dec [free_blocks] |
mov eax, [esi] |
mov [next_memblock], eax |
mov esi, eax ;esi - splitted block |
|
mov [esi+block_next], edi |
mov eax, [edi+block_prev] |
267,8 → 309,10 |
mov [edi+block_prev], esi |
mov [esi+list_fd], 0 |
mov [esi+list_bk], 0 |
and eax, eax |
jz @f |
mov [eax+block_next], esi |
|
@@: |
mov ebx, [edi+block_base] |
mov [esi+block_base], ebx |
mov edx, [size] |
277,23 → 321,34 |
sub [edi+block_size], edx |
|
mov eax, [edi+block_size] |
calc_index eax |
shr eax, 12 |
sub eax, 1 |
cmp eax, 63 |
jna @f |
mov eax, 63 |
@@: |
cmp eax, [block_ind] |
je .m_eq_ind |
|
list_del edi |
remove_from_list edi |
|
mov ecx, [block_ind] |
lea edx, [mem_block_list+ecx*8] |
cmp edx, [edx] |
mov [mem_block_list+ecx*4], edx |
|
test edx, edx |
jnz @f |
btr [mem_block_mask], ecx |
@@: |
mov edx, [mem_block_list+eax*4] |
mov [edi+list_fd], edx |
test edx, edx |
jz @f |
mov [edx+list_bk], edi |
@@: |
mov [mem_block_list+eax*4], edi |
bts [mem_block_mask], eax |
lea edx, [mem_block_list+eax*8] ;edx= list head |
list_add edi, edx |
.m_eq_ind: |
mov ecx, mem_used.fd |
mov ecx, mem_used.fd-MEM_LIST_OFFSET |
mov edx, [ecx+list_fd] |
mov [esi+list_fd], edx |
mov [esi+list_bk], ecx |
311,13 → 366,13 |
pop ebx |
ret |
.m_eq_size: |
list_del edi |
lea edx, [mem_block_list+ebx*8] |
cmp edx, [edx] |
remove_from_list edi |
mov [mem_block_list+ebx*4], edx |
and edx, edx |
jnz @f |
btr [mem_block_mask], ebx |
@@: |
mov ecx, mem_used.fd |
mov ecx, mem_used.fd-MEM_LIST_OFFSET |
mov edx, [ecx+list_fd] |
mov [edi+list_fd], edx |
mov [edi+list_bk], ecx |
334,11 → 389,9 |
pop esi |
pop ebx |
ret |
|
.error_unlock: |
.error: |
mov ecx, heap_mutex |
call mutex_unlock |
.error: |
xor eax, eax |
pop edi |
pop esi |
348,6 → 401,9 |
|
align 4 |
proc free_kernel_space stdcall uses ebx ecx edx esi edi, base:dword |
push ebx |
push esi |
push edi |
|
mov ecx, heap_mutex |
call mutex_lock |
355,7 → 411,7 |
mov eax, [base] |
mov esi, [mem_used.fd] |
@@: |
cmp esi, mem_used.fd |
cmp esi, mem_used.fd-MEM_LIST_OFFSET |
je .fail |
|
cmp [esi+block_base], eax |
370,28 → 426,31 |
add [heap_free], eax |
|
mov edi, [esi+block_next] |
test edi, edi |
jz .prev |
|
cmp [edi+block_flags], FREE_BLOCK |
jne .prev |
|
list_del edi |
remove_from_free edi |
|
mov edx, [edi+block_next] |
mov [esi+block_next], edx |
test edx, edx |
jz @f |
|
mov [edx+block_prev], esi |
@@: |
mov ecx, [edi+block_size] |
add [esi+block_size], ecx |
|
calc_index ecx |
|
lea edx, [mem_block_list+ecx*8] |
cmp edx, [edx] |
jne @F |
btr [mem_block_mask], ecx |
@@: |
mov eax, edi |
call free_mem_block |
.prev: |
mov edi, [esi+block_prev] |
test edi, edi |
jz .insert |
|
cmp [edi+block_flags], FREE_BLOCK |
jne .insert |
|
399,8 → 458,10 |
|
mov edx, [esi+block_next] |
mov [edi+block_next], edx |
test edx, edx |
jz @f |
mov [edx+block_prev], edi |
|
@@: |
mov eax, esi |
call free_mem_block |
|
409,41 → 470,70 |
add eax, ecx |
mov [edi+block_size], eax |
|
calc_index eax ;new index |
calc_index ecx ;old index |
calc_index eax |
calc_index ecx |
cmp eax, ecx |
je .m_eq |
|
push ecx |
list_del edi |
remove_from_list edi |
pop ecx |
|
lea edx, [mem_block_list+ecx*8] |
cmp edx, [edx] |
jne .add_block |
cmp [mem_block_list+ecx*4], edi |
jne @f |
mov [mem_block_list+ecx*4], edx |
@@: |
cmp [mem_block_list+ecx*4], 0 |
jne @f |
btr [mem_block_mask], ecx |
.add_block: |
@@: |
mov esi, [mem_block_list+eax*4] |
mov [mem_block_list+eax*4], edi |
mov [edi+list_fd], esi |
test esi, esi |
jz @f |
mov [esi+list_bk], edi |
@@: |
bts [mem_block_mask], eax |
lea edx, [mem_block_list+eax*8] |
list_add edi, edx |
.m_eq: |
mov ecx, heap_mutex |
call mutex_unlock |
xor eax, eax |
not eax |
pop edi |
pop esi |
pop ebx |
ret |
.insert: |
remove_from_used esi |
mov [esi+block_flags], FREE_BLOCK |
|
mov eax, [esi+block_size] |
calc_index eax |
mov edi, esi |
jmp .add_block |
|
mov edi, [mem_block_list+eax*4] |
mov [mem_block_list+eax*4], esi |
mov [esi+list_fd], edi |
test edi, edi |
jz @f |
mov [edi+list_bk], esi |
@@: |
bts [mem_block_mask], eax |
mov [esi+block_flags],FREE_BLOCK |
mov ecx, heap_mutex |
call mutex_unlock |
xor eax, eax |
not eax |
pop edi |
pop esi |
pop ebx |
ret |
.fail: |
mov ecx, heap_mutex |
call mutex_unlock |
xor eax, eax |
pop edi |
pop esi |
pop ebx |
ret |
endp |
|
531,7 → 621,7 |
mov eax, [base] |
mov esi, [mem_used.fd] |
@@: |
cmp esi, mem_used.fd |
cmp esi, mem_used.fd-MEM_LIST_OFFSET |
je .fail |
|
cmp [esi+block_base], eax |