Subversion Repositories Kolibri OS

$Revision: 520 $

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;                                                              ;;

;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;

;; Distributed under terms of the GNU General Public License    ;;

;;                                                              ;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

align 4

proc alloc_page

           pushfd

           cli

           mov ebx, [page_start]

           mov ecx, [page_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 [page_start],ebx

           sub ebx, sys_pgmap

           lea eax, [eax+ebx*8]

           shl eax, 12

           dec [pg_data.pages_free]

           popfd

           ret

endp

align 4

proc alloc_pages stdcall, count:dword

           pushfd

           cli

           mov eax, [count]

           add eax, 7

           shr eax, 3

           mov [count], eax

           cmp eax, [pg_data.pages_free]

           ja .fail

           mov ecx, [page_start]

           mov ebx, [page_end]

.find:

           mov edx, [count]

           mov edi, ecx

.match:

           cmp byte [ecx], 0xFF

           jne .next

           dec edx

           jz .ok

           inc ecx

           cmp ecx,ebx

           jb .match

.fail:     xor eax, eax

           popfd

           ret

.next:

           inc ecx

           cmp ecx, ebx

           jb .find

           popfd

           xor eax, eax

           ret

.ok:

           sub ecx, edi

           inc ecx

           mov esi, edi

           xor eax, eax

           rep stosb

           sub esi, sys_pgmap

           shl esi, 3+12

           mov eax, esi

           mov ebx, [count]

           shl ebx, 3

           sub [pg_data.pages_free], ebx

           popfd

           ret

endp

align 4

proc map_page stdcall,lin_addr:dword,phis_addr:dword,flags:dword

           push ebx

           mov eax, [phis_addr]

           and eax, not 0xFFF

           or eax, [flags]

           mov ebx, [lin_addr]

           shr ebx, 12

           mov [page_tabs+ebx*4], eax

           mov eax, [lin_addr]

           invlpg [eax]

           pop ebx

           ret

endp

align 4

map_space:    ;not implemented

           ret

align 4

proc free_page

;arg:  eax  page address

           pushfd

           cli

           shr eax, 12              ;page index

           bts dword [sys_pgmap], eax           ;that's all!

           cmc

           adc [pg_data.pages_free], 0

           shr eax, 3

           and eax, not 3           ;dword offset from page_map

           add eax, sys_pgmap

           cmp [page_start], eax

           ja @f

           popfd

           ret

@@:

           mov [page_start], eax

           popfd

           ret

endp

; param

;  eax= page base + page flags

;  ebx= liear address

;  ecx= count

align 4

commit_pages:

           test ecx, ecx

           jz .fail

           mov edi, ebx

           mov ebx, pg_data.pg_mutex

           call wait_mutex      ;ebx

           mov edx, 0x1000

           mov ebx, edi

           shr ebx, 12

@@:

           mov [page_tabs+ebx*4], eax

           invlpg [edi]

           add edi, edx

           add eax, edx

           inc ebx

           dec ecx

           jnz @B

           mov [pg_data.pg_mutex],ecx

.fail:

           ret

; param

;  eax= base

;  ecx= count

align 4

release_pages:

           pushad

           mov ebx, pg_data.pg_mutex

           call wait_mutex      ;ebx

           mov esi, eax

           mov edi, eax

           shr esi, 10

           add esi, page_tabs

           mov ebp, [pg_data.pages_free]

           mov ebx, [page_start]

           mov edx, sys_pgmap

@@:

           xor eax, eax

           xchg eax, [esi]

           invlpg [edi]

           test eax, 1

           jz .next

           shr eax, 12

           bts [edx], eax

           cmc

           adc ebp, 0

           shr eax, 3

           and eax, -4

           add eax, edx

           cmp eax, ebx

           jae .next

           mov ebx, eax

.next:

           add edi, 0x1000

           add esi, 4

           dec ecx

           jnz @B

           mov [pg_data.pages_free], ebp

           and [pg_data.pg_mutex],0

           popad

           ret

align 4

proc map_page_table stdcall, lin_addr:dword, phis_addr:dword

           push ebx

           mov ebx, [lin_addr]

           shr ebx, 22

           mov eax, [phis_addr]

           and eax, not 0xFFF

           or eax, PG_UW          ;+PG_NOCACHE

           mov dword [master_tab+ebx*4], eax

           mov eax, [lin_addr]

           shr eax, 10

           add eax, page_tabs

           invlpg [eax]

           pop ebx

           ret

endp

align 4

proc init_LFB