Subversion Repositories Kolibri OS

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

;;                                                              ;;

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

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

;;                                                              ;;

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

$Revision: 10002 $

align 4

proc alloc_page

        pushfd

        cli

        push    ebx

        cmp     [pg_data.pages_free], 1

        jle     .out_of_memory

        mov     ebx, [page_start]

        mov     ecx, [page_end]

.l1:

        bsf     eax, [ebx];

        jnz     .found

        add     ebx, 4

        cmp     ebx, ecx

        jb      .l1

        pop     ebx

        popfd

        xor     eax, eax

        ret

.found:

        dec     [pg_data.pages_free]

        jz      .out_of_memory

        btr     [ebx], eax

        mov     [page_start], ebx

        sub     ebx, sys_pgmap

        lea     eax, [eax+ebx*8]

        shl     eax, 12

;       dec [pg_data.pages_free]

        pop     ebx

        popfd

        ret

.out_of_memory:

        mov     [pg_data.pages_free], 1

        xor     eax, eax

        pop     ebx

        popfd

        ret

endp

align 4

proc alloc_pages stdcall, count:dword

        pushfd

        push    ebx

        push    edi

        cli

        mov     eax, [count]

        add     eax, 7

        shr     eax, 3

        mov     [count], eax

        mov     ebx, [pg_data.pages_free]

        sub     ebx, 9

        js      .out_of_memory

        shr     ebx, 3

        cmp     eax, ebx

        jg      .out_of_memory

        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

  .out_of_memory:

  .fail:

        xor     eax, eax

        pop     edi

        pop     ebx

        popfd

        ret

  .next:

        inc     ecx

        cmp     ecx, ebx

        jb      .find

        pop     edi

        pop     ebx

        popfd

        xor     eax, eax

        ret

  .ok:

        sub     ecx, edi

        inc     ecx

        push    esi

        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

        pop     esi

        pop     edi

        pop     ebx

        popfd

        ret

endp

align 4

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

map_page:

        push    ebx

        mov     eax, [esp+12]              ; phis_addr

        or      eax, [esp+16]              ; flags

        and     eax, [pte_valid_mask]

        mov     ebx, [esp+8]               ; lin_addr

        shr     ebx, 12

        mov     [page_tabs + ebx*4], eax

        mov     eax, [esp+8]               ; lin_addr

        pop     ebx

        invlpg  [eax]

        ret     12

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

align 4

proc map_io_mem stdcall, base:dword, size:dword, flags:dword

        push    ebx

        push    edi

        mov     eax, [size]

        add     eax, [base]

        add     eax, PAGE_SIZE-1

        and     eax, -PAGE_SIZE

        mov     ecx, [base]

        and     ecx, -PAGE_SIZE

        sub     eax, ecx

        mov     [size], eax

        stdcall alloc_kernel_space, eax

        test    eax, eax

        jz      .fail

        push    eax

        mov     edi, PAGE_SIZE

        mov     ebx, eax

        mov     ecx, [size]

        mov     edx, [base]

        shr     eax, 12

        shr     ecx, 12

        or      edx, [flags]

        and     edx, [pte_valid_mask]

@@:

        mov     [page_tabs + eax*4], edx

        invlpg  [ebx]

        inc     eax

        add     ebx, edi

        add     edx, edi

        loop    @B

        pop     eax

        mov     edx, [base]

        and     edx, PAGE_SIZE-1

        add     eax, edx

.fail:

        pop     edi

        pop     ebx

        ret

endp

; param

;  eax= page base + page flags

;  ebx= linear address

;  ecx= count

align 4

commit_pages:

        test    ecx, ecx

        jz      .fail

        push    edi

        push    eax

        push    ecx

        mov     ecx, pg_data.mutex

        call    mutex_lock

        pop     ecx

        pop     eax

        and     eax, [pte_valid_mask ]