OSDev

if (eip == 0x12345)
{
   return;
}

/*------------------------------------------------------------------------------
//      Copy data from page (in physical memory!)
//----------------------------------------------------------------------------*/
.global     copy_page_physical

copy_page_physical:

        /* Push EBX and EFLAGS */
        push    %ebx
        pushf

        /* Switch off all interrupts */
        cli

        /* Get parametrs from stack */
        mov     12(%esp), %ebx
        mov     16(%esp), %ecx

        /* Switch off paging memory */
        mov     %cr0, %edx
        and     $0x7FFFFFFF, %edx
        mov     %edx, %cr0

        mov     $1024, %edx

        /* Copy page data */
loop:

        mov     (%ebx), %eax
        mov     %eax,   (%ecx)
        add     $4, %ebx
        add     $4, %ecx
        dec     %edx
        jnz     loop

        /* Switch on paging memory */
        mov     %cr0, %edx
        or      $0x80000000, %edx
        mov     %edx, %cr0

        /* Pop EFLAGS and EBX */
        popf
        pop     %ebx

        ret

/*------------------------------------------------------------------------------
//   Clone pages directories
//----------------------------------------------------------------------------*/
page_directory_t* clone_directory(page_directory_t* src)
{
    u32int phys; /* Physical address of new directory */
    u32int offset = 0;
    int i = 0;
   
    /* Ctreate new directory */
    page_directory_t* dir = (page_directory_t*) kmalloc_ap(sizeof(page_directory_t), &phys);
   
    /* Clear directory */
    memset(dir, 0, sizeof(page_directory_t));
   
    /* Calculate physical address of page tables */
    offset = (u32int) dir->tables_phys_addr - (u32int) dir;
    dir->phys_addr = phys + offset;

    /* Clone page tables */
    for (i = 0; i < 1024; i++)
    {
        /* If table is not created */
        if (!src->tables[i])
            continue;
       
        /* Check cloned directory is kernel directory */
        if ( kernel_dir->tables[i] == src->tables[i] )
        {
            /* Make link to this table */
            dir->tables[i] = src->tables[i];
            dir->tables_phys_addr[i] = src->tables_phys_addr[i];
        }
        else
        {
            /* Copy table */
            u32int phys = 0;
           
            dir->tables[i] = clone_table(src->tables[i], &phys);
            dir->tables_phys_addr[i] = phys | 0x07;
        }       
    }
   
    return dir;
}

/*------------------------------------------------------------------------------
//   Clone table
//----------------------------------------------------------------------------*/
page_table_t* clone_table(page_table_t* src, u32int* phys_addr)
{
    page_table_t* table = 0;
    int i = 0;
   
    /* Create new table */
    table = (page_table_t*) kmalloc_ap(sizeof(page_table_t), phys_addr);   
    /* Clear table */
    memset(table, 0, sizeof(page_table_t));
   
    /* for each page in table */
    for (i = 0; i < 1024; i++)
    {
        /* if page has not frame */
        if (!src->pages[i].frame)
            continue;
       
        /* Allocate new frame */
        alloc_frame(&table->pages[i], 0, 0);
       
        /* Clone all flags */
        if (src->pages[i].present)
            table->pages[i].present = 1;
       
        if (src->pages[i].rw)
            table->pages[i].rw = 1;
       
        if (src->pages[i].user)
            table->pages[i].user = 1;
       
        if (src->pages[i].access)
            table->pages[i].access = 1;
       
        if (src->pages[i].dirty)
            table->pages[i].dirty = 1;
       
        copy_page_physical(src->pages[i].frame*PAGE_SIZE,
                           table->pages[i].frame*PAGE_SIZE);
    }
   
    return table;
}