source: trunk/kernel/mm/vmm.c @ 385

Last change on this file since 385 was 385, checked in by max@…, 7 years ago

Remove redundant (and buggy) code.

File size: 46.9 KB
Line 
1/*
2 * vmm.c - virtual memory manager related operations interface.
3 *
4 * Authors   Ghassan Almaless (2008,2009,2010,2011, 2012)
5 *           Mohamed Lamine Karaoui (2015)
6 *           Alain Greiner (2016)
7 *
8 * Copyright (c) UPMC Sorbonne Universites
9 *
10 * This file is part of ALMOS-MKH.
11 *
12 * ALMOS-MKH is free software; you can redistribute it and/or modify it
13 * under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; version 2.0 of the License.
15 *
16 * ALMOS-MKH is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
19 * General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with ALMOS-MKH; if not, write to the Free Software Foundation,
23 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
24 */
25
26#include <kernel_config.h>
27#include <hal_types.h>
28#include <hal_special.h>
29#include <hal_gpt.h>
30#include <printk.h>
31#include <memcpy.h>
32#include <rwlock.h>
33#include <list.h>
34#include <bits.h>
35#include <process.h>
36#include <thread.h>
37#include <vseg.h>
38#include <cluster.h>
39#include <scheduler.h>
40#include <vfs.h>
41#include <mapper.h>
42#include <page.h>
43#include <kmem.h>
44#include <vmm.h>
45
46//////////////////////////////////////////////////////////////////////////////////
47//   Extern global variables
48//////////////////////////////////////////////////////////////////////////////////
49
50extern  process_t  process_zero;   // defined in cluster.c file
51
52
53////////////////////////////////////
54void vmm_init( process_t * process )
55{
56    error_t   error;
57    vseg_t  * vseg_kentry;
58    vseg_t  * vseg_args;
59    vseg_t  * vseg_envs;
60    vseg_t  * vseg_heap;
61    intptr_t  base;
62    intptr_t  size;
63
64    vmm_dmsg("\n[INFO] %s : enter for process %x\n", __FUNCTION__ , process->pid );
65
66    // get pointer on VMM
67    vmm_t   * vmm = &process->vmm;
68
69    assert( ((CONFIG_VMM_KENTRY_SIZE + CONFIG_VMM_ARGS_SIZE + CONFIG_VMM_ENVS_SIZE) 
70            <= CONFIG_VMM_ELF_BASE) , __FUNCTION__ , "UTILS zone too small\n" );
71
72    assert( (CONFIG_THREAD_MAX_PER_CLUSTER <= 32) , __FUNCTION__ ,
73            "no more than 32 threads per cluster for a single process\n");
74
75    assert( ((CONFIG_VMM_STACK_SIZE * CONFIG_THREAD_MAX_PER_CLUSTER) <=
76             (CONFIG_VMM_VSPACE_SIZE - CONFIG_VMM_STACK_BASE)) , __FUNCTION__ ,
77             "STACK zone too small\n");
78
79    // initialize the rwlock protecting the vsegs list
80        rwlock_init( &vmm->vsegs_lock );
81
82    // initialize local list of vsegs and radix-tree
83    vmm->vsegs_nr = 0;
84        list_root_init( &vmm->vsegs_root );
85    error = grdxt_init( &vmm->grdxt,
86                        CONFIG_VMM_GRDXT_W1,
87                        CONFIG_VMM_GRDXT_W2,
88                        CONFIG_VMM_GRDXT_W3 );
89 
90    assert( (error == 0) , __FUNCTION__ , "cannot initialize radix tree\n" );
91
92    // register kentry vseg in VMM
93    base = 1 << CONFIG_PPM_PAGE_SHIFT;
94    size = CONFIG_VMM_KENTRY_SIZE << CONFIG_PPM_PAGE_SHIFT;
95    vseg_kentry = vmm_create_vseg( process , base , size , VSEG_TYPE_CODE );
96
97    assert( (vseg_kentry != NULL) , __FUNCTION__ , "cannot register kentry vseg\n" );
98
99    vmm->kent_vpn_base = 1;
100
101    // register the args vseg in VMM
102    base = (CONFIG_VMM_KENTRY_SIZE + 1 )<<CONFIG_PPM_PAGE_SHIFT;
103    size = CONFIG_VMM_ARGS_SIZE << CONFIG_PPM_PAGE_SHIFT;
104    vseg_args = vmm_create_vseg( process , base , size , VSEG_TYPE_DATA );
105
106    assert( (vseg_args != NULL) , __FUNCTION__ , "cannot register args vseg\n" );
107
108    vmm->args_vpn_base = CONFIG_VMM_KENTRY_SIZE + 1;
109
110    // register the envs vseg in VMM
111    base = (CONFIG_VMM_KENTRY_SIZE + CONFIG_VMM_ARGS_SIZE + 1 )<<CONFIG_PPM_PAGE_SHIFT;
112    size = CONFIG_VMM_ENVS_SIZE << CONFIG_PPM_PAGE_SHIFT;
113    vseg_envs = vmm_create_vseg( process , base , size , VSEG_TYPE_DATA );
114
115    assert( (vseg_envs != NULL) , __FUNCTION__ , "cannot register envs vseg\n" );
116
117    vmm->envs_vpn_base = CONFIG_VMM_KENTRY_SIZE + CONFIG_VMM_ARGS_SIZE + 1;
118
119    // register the heap vseg in VMM
120    base = CONFIG_VMM_HEAP_BASE << CONFIG_PPM_PAGE_SHIFT;
121    size = (CONFIG_VMM_MMAP_BASE-CONFIG_VMM_HEAP_BASE) << CONFIG_PPM_PAGE_SHIFT;
122    vseg_heap = vmm_create_vseg( process , base , size , VSEG_TYPE_HEAP );
123
124    assert( (vseg_heap != NULL) , __FUNCTION__ , "cannot register heap vseg\n" );
125
126    vmm->heap_vpn_base = CONFIG_VMM_HEAP_BASE;
127
128    // initialize generic page table
129    error = hal_gpt_create( &vmm->gpt );
130
131    assert( (error == 0) , __FUNCTION__ , "cannot initialize page table\n");
132
133    // initialize STACK allocator
134    vmm->stack_mgr.bitmap   = 0;
135    vmm->stack_mgr.vpn_base = CONFIG_VMM_STACK_BASE;
136
137    // initialize MMAP allocator
138    vmm->mmap_mgr.vpn_base        = CONFIG_VMM_MMAP_BASE;
139    vmm->mmap_mgr.vpn_size        = CONFIG_VMM_STACK_BASE - CONFIG_VMM_MMAP_BASE;
140    vmm->mmap_mgr.first_free_vpn  = CONFIG_VMM_MMAP_BASE;
141    uint32_t i;
142    for( i = 0 ; i < 32 ; i++ ) list_root_init( &vmm->mmap_mgr.zombi_list[i] );
143
144    // initialize instrumentation counters
145        vmm->pgfault_nr          = 0;
146        vmm->u_err_nr            = 0;
147        vmm->m_err_nr            = 0;
148
149    hal_fence();
150
151    vmm_dmsg("\n[INFO] %s : exit for process %x\n", __FUNCTION__ , process->pid );
152
153}  // end vmm_init()
154
155//////////////////////////////////////////
156error_t vmm_copy( process_t * dst_process,
157                  process_t * src_process )
158{
159    error_t error;
160
161    vmm_t * src_vmm = &src_process->vmm;
162    vmm_t * dst_vmm = &dst_process->vmm;
163
164    // take the src_vmm vsegs_lock
165    rwlock_wr_lock( &src_vmm->vsegs_lock );
166
167    // initialize dst_vmm vsegs_lock
168    rwlock_init( &dst_vmm->vsegs_lock );
169
170    // initialize the dst_vmm vsegs list and the radix tree
171    dst_vmm->vsegs_nr = 0;
172    list_root_init( &dst_vmm->vsegs_root );
173    error = grdxt_init( &dst_vmm->grdxt,
174                        CONFIG_VMM_GRDXT_W1,
175                        CONFIG_VMM_GRDXT_W2,
176                        CONFIG_VMM_GRDXT_W3 );
177    if( error )
178    {
179        printk("\n[ERROR] in %s : cannot initialize radix tree for process %x\n",
180               __FUNCTION__ , dst_process->pid );
181        return ENOMEM;
182    }
183
184    // loop on src_vmm list of vsegs to create
185    // and register vsegs copies in dst_vmm
186    list_entry_t * iter;
187    vseg_t       * src_vseg;
188    vseg_t       * dst_vseg;
189    LIST_FOREACH( &src_vmm->vsegs_root , iter )
190    {
191        // get pointer on current src_vseg
192        src_vseg = LIST_ELEMENT( iter , vseg_t , list );
193
194        // allocate memory for a new dst_vseg
195        dst_vseg = vseg_alloc();
196
197        if( dst_vseg == NULL )
198        {
199            // release all allocated vsegs
200            LIST_FOREACH( &dst_vmm->vsegs_root , iter )
201            {
202                dst_vseg = LIST_ELEMENT( iter , vseg_t , list );
203                vseg_free( dst_vseg );
204            }
205            return ENOMEM;
206        }
207
208        // copy src_vseg to dst_vseg
209        vseg_init_from_ref( dst_vseg , XPTR( local_cxy , src_vseg ) );
210
211        // register dst_vseg in dst_vmm
212        vseg_attach( dst_vmm , dst_vseg );
213    }
214
215    // release the src_vmm vsegs_lock
216    rwlock_wr_unlock( &src_vmm->vsegs_lock );
217
218    // initialize generic page table
219    error = hal_gpt_create( &dst_vmm->gpt );
220
221    if( error )
222    {
223        printk("\n[ERROR] in %s : cannot initialize page table\n", __FUNCTION__ );
224        return ENOMEM;
225    }
226
227    // initialize STACK allocator
228    dst_vmm->stack_mgr.bitmap   = 0;
229    dst_vmm->stack_mgr.vpn_base = CONFIG_VMM_STACK_BASE;
230
231    // initialize MMAP allocator
232    dst_vmm->mmap_mgr.vpn_base        = CONFIG_VMM_MMAP_BASE;
233    dst_vmm->mmap_mgr.vpn_size        = CONFIG_VMM_STACK_BASE - CONFIG_VMM_MMAP_BASE;
234    dst_vmm->mmap_mgr.first_free_vpn  = CONFIG_VMM_MMAP_BASE;
235    uint32_t i;
236    for( i = 0 ; i < 32 ; i++ ) list_root_init( &dst_vmm->mmap_mgr.zombi_list[i] );
237
238    // initialize instrumentation counters
239        dst_vmm->pgfault_nr    = 0;
240        dst_vmm->u_err_nr      = 0;
241        dst_vmm->m_err_nr      = 0;
242
243    // copy base addresses
244    dst_vmm->kent_vpn_base = src_vmm->kent_vpn_base;
245    dst_vmm->args_vpn_base = src_vmm->args_vpn_base;
246    dst_vmm->envs_vpn_base = src_vmm->envs_vpn_base;
247    dst_vmm->heap_vpn_base = src_vmm->heap_vpn_base;
248    dst_vmm->code_vpn_base = src_vmm->code_vpn_base;
249    dst_vmm->data_vpn_base = src_vmm->data_vpn_base;
250
251    dst_vmm->entry_point   = src_vmm->entry_point;
252
253    // HEAP TODO : new heap for child ???
254    dst_vmm->heap_vseg     = src_vmm->heap_vseg;
255
256    // initialize generic page table
257    error = hal_gpt_create( &dst_vmm->gpt );
258
259    if( error )
260    {
261        printk("\n[ERROR] in %s : cannot initialize page table\n", __FUNCTION__ );
262        return ENOMEM;
263    }
264
265    // copy GPT content from src_vmm to dst_vmm, activating "Copy-On-Write"
266    // TODO register Copy-On_Write in page descriptors
267    bool_t cow = true;
268    hal_gpt_copy( &dst_vmm->gpt , &src_vmm->gpt , cow );
269
270    hal_fence();
271
272    return 0;
273
274}  // vmm_copy()
275
276///////////////////////////////////////
277void vmm_destroy( process_t * process )
278{
279        vseg_t * vseg;
280
281    // get pointer on VMM
282    vmm_t  * vmm = &process->vmm;
283
284    // get lock protecting vseg list
285        rwlock_wr_lock( &vmm->vsegs_lock );
286
287    // remove all vsegs registered in vmm
288        while( !list_is_empty( &vmm->vsegs_root ) )
289        {
290                vseg = LIST_FIRST( &vmm->vsegs_root ,  vseg_t , list );
291                vseg_detach( vmm , vseg );
292        vseg_free( vseg );
293        }
294
295    // delete vsegs radix_tree
296    grdxt_destroy( &vmm->grdxt );
297
298    // release lock
299        rwlock_wr_unlock(&vmm->vsegs_lock);
300
301    // remove all vsegs from zombi_lists in MMAP allocator
302    uint32_t i;
303    for( i = 0 ; i<32 ; i++ )
304    {
305            while( !list_is_empty( &vmm->mmap_mgr.zombi_list[i] ) )
306            {
307                    vseg = LIST_FIRST( &vmm->mmap_mgr.zombi_list[i] , vseg_t , list );
308                    vseg_detach( vmm , vseg );
309            vseg_free( vseg );
310            }
311    }
312
313    // release memory allocated to the local page table
314    hal_gpt_destroy( &vmm->gpt );
315
316}  // end vmm_destroy()
317
318/////////////////////////////////////////////////
319vseg_t * vmm_check_conflict( process_t * process,
320                             vpn_t       vpn_base,
321                             vpn_t       vpn_size )
322{
323    vmm_t        * vmm = &process->vmm;
324        vseg_t       * vseg;
325    list_entry_t * iter;
326
327    // scan the list of registered vsegs
328        LIST_FOREACH( &vmm->vsegs_root , iter )
329        {
330                vseg = LIST_ELEMENT( iter , vseg_t , list );
331
332                if( ((vpn_base + vpn_size) > vseg->vpn_base) &&
333             (vpn_base < (vseg->vpn_base + vseg->vpn_size)) ) return vseg;
334        }
335    return NULL;
336
337}  // end vmm_check_conflict()
338
339////////////////////////////////////////////////////////////////////////////////////////////
340// This static function is called by the vmm_create_vseg() function, and implements
341// the VMM stack_vseg specific allocator.
342////////////////////////////////////////////////////////////////////////////////////////////
343// @ vmm      : pointer on VMM.
344// @ vpn_base : (return value) first allocated page
345// @ vpn_size : (return value) number of allocated pages
346////////////////////////////////////////////////////////////////////////////////////////////
347static error_t vmm_stack_alloc( vmm_t * vmm,
348                                vpn_t * vpn_base,
349                                vpn_t * vpn_size )
350{
351    // get stack allocator pointer
352    stack_mgr_t * mgr = &vmm->stack_mgr;
353
354    // get lock on stack allocator
355    spinlock_lock( &mgr->lock );
356
357    // get first free slot index in bitmap
358    int32_t index = bitmap_ffc( &mgr->bitmap , 4 );
359    if( (index < 0) || (index > 31) )
360    {
361        spinlock_unlock( &mgr->lock );
362        return ENOMEM;
363    }
364
365    // update bitmap
366    bitmap_set( &mgr->bitmap , index );
367
368    // release lock on stack allocator
369    spinlock_unlock( &mgr->lock );
370
371    // returns vpn_base, vpn_size (one page non allocated)
372    *vpn_base = mgr->vpn_base + index * CONFIG_VMM_STACK_SIZE + 1;
373    *vpn_size = CONFIG_VMM_STACK_SIZE - 1;
374    return 0;
375
376} // end vmm_stack_alloc()
377
378////////////////////////////////////////////////////////////////////////////////////////////
379// This static function is called by the vmm_create_vseg() function, and implements
380// the VMM MMAP specific allocator.
381////////////////////////////////////////////////////////////////////////////////////////////
382// @ vmm      : [in] pointer on VMM.
383// @ npages   : [in] requested number of pages.
384// @ vpn_base : [out] first allocated page.
385// @ vpn_size : [out] actual number of allocated pages.
386////////////////////////////////////////////////////////////////////////////////////////////
387static error_t vmm_mmap_alloc( vmm_t * vmm,
388                               vpn_t   npages,
389                               vpn_t * vpn_base,
390                               vpn_t * vpn_size )
391{
392    uint32_t   index;
393    vseg_t   * vseg;
394    vpn_t      base;
395    vpn_t      size;
396    vpn_t      free;
397
398    // mmap vseg size must be power of 2
399    // compute actual size and index in zombi_list array
400    size  = POW2_ROUNDUP( npages );
401    index = bits_log2( size );
402
403    // get mmap allocator pointer
404    mmap_mgr_t * mgr = &vmm->mmap_mgr;
405
406    // get lock on mmap allocator
407    spinlock_lock( &mgr->lock );
408
409    // get vseg from zombi_list or from mmap zone
410    if( list_is_empty( &mgr->zombi_list[index] ) )     // from mmap zone
411    {
412        // check overflow
413        free = mgr->first_free_vpn;
414        if( (free + size) > mgr->vpn_size ) return ENOMEM;
415
416        // update STACK allocator
417        mgr->first_free_vpn += size;
418
419        // compute base
420        base = free;
421    }
422    else                                             // from zombi_list
423    {
424        // get pointer on zombi vseg from zombi_list
425        vseg = LIST_FIRST( &mgr->zombi_list[index] , vseg_t , list );
426
427        // remove vseg from free-list
428        list_unlink( &vseg->list );
429
430        // compute base
431        base = vseg->vpn_base;
432    }
433
434    // release lock on mmap allocator
435    spinlock_unlock( &mgr->lock );
436
437    // returns vpn_base, vpn_size
438    *vpn_base = base;
439    *vpn_size = size;
440    return 0;
441
442}  // end vmm_mmap_alloc()
443
444//////////////////////////////////////////////
445vseg_t * vmm_create_vseg( process_t * process,
446                          intptr_t    base,
447                              intptr_t    size,
448                              uint32_t    type )
449{
450    vseg_t     * vseg;          // created vseg pointer
451    vpn_t        vpn_base;      // first page index
452    vpn_t        vpn_size;      // number of pages
453        error_t      error;
454
455    // get pointer on VMM
456        vmm_t * vmm = &process->vmm;
457
458        vmm_dmsg("\n[INFO] %s : enter for process %x / base = %x / size = %x / type = %s\n",
459                     __FUNCTION__ , process->pid , base , size , vseg_type_str(type) );
460
461    // compute base, size, vpn_base, vpn_size, depending on vseg type
462    // we use the VMM specific allocators for STACK and MMAP vsegs
463    if( type == VSEG_TYPE_STACK )
464    {
465        // get vpn_base and vpn_size from STACK allocator
466        error = vmm_stack_alloc( vmm , &vpn_base , &vpn_size );
467        if( error )
468        {
469            printk("\n[ERROR] in %s : no vspace for stack vseg / process %x in cluster %x\n",
470                   __FUNCTION__ , process->pid , local_cxy );
471            return NULL;
472        }
473
474        // compute vseg base and size from vpn_base and vpn_size
475        base = vpn_base << CONFIG_PPM_PAGE_SHIFT;
476        size = vpn_size << CONFIG_PPM_PAGE_SHIFT;
477    }
478    else if( (type == VSEG_TYPE_ANON) ||
479             (type == VSEG_TYPE_FILE) ||
480             (type == VSEG_TYPE_REMOTE) )
481    {
482        // get vpn_base and vpn_size from MMAP allocator
483        vpn_t npages = size >> CONFIG_PPM_PAGE_SHIFT;
484        error = vmm_mmap_alloc( vmm , npages , &vpn_base , &vpn_size );
485        if( error )
486        {
487            printk("\n[ERROR] in %s : no vspace for mmap vseg / process %x in cluster %x\n",
488                   __FUNCTION__ , process->pid , local_cxy );
489            return NULL;
490        }
491
492        // compute vseg base and size from vpn_base and vpn_size
493        base = vpn_base << CONFIG_PPM_PAGE_SHIFT;
494        size = vpn_size << CONFIG_PPM_PAGE_SHIFT;
495    }
496    else
497    {
498        uint32_t vpn_min = base >> CONFIG_PPM_PAGE_SHIFT;
499        uint32_t vpn_max = (base + size - 1) >> CONFIG_PPM_PAGE_SHIFT;
500
501        vpn_base = vpn_min;
502            vpn_size = vpn_max - vpn_min + 1;
503    }
504
505    // check collisions
506    vseg = vmm_check_conflict( process , vpn_base , vpn_size );
507    if( vseg != NULL )
508    {
509        printk("\n[ERROR] in %s for process %x : new vseg [vpn_base = %x / vpn_size = %x]\n"
510               "  overlap existing vseg [vpn_base = %x / vpn_size = %x]\n",
511               __FUNCTION__ , process->pid, vpn_base, vpn_size,
512               vseg->vpn_base, vseg->vpn_size );
513        return NULL;
514    }
515
516    // allocate physical memory for vseg descriptor
517        vseg = vseg_alloc();
518        if( vseg == NULL )
519        {
520            printk("\n[ERROR] in %s for process %x : cannot allocate memory for vseg\n",
521             __FUNCTION__ , process->pid );
522        return NULL;
523        }
524
525    // initialize vseg descriptor
526        vseg_init( vseg , base, size , vpn_base , vpn_size , type , local_cxy );
527
528    // update "heap_vseg" in VMM
529        process->vmm.heap_vseg = vseg;
530
531    // attach vseg to vmm
532        rwlock_wr_lock( &vmm->vsegs_lock );
533        vseg_attach( vmm , vseg );
534        rwlock_wr_unlock( &vmm->vsegs_lock );
535
536        vmm_dmsg("\n[INFO] %s : exit for process %x / vseg [%x, %x] has been mapped\n",
537                     __FUNCTION__ , process->pid , vseg->min , vseg->max );
538
539        return vseg;
540}
541
542/////////////////////////////////////
543void vmm_remove_vseg( vseg_t * vseg )
544{
545    // get pointers on calling process and VMM
546    thread_t   * this    = CURRENT_THREAD;
547    process_t  * process = this->process;
548    vmm_t      * vmm     = &this->process->vmm;
549    uint32_t     type    = vseg->type;
550
551    // detach vseg from VMM
552        rwlock_wr_lock( &vmm->vsegs_lock );
553    vseg_detach( &process->vmm , vseg );
554        rwlock_wr_unlock( &vmm->vsegs_lock );
555
556    // release the stack slot to VMM stack allocator if STACK type
557    if( type == VSEG_TYPE_STACK )
558    {
559        // get pointer on stack allocator
560        stack_mgr_t * mgr = &vmm->stack_mgr;
561
562        // compute slot index
563        uint32_t index = ((vseg->vpn_base - mgr->vpn_base - 1) / CONFIG_VMM_STACK_SIZE);
564
565        // update stacks_bitmap
566        spinlock_lock( &mgr->lock );
567        bitmap_clear( &mgr->bitmap , index );
568        spinlock_unlock( &mgr->lock );
569    }
570
571    // release the vseg to VMM mmap allocator if MMAP type
572    if( (type == VSEG_TYPE_ANON) || (type == VSEG_TYPE_FILE) || (type == VSEG_TYPE_REMOTE) )
573    {
574        // get pointer on mmap allocator
575        mmap_mgr_t * mgr = &vmm->mmap_mgr;
576
577        // compute zombi_list index
578        uint32_t index = bits_log2( vseg->vpn_size );
579
580        // update zombi_list
581        spinlock_lock( &mgr->lock );
582        list_add_first( &mgr->zombi_list[index] , &vseg->list );
583        spinlock_unlock( &mgr->lock );
584    }
585
586    // release physical memory allocated for vseg descriptor if no MMAP type
587    if( (type != VSEG_TYPE_ANON) && (type != VSEG_TYPE_FILE) && (type != VSEG_TYPE_REMOTE) )
588    {
589        vseg_free( vseg );
590    }
591}
592
593//////////////////////////////////////////////
594error_t vmm_map_kernel_vseg( vseg_t    * vseg,
595                             uint32_t    attr )
596{
597    vpn_t       vpn;        // VPN of PTE to be set
598    vpn_t       vpn_min;    // VPN of first PTE to be set
599    vpn_t       vpn_max;    // VPN of last PTE to be set (excluded)
600        ppn_t       ppn;        // PPN of allocated physical page
601        uint32_t    order;      // ln( number of small pages for one single PTE )
602        page_t    * page;
603    error_t     error;
604
605    // check vseg type : must be a kernel vseg
606    uint32_t type = vseg->type;
607    assert( ((type==VSEG_TYPE_KCODE) || (type==VSEG_TYPE_KDATA) || (type==VSEG_TYPE_KDEV)),
608            __FUNCTION__ , "not a kernel vseg\n" );
609
610    // get pointer on page table
611    gpt_t * gpt = &process_zero.vmm.gpt;
612
613    // define number of small pages per PTE
614        if( attr & GPT_SMALL ) order = 0;   // 1 small page
615        else                   order = 9;   // 512 small pages
616
617    // loop on pages in vseg
618    vpn_min = vseg->vpn_base;
619    vpn_max = vpn_min + vseg->vpn_size;
620        for( vpn = vpn_min ; vpn < vpn_max ; vpn++ )
621        {
622        // allocate a physical page from local PPM
623            kmem_req_t req;
624            req.type  = KMEM_PAGE;
625            req.size  = order;
626            req.flags = AF_KERNEL | AF_ZERO;
627            page      = (page_t *)kmem_alloc( &req );
628                if( page == NULL )
629        {
630            printk("\n[ERROR] in %s : cannot allocate physical memory\n", __FUNCTION__ );
631            return ENOMEM;
632        }
633
634        // set page table entry
635        ppn = ppm_page2ppn( XPTR( local_cxy , page ) );
636        error = hal_gpt_set_pte( gpt , vpn , ppn , attr );
637                if( error )
638        {
639            printk("\n[ERROR] in %s : cannot register PPE\n", __FUNCTION__ );
640            return ENOMEM;
641        }
642        }
643
644        return 0;
645}
646
647/////////////////////////////////////////
648void vmm_unmap_vseg( process_t * process,
649                     vseg_t    * vseg )
650{
651    vpn_t       vpn;        // VPN of current PTE
652    vpn_t       vpn_min;    // VPN of first PTE
653    vpn_t       vpn_max;    // VPN of last PTE (excluded)
654
655    // get pointer on process page table
656    gpt_t     * gpt = &process->vmm.gpt;
657
658    // loop on pages in vseg
659    vpn_min = vseg->vpn_base;
660    vpn_max = vpn_min + vseg->vpn_size;
661        for( vpn = vpn_min ; vpn < vpn_max ; vpn++ )
662    {
663        hal_gpt_reset_pte( gpt , vpn );
664    }
665}
666
667/////////////////////////////////////////////
668error_t vmm_resize_vseg( process_t * process,
669                         intptr_t    base,
670                         intptr_t    size )
671{
672        error_t error;
673
674    // get pointer on process VMM
675    vmm_t * vmm = &process->vmm;
676
677    intptr_t addr_min = base;
678        intptr_t addr_max = base + size;
679    uint32_t shift    = CONFIG_PPM_PAGE_SHIFT;
680
681    // get pointer on vseg
682        vseg_t * vseg = grdxt_lookup( &vmm->grdxt , (uint32_t)(base >> shift) );
683
684        if( vseg == NULL)  return EINVAL;
685
686    // get VMM lock protecting vsegs list
687        rwlock_wr_lock( &vmm->vsegs_lock );
688
689        if( (vseg->min > addr_min) || (vseg->max < addr_max) )   // region not included in vseg
690    {
691        error = EINVAL;
692    }
693        else if( (vseg->min == addr_min) && (vseg->max == addr_max) ) // vseg must be removed
694    {
695        vmm_remove_vseg( vseg );
696        error = 0;
697    }
698        else if( vseg->min == addr_min )                              // vseg must be resized
699    {
700        printk("\n[PANIC] in %s : resize not implemented yet\n", __FUNCTION__ );
701        hal_core_sleep();
702                error = 0;
703    }
704        else if( vseg->max == addr_max )                              // vseg must be resized
705    {
706        printk("\n[PANIC] in %s : resize not implemented yet\n", __FUNCTION__ );
707        hal_core_sleep();
708                error = 0;
709    }
710    else            // vseg cut in three regions => vseg must be resized & new vseg created
711    {
712        printk("\n[PANIC] in %s : resize not implemented yet\n", __FUNCTION__ );
713        hal_core_sleep();
714                error = 0;
715    }
716
717    // release VMM lock
718        rwlock_wr_unlock( &vmm->vsegs_lock );
719
720        return error;
721}
722
723///////////////////////////////////////////
724vseg_t * vmm_get_vseg( process_t * process,
725                       intptr_t    vaddr )
726{
727
728    // get pointer on process VMM
729    vmm_t * vmm = &process->vmm;
730
731    // get lock protecting the vseg list
732    rwlock_rd_lock( &vmm->vsegs_lock );
733
734    // get pointer on vseg from radix tree
735        vseg_t * vseg = grdxt_lookup( &vmm->grdxt, (uint32_t)(vaddr >> CONFIG_PPM_PAGE_SHIFT) );
736
737    // release the lock
738    rwlock_rd_unlock( &vmm->vsegs_lock );
739
740    return vseg;
741}
742
743////////////////////////////////////////
744error_t vmm_get_one_ppn( vseg_t * vseg,
745                         vpn_t    vpn,
746                         ppn_t  * ppn )
747{
748    error_t    error;
749    cxy_t      page_cxy;          // physical page cluster
750    page_t   * page_ptr;          // local pointer on physical page descriptor
751
752    uint32_t   type      = vseg->type;
753    xptr_t     mapper_xp = vseg->mapper_xp;
754    uint32_t   flags     = vseg->flags;
755
756    // get mapper cluster and local pointer
757    cxy_t      mapper_cxy = GET_CXY( mapper_xp );
758    mapper_t * mapper_ptr = (mapper_t *)GET_PTR( mapper_xp );
759
760    // FILE type : simply get the physical page from the file mapper
761    if( type == VSEG_TYPE_FILE )
762    {
763        // compute index in file mapper
764        uint32_t index = vpn - vseg->vpn_base;
765
766        // get page descriptor from mapper
767        if( mapper_cxy == local_cxy )             // mapper is local
768        {
769            page_ptr = mapper_get_page( mapper_ptr , index );
770        }
771        else                                      // mapper is remote
772        {
773            rpc_mapper_get_page_client( mapper_cxy , mapper_ptr , index , &page_ptr );
774        }
775
776        if ( page_ptr == NULL ) return EINVAL;
777
778        page_cxy = mapper_cxy;
779    }
780
781    // all other types : allocate a physical page from target cluster,
782    else
783    {
784        // get target cluster for physical page
785        if( flags & VSEG_DISTRIB ) // depends on VPN LSB
786        {
787            uint32_t x_width = LOCAL_CLUSTER->x_width;
788            uint32_t y_width = LOCAL_CLUSTER->y_width;
789            page_cxy = vpn & ((1<<(x_width + y_width)) - 1);
790        }
791        else                       // defined in vseg descriptor
792        {
793            page_cxy = vseg->cxy;
794        }
795
796        // allocate a physical page in target cluster
797        kmem_req_t   req;
798        if( page_cxy == local_cxy )    // target cluster is the local cluster
799        {
800            req.type  = KMEM_PAGE;
801            req.size  = 0;
802            req.flags = AF_NONE;
803            page_ptr  = (page_t *)kmem_alloc( &req );
804        }
805        else                           // target cluster is not the local cluster
806        {
807            rpc_pmem_get_pages_client( page_cxy , 0 , &page_ptr );
808        }
809
810        if( page_ptr == NULL ) return ENOMEM;
811
812        // initialise page from .elf file mapper for DATA and CODE types
813        if( (type == VSEG_TYPE_CODE) || (type == VSEG_TYPE_DATA) )
814        {
815            // compute missing page index in vseg
816            vpn_t page_index = vpn - vseg->vpn_base;
817
818            // compute missing page offset in .elf file
819            intptr_t page_offset = vseg->file_offset + 
820                                   (page_index << CONFIG_PPM_PAGE_SHIFT);
821
822            // compute extended pointer on page first byte
823            xptr_t base_xp = ppm_page2base( XPTR( page_cxy , page_ptr ) );
824
825            // file_size can be smaller than vseg_size for BSS
826            intptr_t file_size = vseg->file_size;
827
828            if( file_size < page_offset )                                // fully in  BSS
829            {
830                if( page_cxy == local_cxy )
831                {
832                    memset( GET_PTR( base_xp ) , 0 , CONFIG_PPM_PAGE_SIZE );
833                }
834                else
835                {
836                   hal_remote_memset( base_xp , 0 , CONFIG_PPM_PAGE_SIZE );       
837                }
838            }
839            else if( file_size >= (page_offset + CONFIG_PPM_PAGE_SIZE) )  // fully in  mapper
840            {
841                if( mapper_cxy == local_cxy ) 
842                {
843                    error = mapper_move_kernel( mapper_ptr,
844                                                true,             // to_buffer
845                                                page_offset,
846                                                base_xp,
847                                                CONFIG_PPM_PAGE_SIZE ); 
848                }
849                else 
850                {
851                    rpc_mapper_move_buffer_client( mapper_cxy,
852                                                   mapper_ptr,
853                                                   true,         // to buffer
854                                                   false,        // kernel buffer
855                                                   page_offset,
856                                                   (uint64_t)base_xp,
857                                                   CONFIG_PPM_PAGE_SIZE,
858                                                   &error );
859                }
860                if( error ) return EINVAL;
861            }
862            else  // in mapper : from page_offset -> (file_size - page_offset)
863                  // in BSS    : from file_size   -> (page_offset + page_size)
864            {
865                // initialize mapper part
866                if( mapper_cxy == local_cxy )
867                {
868                    error = mapper_move_kernel( mapper_ptr,
869                                                true,         // to buffer
870                                                page_offset,
871                                                base_xp,
872                                                file_size - page_offset ); 
873                }
874                else                               
875                {
876                    rpc_mapper_move_buffer_client( mapper_cxy,
877                                                   mapper_ptr,
878                                                   true,         // to buffer
879                                                   false,        // kernel buffer
880                                                   page_offset,
881                                                   (uint64_t)base_xp,
882                                                   file_size - page_offset, 
883                                                   &error );
884                }
885                if( error ) return EINVAL;
886
887                // initialize BSS part
888                if( page_cxy == local_cxy )
889                {
890                    memset( GET_PTR( base_xp ) + file_size - page_offset , 0 , 
891                            page_offset + CONFIG_PPM_PAGE_SIZE - file_size );
892                }
893                else
894                {
895                   hal_remote_memset( base_xp + file_size - page_offset , 0 , 
896                                      page_offset + CONFIG_PPM_PAGE_SIZE - file_size );
897                }
898            }   
899        }  // end initialisation for CODE or DATA types   
900    } 
901
902    // return ppn
903    *ppn = ppm_page2ppn( XPTR( page_cxy , page_ptr ) );
904    return 0;
905
906}  // end vmm_get_one_ppn()
907
908/////////////////////////////////////////
909error_t vmm_get_pte( process_t * process,
910                     vpn_t       vpn,
911                     uint32_t  * ret_attr,
912                     ppn_t     * ret_ppn )
913{
914    vseg_t  * vseg;   // pointer on vseg containing VPN
915    ppn_t     ppn;    // physical page number
916    uint32_t  attr;   // attributes from GPT entry
917    error_t   error;
918
919    // this function must be called by a thread running in the reference cluster
920    assert( (GET_CXY( process->ref_xp ) == local_cxy ) , __FUNCTION__ ,
921             " not called in the reference cluster\n" );
922
923    // get VMM pointer
924    vmm_t * vmm = &process->vmm;
925
926    // access GPT to get PTE attributes and PPN
927    hal_gpt_get_pte( &vmm->gpt , vpn , &attr , &ppn );
928
929    // if PTE is unmapped
930    // 1) get VSEG containing the missing VPN
931    // 2) get & initialize physical page (depending on vseg type),
932    // 3) register the PTE in reference GPT
933    if( (attr & GPT_MAPPED) == 0 )
934    {
935        // 1. get vseg pointer
936        vseg = vmm_get_vseg( process , vpn<<CONFIG_PPM_PAGE_SHIFT );
937
938        if( vseg == NULL )
939        {
940            printk("\n[ERROR] in %s : out of segment / process = %x / vpn = %x\n",
941                   __FUNCTION__ , process->pid , vpn );
942            return EINVAL;
943        }
944
945        // 2. get physical page number, depending on vseg type
946        error = vmm_get_one_ppn( vseg , vpn , &ppn );
947
948        if( error )
949        {
950            printk("\n[ERROR] in %s : cannot allocate memory / process = %x / vpn = %x\n",
951                   __FUNCTION__ , process->pid , vpn );
952            return error;
953        }
954
955        // 3. define attributes from vseg flags and register in GPT
956        attr = GPT_MAPPED | GPT_SMALL;
957        if( vseg->flags & VSEG_USER  ) attr |= GPT_USER;
958        if( vseg->flags & VSEG_WRITE ) attr |= GPT_WRITABLE;
959        if( vseg->flags & VSEG_EXEC  ) attr |= GPT_EXECUTABLE;
960        if( vseg->flags & VSEG_CACHE ) attr |= GPT_CACHABLE;
961
962        error = hal_gpt_set_pte( &vmm->gpt , vpn , ppn , attr );
963
964        if( error )
965        {
966            printk("\n[ERROR] in %s : cannot register PTE / process = %x / vpn = %x\n",
967                   __FUNCTION__ , process->pid , vpn );
968            return ENOMEM;
969        }
970    }  // end new PTE
971
972    *ret_ppn  = ppn;
973    *ret_attr = attr;
974    return 0;
975
976}  // end vmm_get_pte()
977
978///////////////////////////////////////////////////
979error_t vmm_handle_page_fault( process_t * process,
980                               vseg_t    * vseg,
981                               vpn_t       vpn )
982{
983    uint32_t         attr;          // missing page attributes
984    ppn_t            ppn;           // missing page PPN
985    error_t          error;         // return value
986
987    // get local VMM pointer
988        vmm_t * vmm = &process->vmm;
989
990    // get reference process cluster and local pointer
991    cxy_t       ref_cxy = GET_CXY( process->ref_xp );
992    process_t * ref_ptr = (process_t *)GET_PTR( process->ref_xp );
993
994    // get missing PTE attributes and PPN from reference cluster
995    if( local_cxy != ref_cxy )   // local cluster is not the reference cluster
996    {
997        rpc_vmm_get_pte_client( ref_cxy , ref_ptr , vpn , &attr , &ppn , &error );
998    }
999    else                              // local cluster is the reference cluster
1000    {
1001        error = vmm_get_pte( process , vpn , &attr , &ppn );
1002    }
1003
1004    // check page allocation error
1005    if( error )
1006    {
1007        printk("\n[ERROR] in %s : cannot allocate memory / process = %x / vpn = %x\n",
1008               __FUNCTION__ , process->pid , vpn );
1009            return ENOMEM;
1010    }
1011
1012    return 0;
1013
1014}  // end vmm_handle_page_fault()
1015
1016
1017///////////////////////////////////////////
1018error_t vmm_v2p_translate( bool_t    ident,
1019                           void    * ptr,
1020                           paddr_t * paddr )
1021{
1022    process_t * process = CURRENT_THREAD->process;
1023
1024    if( ident )  // identity mapping
1025    {
1026        *paddr = (paddr_t)PADDR( local_cxy , (lpa_t)ptr );
1027        return 0;
1028    }
1029
1030    // access page table
1031    error_t  error;
1032    vpn_t    vpn;
1033    uint32_t attr;
1034    ppn_t    ppn;
1035    uint32_t offset;
1036
1037    vpn    = (vpn_t)( (intptr_t)ptr >> CONFIG_PPM_PAGE_SHIFT );
1038    offset = (uint32_t)( ((intptr_t)ptr) & CONFIG_PPM_PAGE_MASK );
1039
1040    if( local_cxy == GET_CXY( process->ref_xp) ) // calling process is reference process
1041    {
1042        error = vmm_get_pte( process, vpn , &attr , &ppn );
1043    }
1044    else                                         // calling process is not reference process
1045    {
1046        cxy_t       ref_cxy = GET_CXY( process->ref_xp );
1047        process_t * ref_ptr = (process_t *)GET_PTR( process->ref_xp );
1048        rpc_vmm_get_pte_client( ref_cxy , ref_ptr , vpn , &attr , &ppn , &error );
1049    }
1050
1051    // set paddr
1052    *paddr = (((paddr_t)ppn) << CONFIG_PPM_PAGE_SHIFT) | offset;
1053
1054    return error;
1055
1056}  // end vmm_v2p_translate()
1057
1058/* deprecated
1059
1060///////////////////////////////////////////////////////////////////
1061///////////////////////////////////////////////////////////////////
1062error_t vmm_inval_shared_page( vseg_t *vseg, vma_t vaddr, ppn_t ppn)
1063{
1064        pmm_page_info_t current;
1065        error_t err;
1066
1067        error= pmm_get_page(&vseg->vmm->pmm, vaddr, &current);
1068
1069        if((err) || (current.ppn != ppn))
1070                goto ended;
1071
1072        current.ppn     = 0;
1073        current.attr    = 0;
1074        current.cluster = NULL;
1075
1076        error= pmm_set_page(&vseg->vmm->pmm, vaddr, &current);
1077
1078ended:
1079        return err;
1080}
1081
1082error_t vmm_update_shared_page( vseg_t *vseg, vma_t vaddr, ppn_t ppn)
1083{
1084        pmm_page_info_t current;
1085        error_t err;
1086
1087        error= pmm_get_page(&vseg->vmm->pmm, vaddr, &current);
1088
1089        if((err) || (current.attr != 0))
1090                goto ended;
1091
1092        current.ppn     = ppn;
1093        current.attr    = vseg->vm_pgprot;
1094        current.cluster = NULL; // this function is called after invalidate one
1095
1096        error= pmm_set_page(&vseg->vmm->pmm, vaddr , &current);
1097
1098ended:
1099        return err;
1100}
1101
1102// Hypothesis: the vseg is shared-anon, mapper list is rdlocked, page is locked
1103error_t vmm_migrate_shared_page_seq( vseg_t *vseg, struct page_s *page, struct page_s **new)
1104{
1105        register  vseg_t *reg;
1106        register struct process_s *process;
1107        register struct process_s *this_process;
1108        struct page_s *new_pg;
1109        struct list_entry *iter;
1110        kmem_req_t req;
1111        vma_t vaddr;
1112        ppn_t ppn;
1113        error_t err;
1114
1115        vaddr     = (page->index << PMM_PAGE_SHIFT) + vseg->vm_start + vseg->vm_offset;
1116        ppn       = ppm_page2ppn(page);
1117        this_process = (new == NULL) ? NULL : current_process;
1118        iter      = &vseg->vm_shared_list;
1119        error      = ECANCELED;
1120
1121        // Invalidate All
1122        do
1123        {
1124                reg  = list_element(iter,  vseg_t, vm_shared_list);
1125
1126                process = vmm_get_process(reg->vmm);
1127
1128                if(process != this_process)
1129                {
1130                        error= vmm_inval_shared_page(reg, vaddr, ppn);
1131
1132                        if(err) goto fail_inval;
1133                }
1134
1135                assert(vseg->vm_mapper.m_home_cid == current_cid);
1136                iter = list_next(&vseg->vm_mapper.m_reg_root, iter);
1137
1138        }while(iter != NULL);
1139
1140        req.type  = KMEM_PAGE;
1141        req.size  = 0;
1142        req.excep_code = AF_USER;
1143
1144        new_pg    = kmem_alloc(&req);
1145        *new      = new_pg;
1146
1147        if(new_pg == NULL)
1148        {
1149                error= ENOMEM;
1150                goto fail_alloc;
1151        }
1152
1153        page_copy(new_pg, page);
1154
1155        page_lock(new_pg);
1156
1157        new_pg->mapper = page->mapper;
1158        new_pg->index  = page->index;
1159
1160        // TODO: do the complet job regading dirty page
1161        if(PAGE_IS(page, PG_DIRTY))
1162                PAGE_SET(new_pg, PG_DIRTY);
1163
1164        ppn  = ppm_page2ppn(new_pg);
1165        iter = &vseg->vm_shared_list;
1166
1167        // Update All
1168        do
1169        {
1170                reg  = list_element(iter,  vseg_t, vm_shared_list);
1171
1172                process = vmm_get_process(reg->vmm);
1173
1174                if(process != this_process)
1175                        (void) vmm_update_shared_page(reg, vaddr, ppn);
1176
1177                assert(vseg->vm_mapper.m_home_cid == current_cid);
1178                iter = list_next(&vseg->vm_mapper.m_reg_root, iter);
1179
1180
1181        }while(iter != NULL);
1182
1183        page_unlock(new_pg);
1184
1185fail_alloc:
1186fail_inval:
1187        return err;
1188}
1189
1190//TODO: revisit all manipulation of the page->refcount
1191///////////////////////////////////////////////////////////////
1192static inline error_t vmm_do_migrate( vseg_t     * vseg,
1193                                      pmm_page_info_t * pinfo,
1194                                      uint32_t          vaddr )
1195{
1196        kmem_req_t        req;
1197        pmm_page_info_t   current;
1198        page_t          * newpage;
1199        cluster_t       * cluster;
1200        thread_t        * this;
1201        error_t           err;
1202        ppn_t             ppn;
1203
1204        assert( pinfo->ppn != 0 );
1205
1206        ppn = pinfo->ppn;
1207        this = current_thread;
1208        newpage = NULL;
1209        cluster = current_cluster;
1210
1211        current.attr = 0;
1212        current.ppn  = 0;
1213
1214        error= pmm_lock_page(&vseg->vmm->pmm, vaddr, &current);
1215
1216        if(error|| (current.isAtomic == false) ||
1217              (current.ppn != ppn) || !(current.attr & PMM_MIGRATE))
1218        {
1219#if CONFIG_SHOW_SPURIOUS_PGFAULT
1220                printk(INFO, "%s: pid %d, tid %d, cpu %d, nothing to do for vaddr %x\n",
1221                       __FUNCTION__,
1222                       this->process->pid,
1223                       this->info.order,
1224                       cpu_get_id(),
1225                       vaddr);
1226#endif
1227                this->info.spurious_pgfault_cntr ++;
1228                pmm_unlock_page(&vseg->vmm->pmm, vaddr, &current);
1229                pmm_tlb_flush_vaddr(vaddr, PMM_DATA);
1230                return 0;
1231        }
1232
1233        if(!ppn_is_local(ppn))
1234        {
1235                req.type  = KMEM_PAGE;
1236                req.size  = 0;
1237                req.excep_code = AF_PGFAULT;
1238
1239                newpage = kmem_alloc(&req);
1240
1241                if(newpage)
1242                {
1243                        newpage->mapper = NULL;//?
1244                        ppn_copy(ppm_page2ppn(newpage), ppn);
1245
1246                        if(current.attr & PMM_COW)
1247                        {
1248                                current.attr |= PMM_WRITE;
1249                                current.attr &= ~(PMM_COW);
1250                        }
1251
1252                        current.ppn = ppm_page2ppn(newpage);
1253                }
1254        }
1255
1256        current.attr   |= PMM_PRESENT;
1257        current.attr   &= ~(PMM_MIGRATE);
1258        current.attr   &= ~(PMM_LOCKED);
1259        current.cluster = NULL;
1260
1261        //also unlock the table entry
1262        error= pmm_set_page(&vseg->vmm->pmm, vaddr, &current);
1263       
1264        if(err)
1265        {
1266                // TODO: we should differ the kmem_free call
1267                //page_unlock(page);
1268                (void)pmm_unlock_page(&vseg->vmm->pmm, vaddr, &current);
1269                req.ptr = newpage;
1270                kmem_free(&req);
1271                return err;
1272        }
1273
1274
1275        if(newpage)
1276        {
1277                ppn_refcount_down(ppn);
1278                current_thread->info.remote_pages_cntr ++;
1279#if CONFIG_SHOW_REMOTE_PGALLOC
1280                printk(INFO, "%s: pid %d, tid %x, cpu %d, cid %d: got new remote page from cluster %d (vaddr %x)\n",
1281                       __FUNCTION__,
1282                       current_process->pid,
1283                       current_thread,
1284                       cpu_get_id(),
1285                       cluster->id,
1286                       newpage->cid,
1287                       vaddr);
1288#endif
1289        }
1290
1291#if CONFIG_SHOW_VMMMGRT_MSG
1292        printk(INFO, "%s: pid %d, tid %d, cpu %d: Asked to migrate page (vaddr %x) from cluster %d to cluster %d, error%d\n",
1293               __FUNCTION__,
1294               current_process->pid,
1295               current_thread->info.order,
1296               cpu_get_id(),
1297               vaddr,
1298               ppn_ppn2cid(ppn),
1299               cluster->id,
1300               err);
1301#endif
1302
1303        return err;
1304}
1305
1306error_t vmm_do_cow( vseg_t *vseg, pmm_page_info_t *pinfo, uint32_t vaddr)
1307{
1308        register struct page_s *newpage;
1309        register struct page_s *page;
1310        register struct thread_s *this;
1311        register error_t err;
1312        register uint32_t count;
1313        register bool_t isCountDown;
1314        pmm_page_info_t old;
1315        pmm_page_info_t new;
1316        kmem_req_t req;
1317
1318        this       = current_thread;
1319        old.attr  = 0;
1320        newpage    = NULL;
1321        isCountDown = true;
1322
1323        vmm_dmsg(2,"%s: pid %d, tid %d, cpu %d, vaddr %x\n",
1324                 __FUNCTION__,
1325                 this->process->pid,
1326                 this->info.order,
1327                 cpu_get_id(),
1328                 vaddr);
1329
1330
1331        error= pmm_lock_page(&vseg->vmm->pmm, vaddr, &old);
1332
1333        //TODO: check this condition
1334        if(error|| (old.isAtomic == false) || !(old.attr & PMM_COW))
1335        {
1336#if CONFIG_SHOW_SPURIOUS_PGFAULT
1337                printk(INFO, "%s: pid %d, tid %d, cpu %d, nothing to do for vaddr %x\n",
1338                       __FUNCTION__,
1339                       this->process->pid,
1340                       this->info.order,
1341                       cpu_get_id(),
1342                       vaddr);
1343#endif
1344                this->info.spurious_pgfault_cntr ++;
1345                pmm_tlb_flush_vaddr(vaddr, PMM_DATA);
1346                pmm_unlock_page(&vseg->vmm->pmm, vaddr, &old);
1347                return err;
1348                //goto VMM_COW_END;
1349        }
1350
1351        //if the ppn is local and the others (processus with wich we share the page)
1352        //has done cow, then use the old.ppn directly
1353        if(ppn_is_local(old.ppn))
1354        {
1355                page = ppm_ppn2page(&current_cluster->ppm, old.ppn);
1356
1357                if(page->mapper == NULL)
1358                {
1359                        count = page_refcount_get(page);
1360                        if(count == 1)
1361                        {
1362                                newpage = page;//don't copy the page. use it directly.
1363                                isCountDown = false;
1364                                vmm_dmsg(2, "%s: pid %d, tid %d, cpu %d, reuse same page for vaddr %x, pg_addr %x\n",
1365                                         __FUNCTION__,
1366                                         this->process->pid,
1367                                         this->info.order,
1368                                         cpu_get_id(),
1369                                         vaddr,
1370                                         ppm_page2addr(page));
1371                        }
1372                }
1373                //else: we need to do the cow even if it's local!
1374
1375        }
1376
1377        //else: alocate newpage and copy the data from the remote node
1378        //also defcount down the ppn
1379        if(newpage == NULL)
1380        {
1381                req.type  = KMEM_PAGE;
1382                req.size  = 0;
1383                req.excep_code = AF_PGFAULT;
1384
1385                if((newpage = kmem_alloc(&req)) == NULL)
1386                {
1387                        (void)pmm_unlock_page(&vseg->vmm->pmm, vaddr, &old);
1388                        return ENOMEM;
1389                }       
1390
1391                newpage->mapper = NULL;
1392
1393                ppn_copy(ppm_page2ppn(newpage), old.ppn);
1394                assert(isCountDown);
1395               
1396                vmm_dmsg(2,
1397                         "%s: pid %d, tid %d, cpu %d, newpage for vaddr %x, pg_addr %x\n",
1398                         __FUNCTION__,
1399                         this->process->pid,
1400                         this->info.order,
1401                         cpu_get_id(),
1402                         vaddr,
1403                         ppm_page2addr(newpage));
1404
1405                if(newpage->cid != current_cid)
1406                        this->info.remote_pages_cntr ++;
1407        }
1408
1409        new.attr    = vseg->vm_pgprot | PMM_WRITE;
1410        new.attr   &= ~(PMM_COW | PMM_MIGRATE);
1411        new.ppn     = ppm_page2ppn(newpage);
1412        new.cluster = NULL;
1413
1414        //this also unlock the table entry (if no error)
1415        error= pmm_set_page(&vseg->vmm->pmm, vaddr, &new);
1416
1417        if(err)
1418        {
1419                (void)pmm_unlock_page(&vseg->vmm->pmm, vaddr, &old);
1420                req.ptr = newpage;
1421                kmem_free(&req);
1422                vmm_dmsg(3, "%s: ended [ error%d ]\n", __FUNCTION__, err);
1423                return err;
1424        }
1425       
1426        if(isCountDown) ppn_refcount_down(old.ppn);
1427       
1428        vmm_dmsg(2, "%s, pid %d, tid %d, cpu %d, COW ended [vaddr %x]\n",
1429                 __FUNCTION__,
1430                 this->process->pid,
1431                 this->info.order,
1432                 cpu_get_id(),
1433                 vaddr);
1434
1435        return 0;
1436}
1437
1438
1439//refcount is taken on the file at mmap
1440static inline error_t vmm_do_mapped( vseg_t *vseg, uint32_t vaddr, uint32_t excep_code)
1441{
1442        ppn_t ppn;
1443        error_t err;
1444        uint32_t index;
1445        bool_t isDone;
1446        pmm_page_info_t info;
1447        pmm_page_info_t current;
1448        struct thread_s *this;
1449
1450        this = current_thread;
1451
1452        current.attr = 1;
1453        current.ppn  = 1;
1454        isDone       = false;
1455
1456        error= pmm_lock_page(&vseg->vmm->pmm, vaddr, &current);
1457       
1458        if(err) return err;
1459
1460        if((current.isAtomic == false) || (current.attr != 0))
1461        {
1462#if CONFIG_SHOW_SPURIOUS_PGFAULT
1463                printk(INFO, "%s: pid %d, tid %d, cpu %d, nothing to do for vaddr %x\n",
1464                       __FUNCTION__,
1465                       this->process->pid,
1466                       this->info.order,
1467                       cpu_get_id(),
1468                       vaddr);
1469#endif
1470                this->info.spurious_pgfault_cntr ++;
1471                pmm_tlb_flush_vaddr(vaddr, PMM_DATA);
1472                return 0;
1473        }
1474
1475        index = ((vaddr - vseg->vm_start) + vseg->vm_offset) >> PMM_PAGE_SHIFT;
1476
1477        //also hold a refcount!
1478        ppn = mapper_get_ppn(&vseg->vm_mapper,
1479                               index,
1480                               MAPPER_SYNC_OP);
1481
1482        if(!ppn)
1483        {
1484                error= pmm_unlock_page(&vseg->vmm->pmm, vaddr, &current);
1485                assert(!err); //FIXME: liberate the ppn ...
1486                return (VFS_FILE_IS_NULL(vseg->vm_file)) ? EIO : ENOMEM;
1487        }
1488
1489        info.attr    = vseg->vm_pgprot;
1490        info.ppn     = ppn;
1491        info.cluster = NULL;
1492
1493        //also unlock the page
1494        error= pmm_set_page(&vseg->vmm->pmm, vaddr, &info);
1495
1496        assert(!err);//FIXME: liberate the ppn and unlock the table entry ...
1497        //error= pmm_unlock_page(&vseg->vmm->pmm, vaddr, &current);
1498
1499        return err;
1500}
1501
1502/////////////////////////////////////////////////////
1503static inline error_t vmm_do_aod( vseg_t *vseg, uint32_t vaddr)
1504{
1505        register error_t err;
1506        register struct page_s *page;
1507        register struct cluster_s *cluster;
1508        struct thread_s *this;
1509        pmm_page_info_t old;
1510        pmm_page_info_t new;
1511        kmem_req_t req;
1512
1513        page      = NULL;
1514        old.attr  = 0;
1515        this      = current_thread;
1516
1517        error= pmm_lock_page(&vseg->vmm->pmm, vaddr, &old);
1518
1519        if(err) return err;
1520
1521        if(old.isAtomic == false)
1522        {
1523                this->info.spurious_pgfault_cntr ++;
1524                pmm_tlb_flush_vaddr(vaddr, PMM_DATA);
1525                return 0;
1526        }
1527
1528        req.type  = KMEM_PAGE;
1529        req.size  = 0;
1530        req.excep_code = AF_PGFAULT | AF_ZERO;
1531
1532        if((page = kmem_alloc(&req)) == NULL)
1533        {
1534                (void)pmm_unlock_page(&vseg->vmm->pmm, vaddr, &old);
1535                return ENOMEM;
1536        }
1537
1538        page->mapper = NULL;
1539
1540        new.attr    = vseg->vm_pgprot;
1541        new.ppn     = ppm_page2ppn(page);
1542        new.cluster = NULL;
1543
1544        error= pmm_set_page(&vseg->vmm->pmm, vaddr, &new);
1545       
1546        if(err) goto fail_set_pg;
1547
1548        cluster = current_cluster;
1549
1550        if(page->cid != cluster->id)
1551                this->info.remote_pages_cntr ++;
1552
1553        return 0;
1554
1555fail_set_pg:
1556        (void)pmm_unlock_page(&vseg->vmm->pmm, vaddr, &old);
1557        req.ptr = page;
1558        kmem_free(&req);
1559
1560        vmm_dmsg(3, "%s: ended [ error%d ]\n", __FUNCTION__, err);
1561        return err;
1562}
1563
1564VSEGION_PAGE_FAULT(vmm_default_pagefault)
1565{
1566        register struct thread_s *this;
1567        register error_t err;
1568        pmm_page_info_t info;
1569
1570        if((error= pmm_get_page(&vseg->vmm->pmm, vaddr, &info)))
1571                return err;
1572
1573        if((info.attr != 0) && (info.ppn != 0))
1574        {
1575                if((info.attr & PMM_COW) && pmm_except_isWrite(excep_code))
1576                {
1577                        error= vmm_do_cow(vseg, &info, vaddr);
1578                        return err;
1579                }
1580
1581                if(info.attr & PMM_MIGRATE)
1582                        return vmm_do_migrate(vseg, &info, vaddr);
1583
1584                if(info.attr & PMM_PRESENT)
1585                {
1586                        this = current_thread;
1587
1588#if CONFIG_SHOW_SPURIOUS_PGFAULT
1589                        printk(WARNING, "WARNING: %s: pid %d, tid %d, cpu %d, excep_code %x but vaddr is valid %x, attr %x, ppn %x\n",
1590                               __FUNCTION__,
1591                               this->process->pid,
1592                               this->info.order,
1593                               cpu_get_id(),
1594                               excep_code,
1595                               vaddr,
1596                               info.attr,
1597                               info.ppn);
1598#endif
1599
1600                        current_thread->info.spurious_pgfault_cntr ++;
1601                        pmm_tlb_flush_vaddr(vaddr, PMM_UNKNOWN);
1602                        return 0;
1603                }
1604
1605                current_thread->info.spurious_pgfault_cntr ++;
1606                pmm_tlb_flush_vaddr(vaddr, PMM_UNKNOWN);
1607                return 0;
1608#if 0
1609#if CONFIG_SHOW_VMM_ERROR_MSG
1610                printk(ERROR,
1611                       "ERROR: %s: pid %d, cpu %d, Unexpected page attributes configuration for vaddr %x, found: ppn %x, attr %x\n",
1612                       __FUNCTION__,
1613                       current_process->pid,
1614                       cpu_get_id(),
1615                       vaddr,
1616                       info.ppn,
1617                       info.attr);
1618#endif
1619
1620                return EPERM;
1621#endif
1622        }
1623
1624        if(!MAPPER_IS_NULL(vseg->vm_mapper))
1625                return vmm_do_mapped(vseg, vaddr, excep_code);
1626
1627        return vmm_do_aod(vseg, vaddr);
1628}
1629*/
1630
Note: See TracBrowser for help on using the repository browser.