2006-10-06 08:09:41 +02:00
|
|
|
|
|
|
|
HEAP_BASE equ 0x01000000
|
|
|
|
;HEAP_SIZE equ 0x01000000
|
|
|
|
|
|
|
|
struc MEM_BLOCK
|
|
|
|
{ .next_block dd ?
|
|
|
|
.prev_block dd ? ;+4
|
|
|
|
.list_next dd ? ;+8
|
|
|
|
.list_prev dd ? ;+12
|
|
|
|
.base dd ? ;+16
|
|
|
|
.size dd ? ;+20
|
|
|
|
.flags dd ? ;+24
|
|
|
|
.handle dd ? ;+28
|
|
|
|
}
|
|
|
|
|
|
|
|
FREE_BLOCK equ 4
|
|
|
|
USED_BLOCK equ 8
|
|
|
|
|
|
|
|
virtual at 0
|
|
|
|
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_next equ MEM_BLOCK.list_next
|
|
|
|
list_prev equ MEM_BLOCK.list_prev
|
|
|
|
block_base equ MEM_BLOCK.base
|
|
|
|
block_size equ MEM_BLOCK.size
|
|
|
|
block_flags equ MEM_BLOCK.flags
|
|
|
|
|
|
|
|
macro calc_index op
|
|
|
|
{ shr op, 12
|
|
|
|
dec op
|
|
|
|
cmp op, 63
|
|
|
|
jna @f
|
|
|
|
mov op, 63
|
|
|
|
@@:
|
|
|
|
}
|
|
|
|
|
|
|
|
macro remove_from_list op
|
|
|
|
{ mov edx, [op+list_next]
|
|
|
|
mov ecx, [op+list_prev]
|
|
|
|
test edx, edx
|
|
|
|
jz @f
|
|
|
|
mov [edx+list_prev], ecx
|
|
|
|
@@:
|
|
|
|
test ecx, ecx
|
|
|
|
jz @f
|
|
|
|
mov [ecx+list_next], edx
|
|
|
|
@@:
|
|
|
|
mov [op+list_next],0
|
|
|
|
mov [op+list_prev],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
|
|
|
|
{
|
|
|
|
remove_from_list op
|
|
|
|
cmp [mem_used_list], op
|
|
|
|
jne @f
|
|
|
|
mov [mem_used_list], edx
|
|
|
|
@@:
|
|
|
|
}
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc init_kernel_heap
|
|
|
|
|
|
|
|
mov ecx, 64/4
|
|
|
|
mov edi, mem_block_list
|
|
|
|
xor eax, eax
|
|
|
|
cld
|
|
|
|
rep stosd
|
|
|
|
|
|
|
|
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
|
|
|
|
|
|
|
|
stdcall alloc_pages, dword 32
|
|
|
|
mov ecx, 32
|
|
|
|
mov edx, eax
|
|
|
|
mov edi, HEAP_BASE
|
|
|
|
.l1:
|
|
|
|
stdcall map_page,edi,edx,PG_SW
|
|
|
|
add edi, 0x1000
|
|
|
|
add edx, 0x1000
|
|
|
|
dec ecx
|
|
|
|
jnz .l1
|
|
|
|
|
|
|
|
mov edi, HEAP_BASE
|
|
|
|
mov ebx, edi
|
|
|
|
add ebx, MEM_BLOCK_SIZE
|
|
|
|
xor eax, eax
|
|
|
|
mov [edi+block_next], ebx
|
|
|
|
mov [edi+block_prev], eax
|
|
|
|
mov [edi+list_next], eax
|
|
|
|
mov [edi+list_prev], eax
|
|
|
|
mov [edi+block_base], HEAP_BASE
|
|
|
|
mov [edi+block_size], 4096*MEM_BLOCK_SIZE
|
|
|
|
mov [edi+block_flags], USED_BLOCK
|
|
|
|
|
|
|
|
mov [ebx+block_next], eax
|
|
|
|
mov [ebx+block_prev], eax
|
|
|
|
mov [ebx+list_next], eax
|
|
|
|
mov [ebx+block_base], HEAP_BASE+4096*MEM_BLOCK_SIZE
|
|
|
|
|
|
|
|
mov ecx, [MEM_AMOUNT]
|
2006-10-08 09:48:38 +02:00
|
|
|
sub ecx, 0x01000000 + 4096*MEM_BLOCK_SIZE
|
|
|
|
mov [heap_size], ecx
|
|
|
|
mov [heap_free], ecx
|
2006-10-06 08:09:41 +02:00
|
|
|
mov [ebx+block_size], ecx
|
|
|
|
mov [ebx+block_flags], FREE_BLOCK
|
|
|
|
|
|
|
|
mov [mem_block_mask], eax
|
|
|
|
mov [mem_block_mask+4],0x80000000
|
|
|
|
|
|
|
|
mov [mem_used_list], eax
|
|
|
|
mov [mem_block_list+63*4], ebx
|
|
|
|
mov byte [mem_block_map], 0xFC
|
2006-10-08 09:48:38 +02:00
|
|
|
mov [heap_blocks], 4095
|
|
|
|
mov [free_blocks], 4095
|
2006-10-06 08:09:41 +02:00
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc get_block stdcall, index:dword
|
|
|
|
|
|
|
|
mov eax, 63
|
|
|
|
mov ecx, [index]
|
|
|
|
cmp ecx, eax
|
|
|
|
jna @f
|
|
|
|
;cmova ecx, eax
|
|
|
|
mov ecx, eax
|
|
|
|
@@:
|
|
|
|
xor esi, esi
|
|
|
|
xor ebx, ebx
|
|
|
|
xor edx, edx
|
|
|
|
not edx
|
|
|
|
|
|
|
|
cmp ecx, 32
|
|
|
|
jb .bit_test
|
|
|
|
|
|
|
|
sub ecx, 32
|
|
|
|
add ebx, 32
|
|
|
|
add esi, 4
|
|
|
|
|
|
|
|
.bit_test:
|
|
|
|
shl edx, cl
|
|
|
|
and edx, [mem_block_mask+esi]
|
|
|
|
jz .high_mask
|
|
|
|
bsf eax, edx
|
|
|
|
add ebx, eax
|
|
|
|
mov eax, [mem_block_list+ebx*4]
|
|
|
|
ret
|
|
|
|
|
|
|
|
.high_mask:
|
|
|
|
|
|
|
|
add esi, 4
|
|
|
|
add ebx, 32
|
|
|
|
test esi, 0xFFFFFFF8
|
|
|
|
jnz .big_error
|
|
|
|
mov edx, [mem_block_mask+esi]
|
|
|
|
and edx, edx
|
|
|
|
jz .high_mask
|
|
|
|
bsf eax, edx
|
|
|
|
add ebx, eax
|
|
|
|
mov eax, [mem_block_list+ebx*4]
|
|
|
|
ret
|
|
|
|
|
|
|
|
.big_error:
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc alloc_mem_block
|
|
|
|
|
|
|
|
pushfd
|
|
|
|
cli
|
|
|
|
mov ebx, [mem_block_start]
|
|
|
|
mov ecx, [mem_block_end]
|
|
|
|
.l1:
|
|
|
|
bsf eax,[ebx];
|
|
|
|
jnz found
|
|
|
|
add ebx,4
|
|
|
|
cmp ebx, ecx
|
|
|
|
jb .l1
|
|
|
|
popfd
|
|
|
|
xor eax,eax
|
|
|
|
ret
|
|
|
|
|
|
|
|
found:
|
|
|
|
btr [ebx], eax
|
|
|
|
mov [mem_block_start],ebx
|
|
|
|
sub ebx, mem_block_map
|
|
|
|
shl ebx, 3
|
|
|
|
add eax,ebx
|
|
|
|
shl eax, 5
|
|
|
|
add eax, [mem_block_arr]
|
2006-10-08 09:48:38 +02:00
|
|
|
dec [free_blocks]
|
2006-10-06 08:09:41 +02:00
|
|
|
popfd
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
proc free_mem_block
|
|
|
|
pushfd
|
|
|
|
cli
|
|
|
|
sub eax, [mem_block_arr]
|
|
|
|
shr eax, 5
|
|
|
|
|
|
|
|
mov ebx, mem_block_map
|
|
|
|
bts [ebx], eax
|
2006-10-08 09:48:38 +02:00
|
|
|
inc [free_blocks]
|
2006-10-06 08:09:41 +02:00
|
|
|
shr eax, 3
|
|
|
|
and eax, not 3
|
|
|
|
add eax, ebx
|
|
|
|
cmp [mem_block_start], eax
|
|
|
|
ja @f
|
|
|
|
popfd
|
|
|
|
ret
|
|
|
|
@@:
|
|
|
|
mov [mem_block_start], eax
|
|
|
|
popfd
|
|
|
|
ret
|
|
|
|
.err:
|
|
|
|
xor eax, eax
|
|
|
|
popfd
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc alloc_kernel_space stdcall, size:dword
|
|
|
|
local block_ind:DWORD
|
|
|
|
|
|
|
|
pushfd
|
|
|
|
cli
|
|
|
|
|
|
|
|
mov eax, [size]
|
2006-11-03 16:19:15 +01:00
|
|
|
add eax, 4095
|
|
|
|
and eax, not 4095
|
2006-10-06 08:09:41 +02:00
|
|
|
mov [size], eax
|
2006-10-08 09:48:38 +02:00
|
|
|
cmp eax, [heap_free]
|
|
|
|
ja .error
|
2006-10-06 08:09:41 +02:00
|
|
|
|
|
|
|
shr eax, 12
|
|
|
|
sub eax, 1
|
|
|
|
|
|
|
|
mov [block_ind], eax
|
|
|
|
|
|
|
|
stdcall get_block, eax
|
|
|
|
and eax, eax
|
|
|
|
jz .error
|
|
|
|
|
|
|
|
mov edi, eax ;edi - pBlock
|
|
|
|
|
|
|
|
cmp [edi+block_flags], FREE_BLOCK
|
|
|
|
jne .error
|
|
|
|
|
|
|
|
mov [block_ind], ebx ;index of allocated block
|
|
|
|
|
|
|
|
mov eax, [edi+block_size]
|
|
|
|
cmp eax, [size]
|
|
|
|
je .m_eq_size
|
|
|
|
|
|
|
|
call alloc_mem_block
|
|
|
|
and eax, eax
|
|
|
|
jz .error
|
|
|
|
|
|
|
|
mov esi, eax ;esi - splitted block
|
|
|
|
|
|
|
|
mov [esi+block_next], edi
|
|
|
|
mov eax, [edi+block_prev]
|
|
|
|
mov [esi+block_prev], eax
|
|
|
|
mov [edi+block_prev], esi
|
|
|
|
mov [esi+list_next], 0
|
|
|
|
mov [esi+list_prev], 0
|
|
|
|
and eax, eax
|
|
|
|
jz @f
|
|
|
|
mov [eax+block_next], esi
|
|
|
|
@@:
|
|
|
|
mov ebx, [edi+block_base]
|
|
|
|
mov [esi+block_base], ebx
|
|
|
|
mov edx, [size]
|
|
|
|
mov [esi+block_size], edx
|
|
|
|
add [edi+block_base], edx
|
|
|
|
sub [edi+block_size], edx
|
|
|
|
|
|
|
|
mov eax, [edi+block_size]
|
|
|
|
shr eax, 12
|
|
|
|
sub eax, 1
|
|
|
|
cmp eax, 63
|
|
|
|
jna @f
|
|
|
|
mov eax, 63
|
|
|
|
@@:
|
|
|
|
cmp eax, [block_ind]
|
|
|
|
je .m_eq_ind
|
|
|
|
|
2006-10-23 22:38:29 +02:00
|
|
|
remove_from_list edi
|
2006-10-06 08:09:41 +02:00
|
|
|
|
|
|
|
mov ecx, [block_ind]
|
2006-11-16 06:47:31 +01:00
|
|
|
mov [mem_block_list+ecx*4], edx
|
2006-10-06 08:09:41 +02:00
|
|
|
|
2006-11-16 06:47:31 +01:00
|
|
|
test edx, edx
|
2006-10-06 08:09:41 +02:00
|
|
|
jnz @f
|
|
|
|
btr [mem_block_mask], ecx
|
|
|
|
@@:
|
|
|
|
mov edx, [mem_block_list+eax*4]
|
|
|
|
mov [edi+list_next], edx
|
|
|
|
test edx, edx
|
|
|
|
jz @f
|
|
|
|
mov [edx+list_prev], edi
|
|
|
|
@@:
|
|
|
|
mov [mem_block_list+eax*4], edi
|
|
|
|
bts [mem_block_mask], eax
|
|
|
|
.m_eq_ind:
|
|
|
|
mov ebx, [mem_used_list]
|
|
|
|
mov [esi+list_next], ebx
|
|
|
|
test ebx, ebx
|
|
|
|
jz @f
|
|
|
|
mov [ebx+list_prev], esi
|
|
|
|
@@:
|
|
|
|
mov [esi+block_flags], USED_BLOCK
|
|
|
|
mov [mem_used_list], esi
|
|
|
|
mov eax, [esi+block_base]
|
2006-10-08 09:48:38 +02:00
|
|
|
mov ebx, [size]
|
|
|
|
sub [heap_free], ebx
|
2006-10-06 08:09:41 +02:00
|
|
|
popfd
|
|
|
|
ret
|
|
|
|
|
|
|
|
.m_eq_size:
|
|
|
|
remove_from_list edi
|
2006-10-23 22:38:29 +02:00
|
|
|
mov [mem_block_list+ebx*4], edx
|
2006-10-06 08:09:41 +02:00
|
|
|
and edx, edx
|
|
|
|
jnz @f
|
2006-10-23 22:38:29 +02:00
|
|
|
btr [mem_block_mask], ebx
|
2006-10-06 08:09:41 +02:00
|
|
|
@@:
|
2006-10-23 22:38:29 +02:00
|
|
|
mov ecx, [mem_used_list]
|
|
|
|
mov [edi+list_next], ecx
|
|
|
|
test ecx, ecx
|
2006-10-06 08:09:41 +02:00
|
|
|
jnz @f
|
2006-10-23 22:38:29 +02:00
|
|
|
mov [ecx+list_prev], edi
|
2006-10-06 08:09:41 +02:00
|
|
|
@@:
|
|
|
|
mov [mem_used_list], edi
|
|
|
|
mov [edi+block_flags], USED_BLOCK
|
|
|
|
mov eax, [edi+block_base]
|
2006-10-08 09:48:38 +02:00
|
|
|
mov ebx, [size]
|
|
|
|
sub [heap_free], ebx
|
2006-10-06 08:09:41 +02:00
|
|
|
popfd
|
|
|
|
ret
|
|
|
|
.error:
|
|
|
|
xor eax, eax
|
|
|
|
popfd
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc free_kernel_space stdcall, base:dword
|
|
|
|
|
|
|
|
mov eax, [base]
|
|
|
|
mov esi, [mem_used_list]
|
|
|
|
@@:
|
|
|
|
test esi, esi
|
|
|
|
jz .fail
|
|
|
|
|
|
|
|
cmp [esi+block_base], eax
|
|
|
|
je .found
|
|
|
|
mov esi, [esi+list_next]
|
|
|
|
jmp @b
|
|
|
|
.found:
|
|
|
|
cmp [esi+block_flags], USED_BLOCK
|
|
|
|
jne .fail
|
|
|
|
|
2006-10-08 09:48:38 +02:00
|
|
|
mov eax, [esi+block_size]
|
|
|
|
add [heap_free], eax
|
|
|
|
|
2006-10-06 08:09:41 +02:00
|
|
|
mov edi, [esi+block_next]
|
|
|
|
test edi, edi
|
|
|
|
jz .prev
|
|
|
|
|
|
|
|
cmp [edi+block_flags], FREE_BLOCK
|
|
|
|
jne .prev
|
|
|
|
|
|
|
|
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
|
|
|
|
|
|
|
|
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
|
|
|
|
|
|
|
|
remove_from_used esi
|
|
|
|
|
|
|
|
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
|
|
|
|
|
|
|
|
mov ecx, [edi+block_size]
|
|
|
|
mov eax, [esi+block_size]
|
|
|
|
add eax, ecx
|
|
|
|
mov [edi+block_size], eax
|
|
|
|
|
|
|
|
calc_index eax
|
|
|
|
calc_index ecx
|
|
|
|
cmp eax, ecx
|
|
|
|
je .m_eq
|
|
|
|
|
|
|
|
push ecx
|
|
|
|
remove_from_list edi
|
|
|
|
pop ecx
|
|
|
|
|
|
|
|
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
|
|
|
|
@@:
|
|
|
|
mov esi, [mem_block_list+eax*4]
|
|
|
|
mov [mem_block_list+eax*4], edi
|
|
|
|
mov [edi+list_next], esi
|
|
|
|
test esi, esi
|
|
|
|
jz @f
|
|
|
|
mov [esi+list_prev], edi
|
|
|
|
@@:
|
|
|
|
bts [mem_block_mask], eax
|
|
|
|
.m_eq:
|
|
|
|
xor eax, eax
|
|
|
|
not eax
|
|
|
|
ret
|
|
|
|
.insert:
|
|
|
|
remove_from_used esi
|
|
|
|
|
|
|
|
mov eax, [esi+block_size]
|
|
|
|
calc_index eax
|
|
|
|
|
|
|
|
mov edi, [mem_block_list+eax*4]
|
|
|
|
mov [mem_block_list+eax*4], esi
|
|
|
|
mov [esi+list_next], edi
|
|
|
|
test edi, edi
|
|
|
|
jz @f
|
|
|
|
mov [edi+list_prev], esi
|
|
|
|
@@:
|
|
|
|
bts [mem_block_mask], eax
|
|
|
|
mov [esi+block_flags],FREE_BLOCK
|
|
|
|
xor eax, eax
|
|
|
|
not eax
|
|
|
|
ret
|
|
|
|
.fail:
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc kernel_alloc stdcall, size:dword
|
|
|
|
locals
|
|
|
|
lin_addr dd ?
|
|
|
|
pages_count dd ?
|
|
|
|
endl
|
|
|
|
|
|
|
|
mov eax, [size]
|
2006-11-03 16:19:15 +01:00
|
|
|
add eax, 4095
|
|
|
|
and eax, not 4095;
|
2006-10-06 08:09:41 +02:00
|
|
|
mov [size], eax
|
|
|
|
and eax, eax
|
|
|
|
jz .error
|
|
|
|
mov ebx, eax
|
|
|
|
shr ebx, 12
|
|
|
|
mov [pages_count], ebx
|
|
|
|
|
|
|
|
stdcall alloc_kernel_space, eax
|
|
|
|
and eax, eax
|
|
|
|
jz .error
|
|
|
|
mov [lin_addr], eax
|
|
|
|
|
|
|
|
mov ecx, [pages_count]
|
|
|
|
mov edx, eax
|
|
|
|
mov ebx, ecx
|
|
|
|
|
|
|
|
shr ecx, 3
|
|
|
|
jz .next
|
|
|
|
|
|
|
|
and ebx, not 7
|
|
|
|
push ebx
|
|
|
|
stdcall alloc_pages, ebx
|
|
|
|
pop ecx ; yes ecx!!!
|
|
|
|
and eax, eax
|
|
|
|
jz .error
|
|
|
|
|
|
|
|
mov edi, eax
|
|
|
|
mov edx, [lin_addr]
|
|
|
|
@@:
|
|
|
|
stdcall map_page,edx,edi,dword PG_SW
|
|
|
|
add edx, 0x1000
|
|
|
|
add edi, 0x1000
|
|
|
|
dec ecx
|
|
|
|
jnz @B
|
|
|
|
.next:
|
|
|
|
mov ecx, [pages_count]
|
|
|
|
and ecx, 7
|
|
|
|
jz .end
|
|
|
|
|
|
|
|
@@: push ecx
|
|
|
|
call alloc_page
|
|
|
|
pop ecx
|
|
|
|
test eax, eax
|
|
|
|
jz .error
|
|
|
|
|
|
|
|
stdcall map_page,edx,eax,dword PG_SW
|
|
|
|
add edx, 0x1000
|
|
|
|
dec ecx
|
|
|
|
jnz @B
|
|
|
|
.end:
|
|
|
|
mov eax, [lin_addr]
|
|
|
|
ret
|
|
|
|
|
|
|
|
.error:
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc kernel_free stdcall, base:dword
|
|
|
|
locals
|
|
|
|
size dd ?
|
|
|
|
endl
|
|
|
|
|
|
|
|
mov eax, [base]
|
|
|
|
mov esi, [mem_used_list]
|
|
|
|
@@:
|
|
|
|
test esi, esi
|
|
|
|
jz .fail
|
|
|
|
|
|
|
|
cmp [esi+block_base], eax
|
|
|
|
je .found
|
|
|
|
mov esi, [esi+list_next]
|
|
|
|
jmp @b
|
|
|
|
.found:
|
|
|
|
cmp [esi+block_flags], USED_BLOCK
|
|
|
|
jne .fail
|
|
|
|
|
|
|
|
mov ecx, [esi+block_size];
|
|
|
|
mov [size], ecx
|
|
|
|
|
|
|
|
stdcall free_kernel_space, [base]
|
|
|
|
test eax, eax
|
|
|
|
jz .fail
|
|
|
|
|
|
|
|
mov ecx, [size]
|
|
|
|
mov edi, [base]
|
|
|
|
|
|
|
|
shr ecx, 12
|
|
|
|
mov esi, edi
|
|
|
|
shr edi, 10
|
|
|
|
add edi, pages_tab
|
|
|
|
xor edx, edx
|
|
|
|
.release:
|
|
|
|
mov eax, [edi]
|
|
|
|
test eax, 1
|
|
|
|
jz .next
|
|
|
|
|
|
|
|
call free_page
|
|
|
|
mov [edi],edx
|
|
|
|
.next:
|
|
|
|
invlpg [esi]
|
|
|
|
add esi, 0x1000
|
|
|
|
add edi, 4
|
|
|
|
dec ecx
|
|
|
|
jnz .release
|
|
|
|
.fail:
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
restore block_next
|
|
|
|
restore block_prev
|
|
|
|
restore block_list
|
|
|
|
restore block_base
|
|
|
|
restore block_size
|
|
|
|
restore block_flags
|
|
|
|
|
|
|
|
;;;;;;;;;;;;;; USER ;;;;;;;;;;;;;;;;;
|
|
|
|
|
2006-10-20 16:02:26 +02:00
|
|
|
HEAP_TOP equ 0x5FC00000
|
|
|
|
|
2006-10-06 08:09:41 +02:00
|
|
|
align 4
|
2006-10-20 16:02:26 +02:00
|
|
|
proc init_heap
|
2006-10-06 08:09:41 +02:00
|
|
|
|
2006-10-10 07:11:30 +02:00
|
|
|
mov ebx,[CURRENT_TASK]
|
|
|
|
shl ebx,8
|
|
|
|
mov eax, [PROC_BASE+APPDATA.heap_top+ebx]
|
|
|
|
test eax, eax
|
|
|
|
jz @F
|
|
|
|
sub eax,[PROC_BASE+APPDATA.heap_base+ebx]
|
|
|
|
sub eax, 4096
|
|
|
|
ret
|
|
|
|
@@:
|
|
|
|
mov esi, [PROC_BASE+APPDATA.mem_size+ebx]
|
2006-10-20 16:02:26 +02:00
|
|
|
add esi, 4095
|
|
|
|
and esi, not 4095
|
|
|
|
mov eax, HEAP_TOP
|
2006-10-10 07:11:30 +02:00
|
|
|
mov [PROC_BASE+APPDATA.heap_base+ebx], esi
|
2006-10-20 16:02:26 +02:00
|
|
|
mov [PROC_BASE+APPDATA.heap_top+ebx], eax
|
2006-10-06 08:09:41 +02:00
|
|
|
|
2006-10-20 16:02:26 +02:00
|
|
|
sub eax, esi
|
|
|
|
add esi, new_app_base
|
|
|
|
shr esi, 10
|
|
|
|
mov ecx, eax
|
2006-10-06 08:09:41 +02:00
|
|
|
sub eax, 4096
|
2006-10-20 16:02:26 +02:00
|
|
|
or ecx, FREE_BLOCK
|
|
|
|
mov [pages_tab+esi], ecx
|
2006-10-06 08:09:41 +02:00
|
|
|
ret
|
|
|
|
.exit:
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc user_alloc stdcall, alloc_size:dword
|
|
|
|
|
|
|
|
mov ecx, [alloc_size]
|
|
|
|
add ecx, (4095+4096)
|
|
|
|
and ecx, not 4095
|
|
|
|
|
|
|
|
mov ebx, [CURRENT_TASK]
|
|
|
|
shl ebx, 8
|
2006-10-10 07:11:30 +02:00
|
|
|
mov esi, dword [ebx+PROC_BASE+APPDATA.heap_base]; heap_base
|
|
|
|
mov edi, dword [ebx+PROC_BASE+APPDATA.heap_top]; heap_top
|
2006-10-06 08:09:41 +02:00
|
|
|
add esi, new_app_base
|
|
|
|
add edi, new_app_base
|
|
|
|
|
|
|
|
l_0:
|
|
|
|
cmp esi, edi
|
|
|
|
jae m_exit
|
|
|
|
|
|
|
|
mov ebx, esi
|
|
|
|
shr ebx, 12
|
|
|
|
mov eax, [pages_tab+ebx*4]
|
|
|
|
test eax, FREE_BLOCK
|
|
|
|
jz test_used
|
|
|
|
and eax, 0xFFFFF000
|
|
|
|
cmp eax, ecx ;alloc_size
|
|
|
|
jb m_next
|
|
|
|
|
|
|
|
mov edx, esi
|
|
|
|
add edx, ecx
|
|
|
|
sub eax, ecx;
|
|
|
|
or eax, FREE_BLOCK
|
|
|
|
shr edx, 12
|
|
|
|
mov [pages_tab+edx*4], eax
|
|
|
|
|
|
|
|
or ecx, USED_BLOCK
|
|
|
|
mov [pages_tab+ebx*4], ecx
|
|
|
|
shr ecx, 12
|
|
|
|
dec ecx
|
|
|
|
inc ebx
|
|
|
|
@@:
|
|
|
|
mov dword [pages_tab+ebx*4], 2
|
|
|
|
inc ebx
|
|
|
|
dec ecx
|
|
|
|
jnz @B
|
|
|
|
|
|
|
|
mov eax, esi
|
|
|
|
add eax, 4096
|
|
|
|
sub eax, new_app_base
|
|
|
|
ret
|
|
|
|
m_next:
|
|
|
|
add esi, eax
|
|
|
|
jmp l_0
|
|
|
|
test_used:
|
|
|
|
test eax, USED_BLOCK
|
|
|
|
jz m_exit
|
|
|
|
|
|
|
|
and eax, 0xFFFFF000
|
|
|
|
add esi, eax
|
|
|
|
jmp l_0
|
|
|
|
m_exit:
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc user_free stdcall, base:dword
|
|
|
|
|
|
|
|
mov esi, [base]
|
|
|
|
test esi, esi
|
|
|
|
jz .exit
|
|
|
|
|
|
|
|
sub esi, 4096
|
|
|
|
shr esi, 12
|
|
|
|
mov eax, [pages_tab+esi*4]
|
|
|
|
test eax, USED_BLOCK
|
2006-10-20 16:02:26 +02:00
|
|
|
jz .not_used
|
2006-10-06 08:09:41 +02:00
|
|
|
|
|
|
|
and eax, not 4095
|
|
|
|
mov ecx, eax
|
|
|
|
or eax, FREE_BLOCK
|
|
|
|
mov [pages_tab+esi*4], eax
|
|
|
|
inc esi
|
|
|
|
sub ecx, 4096
|
|
|
|
shr ecx, 12
|
|
|
|
.release:
|
2006-10-20 16:02:26 +02:00
|
|
|
xor eax, eax
|
|
|
|
xchg eax, [pages_tab+esi*4]
|
|
|
|
test eax, 1
|
|
|
|
jz @F
|
2006-10-06 08:09:41 +02:00
|
|
|
call free_page
|
2006-10-20 16:02:26 +02:00
|
|
|
@@:
|
2006-10-06 08:09:41 +02:00
|
|
|
inc esi
|
|
|
|
dec ecx
|
|
|
|
jnz .release
|
2006-10-20 16:02:26 +02:00
|
|
|
.not_used:
|
2006-10-06 08:09:41 +02:00
|
|
|
mov ebx, [CURRENT_TASK]
|
|
|
|
shl ebx, 8
|
2006-10-10 07:11:30 +02:00
|
|
|
mov esi, dword [ebx+PROC_BASE+APPDATA.heap_base]; heap_base
|
|
|
|
mov edi, dword [ebx+PROC_BASE+APPDATA.heap_top]; heap_top
|
2006-10-06 08:09:41 +02:00
|
|
|
shr esi, 12
|
|
|
|
shr edi, 12
|
|
|
|
@@:
|
|
|
|
mov eax, [pages_tab+esi*4]
|
|
|
|
test eax, USED_BLOCK
|
|
|
|
jz .test_free
|
|
|
|
shr eax, 12
|
|
|
|
add esi, eax
|
|
|
|
jmp @B
|
|
|
|
.test_free:
|
|
|
|
test eax, FREE_BLOCK
|
|
|
|
jz .err
|
|
|
|
mov edx, eax
|
|
|
|
shr edx, 12
|
|
|
|
add edx, esi
|
|
|
|
cmp edx, edi
|
|
|
|
jae .exit
|
|
|
|
|
|
|
|
mov ebx, [pages_tab+edx*4]
|
|
|
|
test ebx, USED_BLOCK
|
|
|
|
jz .next_free
|
|
|
|
|
|
|
|
shr ebx, 12
|
|
|
|
add edx, ebx
|
|
|
|
mov esi, edx
|
|
|
|
jmp @B
|
|
|
|
.next_free:
|
|
|
|
test ebx, FREE_BLOCK
|
|
|
|
jz .err
|
|
|
|
and dword [pages_tab+edx*4], 0
|
|
|
|
add eax, ebx
|
|
|
|
and eax, not 4095
|
|
|
|
or eax, FREE_BLOCK
|
|
|
|
mov [pages_tab+esi*4], eax
|
|
|
|
jmp @B
|
|
|
|
.exit:
|
|
|
|
xor eax, eax
|
|
|
|
inc eax
|
|
|
|
ret
|
|
|
|
.err:
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc alloc_dll
|
|
|
|
pushf
|
|
|
|
cli
|
|
|
|
bsf eax, [dll_map]
|
|
|
|
jnz .find
|
|
|
|
popf
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
.find:
|
|
|
|
btr [dll_map], eax
|
|
|
|
popf
|
|
|
|
shl eax, 5
|
|
|
|
add eax, dll_tab
|
|
|
|
ret
|
|
|
|
endp
|
|
|
|
|
|
|
|
align 4
|
|
|
|
proc alloc_service
|
|
|
|
pushf
|
|
|
|
cli
|
|
|
|
bsf eax, [srv_map]
|
|
|
|
jnz .find
|
|
|
|
popf
|
|
|
|
xor eax, eax
|
|
|
|
ret
|
|
|
|
|
|
|
|
.find: btr [srv_map], eax
|
|
|
|
popf
|
|
|
|
shl eax,5
|
|
|
|
add eax, srv_tab
|
|
|
|
ret
|
|
|
|
endp
|