SimpleOS

LXR

Navigation



Site hébergé par : enix

The LXR Cross Referencer for SOS

source navigation ]
diff markup ]
identifier search ]
general search ]
 
 
Article:1 ] [ 2 ] [ 3 ] [ 4 ] [ 5 ] [ 6 ] [ 6.5 ] [ 7 ] [ 7.5 ] [ 8 ] [ 9 ] [ 9.5 ]

Diff markup

Differences between /sos/umem_vmm.c (Article 8) and /sos/umem_vmm.c (Article 9.5)


001 /* Copyright (C) 2005 David Decotigny          !! 001 /* Copyright (C) 2005,2006 David Decotigny
002                                                   002 
003    This program is free software; you can redi    003    This program is free software; you can redistribute it and/or
004    modify it under the terms of the GNU Genera    004    modify it under the terms of the GNU General Public License
005    as published by the Free Software Foundatio    005    as published by the Free Software Foundation; either version 2
006    of the License, or (at your option) any lat    006    of the License, or (at your option) any later version.
007                                                   007    
008    This program is distributed in the hope tha    008    This program is distributed in the hope that it will be useful,
009    but WITHOUT ANY WARRANTY; without even the     009    but WITHOUT ANY WARRANTY; without even the implied warranty of
010    MERCHANTABILITY or FITNESS FOR A PARTICULAR    010    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
011    GNU General Public License for more details    011    GNU General Public License for more details.
012                                                   012    
013    You should have received a copy of the GNU     013    You should have received a copy of the GNU General Public License
014    along with this program; if not, write to t    014    along with this program; if not, write to the Free Software
015    Foundation, Inc., 59 Temple Place - Suite 3    015    Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307,
016    USA.                                           016    USA. 
017 */                                                017 */
018                                                   018 
019 #include <sos/assert.h>                           019 #include <sos/assert.h>
020 #include <sos/list.h>                             020 #include <sos/list.h>
021 #include <sos/physmem.h>                          021 #include <sos/physmem.h>
022 #include <sos/kmem_slab.h>                        022 #include <sos/kmem_slab.h>
023 #include <drivers/bochs.h>                        023 #include <drivers/bochs.h>
024 #include <hwcore/mm_context.h>                    024 #include <hwcore/mm_context.h>
025 #include <hwcore/paging.h>                        025 #include <hwcore/paging.h>
026 #include <drivers/zero.h>                         026 #include <drivers/zero.h>
027                                                   027 
028 #include "umem_vmm.h"                             028 #include "umem_vmm.h"
029                                                   029 
030                                                   030 
031 struct sos_umem_vmm_as                            031 struct sos_umem_vmm_as
032 {                                                 032 {
033   /** The process that owns this address space    033   /** The process that owns this address space */
034   struct sos_process     * process;               034   struct sos_process     * process;
035                                                   035 
036   /** The MMU configuration of this address sp    036   /** The MMU configuration of this address space */
037   struct sos_mm_context  * mm_context;            037   struct sos_mm_context  * mm_context;
038                                                   038 
039   /** The list of VRs in this address space */    039   /** The list of VRs in this address space */
040   struct sos_umem_vmm_vr * list_vr;               040   struct sos_umem_vmm_vr * list_vr;
041                                                   041 
042   /** Heap location */                            042   /** Heap location */
043   sos_uaddr_t heap_start;                         043   sos_uaddr_t heap_start;
044   sos_size_t  heap_size; /**< Updated by sos_u    044   sos_size_t  heap_size; /**< Updated by sos_umem_vmm_brk() */
045                                                   045 
046   /* Memory usage statistics */                   046   /* Memory usage statistics */
047   sos_size_t phys_total; /* shared + private *    047   sos_size_t phys_total; /* shared + private */
048   struct vm_usage                                 048   struct vm_usage
049   {                                               049   {
050     sos_size_t overall;                           050     sos_size_t overall;
051     sos_size_t ro, rw, code /* all: non readab    051     sos_size_t ro, rw, code /* all: non readable, read and read/write */;
052   } vm_total, vm_shrd;                            052   } vm_total, vm_shrd;
053                                                   053 
054   /* Page fault counters */                       054   /* Page fault counters */
055   sos_size_t pgflt_cow;                           055   sos_size_t pgflt_cow;
056   sos_size_t pgflt_page_in;                       056   sos_size_t pgflt_page_in;
057   sos_size_t pgflt_invalid;                       057   sos_size_t pgflt_invalid;
058 };                                                058 };
059                                                   059 
060                                                   060 
061 struct sos_umem_vmm_vr                            061 struct sos_umem_vmm_vr
062 {                                                 062 {
063   /** The address space owning this VR */         063   /** The address space owning this VR */
064   struct sos_umem_vmm_as *address_space;          064   struct sos_umem_vmm_as *address_space;
065                                                   065 
066   /** The location of the mapping in user spac    066   /** The location of the mapping in user space */
067   sos_uaddr_t start;                              067   sos_uaddr_t start;
068   sos_size_t  size;                               068   sos_size_t  size;
069                                                   069 
070   /** What accesses are allowed (read, write,     070   /** What accesses are allowed (read, write, exec): @see
071       SOS_VM_MAP_PROT_* flags in hwcore/paging    071       SOS_VM_MAP_PROT_* flags in hwcore/paging.h */
072   sos_ui32_t  access_rights;                      072   sos_ui32_t  access_rights;
073                                                   073 
074   /** Flags of the VR. Allowed flags:             074   /** Flags of the VR. Allowed flags:
075    *  - SOS_VR_MAP_SHARED                         075    *  - SOS_VR_MAP_SHARED
076    */                                             076    */
077   sos_ui32_t  flags;                              077   sos_ui32_t  flags;
078                                                   078 
079   /**                                             079   /**
080    * The callbacks for the VR called along map    080    * The callbacks for the VR called along map/unmapping of the
081    * resource                                     081    * resource
082    */                                             082    */
083   struct sos_umem_vmm_vr_ops *ops;                083   struct sos_umem_vmm_vr_ops *ops;
084                                                   084 
085   /** Description of the resource being mapped    085   /** Description of the resource being mapped, if any */
086   struct sos_umem_vmm_mapped_resource *mapped_    086   struct sos_umem_vmm_mapped_resource *mapped_resource;
087   sos_luoffset_t offset_in_resource;              087   sos_luoffset_t offset_in_resource;
088                                                   088 
089   /** The VRs of an AS are linked together and    089   /** The VRs of an AS are linked together and are accessible by way
090       of as->list_vr */                           090       of as->list_vr */
091   struct sos_umem_vmm_vr *prev_in_as, *next_in    091   struct sos_umem_vmm_vr *prev_in_as, *next_in_as;
092                                                   092 
093   /** The VRs mapping a given resource are lin    093   /** The VRs mapping a given resource are linked together and are
094       accessible by way of mapped_resource->li    094       accessible by way of mapped_resource->list_vr */
095   struct sos_umem_vmm_vr *prev_in_mapped_resou    095   struct sos_umem_vmm_vr *prev_in_mapped_resource, *next_in_mapped_resource;
096 };                                                096 };
097                                                   097 
098                                                   098 
099 /*                                                099 /*
100  * We use special slab caches to allocate AS a    100  * We use special slab caches to allocate AS and VR data structures
101  */                                               101  */
102 static struct sos_kslab_cache * cache_of_as;      102 static struct sos_kslab_cache * cache_of_as;
103 static struct sos_kslab_cache * cache_of_vr;      103 static struct sos_kslab_cache * cache_of_vr;
104                                                   104 
105                                                   105 
106 /** Temporary function to debug: list the VRs     106 /** Temporary function to debug: list the VRs of the given As */
107 void sos_dump_as(const struct sos_umem_vmm_as     107 void sos_dump_as(const struct sos_umem_vmm_as * as, const char *str)
108 {                                                 108 {
109   struct sos_umem_vmm_vr *vr;                     109   struct sos_umem_vmm_vr *vr;
110   int nb_vr;                                      110   int nb_vr;
111                                                   111 
112   sos_bochs_printf("AS %p - %s:\n", as, str);     112   sos_bochs_printf("AS %p - %s:\n", as, str);
113   sos_bochs_printf("   physical mem: %x\n",       113   sos_bochs_printf("   physical mem: %x\n",
114                    as->phys_total);               114                    as->phys_total);
115   sos_bochs_printf("   VM (all/ro+rw/exec) tot    115   sos_bochs_printf("   VM (all/ro+rw/exec) tot:%x/%x+%x/%x shrd:%x/%x+%x/%x\n",
116                    as->vm_total.overall,          116                    as->vm_total.overall,
117                    as->vm_total.ro, as->vm_tot    117                    as->vm_total.ro, as->vm_total.rw, as->vm_total.code,
118                    as->vm_shrd.overall,           118                    as->vm_shrd.overall,
119                    as->vm_shrd.ro, as->vm_shrd    119                    as->vm_shrd.ro, as->vm_shrd.rw, as->vm_shrd.code);
120   sos_bochs_printf("   pgflt cow=%d pgin=%d in    120   sos_bochs_printf("   pgflt cow=%d pgin=%d inv=%d\n",
121                    as->pgflt_cow, as->pgflt_pa    121                    as->pgflt_cow, as->pgflt_page_in, as->pgflt_invalid);
122   list_foreach_named(as->list_vr, vr, nb_vr, p    122   list_foreach_named(as->list_vr, vr, nb_vr, prev_in_as, next_in_as)
123     {                                             123     {
124       sos_bochs_printf("  VR[%d]=%x: [%x,%x[ (    124       sos_bochs_printf("  VR[%d]=%x: [%x,%x[ (sz=%x) mr=(%x)+%llx %c%c%c fl=%x\n",
125                        nb_vr, (unsigned)vr,       125                        nb_vr, (unsigned)vr,
126                        vr->start, vr->start +     126                        vr->start, vr->start + vr->size, vr->size,
127                        (unsigned)vr->mapped_re    127                        (unsigned)vr->mapped_resource,
128                        vr->offset_in_resource,    128                        vr->offset_in_resource,
129                        (vr->access_rights & SO    129                        (vr->access_rights & SOS_VM_MAP_PROT_READ)?'r':'-',
130                        (vr->access_rights & SO    130                        (vr->access_rights & SOS_VM_MAP_PROT_WRITE)?'w':'-',
131                        (vr->access_rights & SO    131                        (vr->access_rights & SOS_VM_MAP_PROT_EXEC)?'x':'-',
132                        (unsigned)vr->flags);      132                        (unsigned)vr->flags);
133     }                                             133     }
134   sos_bochs_printf("FIN (%s)\n", str);            134   sos_bochs_printf("FIN (%s)\n", str);
135 }                                                 135 }
136                                                   136 
137                                                   137 
138 /**                                               138 /**
139  * Physical address of THE page (full of 0s) u    139  * Physical address of THE page (full of 0s) used for anonymous
140  * mappings                                       140  * mappings
141  */                                               141  */
142 sos_paddr_t sos_zero_page = 0 /* Initial value !! 142 sos_paddr_t sos_zero_physpage = 0 /* Initial value prior to allocation */;
                                                   >> 143 sos_vaddr_t sos_zero_kernelpage = 0 /* Initial value prior to allocation */;
143                                                   144 
144                                                   145 
145 /*                                                146 /*
146  * Helper functions defined at the bottom of t    147  * Helper functions defined at the bottom of the file
147  */                                               148  */
148                                                   149 
149 /**                                               150 /**
150  * Helper function to retrieve the first VR to    151  * Helper function to retrieve the first VR to have a vr->end >= uaddr
151  */                                               152  */
152 static struct sos_umem_vmm_vr *                   153 static struct sos_umem_vmm_vr *
153 find_enclosing_or_next_vr(struct sos_umem_vmm_    154 find_enclosing_or_next_vr(struct sos_umem_vmm_as * as,
154                           sos_uaddr_t uaddr);     155                           sos_uaddr_t uaddr);
155                                                   156 
156                                                   157 
157 /**                                               158 /**
158  * Helper function to retrieve the first VR th    159  * Helper function to retrieve the first VR that overlaps the given
159  * interval, if any                               160  * interval, if any
160  */                                               161  */
161 static struct sos_umem_vmm_vr *                   162 static struct sos_umem_vmm_vr *
162 find_first_intersecting_vr(struct sos_umem_vmm    163 find_first_intersecting_vr(struct sos_umem_vmm_as * as,
163                            sos_uaddr_t start_u    164                            sos_uaddr_t start_uaddr, sos_size_t size);
164                                                   165 
165                                                   166 
166 /**                                               167 /**
167  * Helper function to find first address where    168  * Helper function to find first address where there is enough
168  * space. Begin to look for such an interval a    169  * space. Begin to look for such an interval at or after the given
169  * address                                        170  * address
170  *                                                171  *
171  * @param hint_addr The address where to begin    172  * @param hint_addr The address where to begin the scan, or NULL
172  */                                               173  */
173 static sos_uaddr_t                                174 static sos_uaddr_t
174 find_first_free_interval(struct sos_umem_vmm_a    175 find_first_free_interval(struct sos_umem_vmm_as * as,
175                          sos_uaddr_t hint_uadd    176                          sos_uaddr_t hint_uaddr, sos_size_t size);
176                                                   177 
177                                                   178 
178 /** Called each time a VR of the AS changes. D    179 /** Called each time a VR of the AS changes. Don't cope with any
179     underlying physcal mapping/unmapping, COW,    180     underlying physcal mapping/unmapping, COW, etc... */
180 static void                                       181 static void
181 as_account_change_of_vr_protection(struct sos_    182 as_account_change_of_vr_protection(struct sos_umem_vmm_as * as,
182                                    sos_bool_t     183                                    sos_bool_t is_shared,
183                                    sos_size_t     184                                    sos_size_t size,
184                                    sos_ui32_t     185                                    sos_ui32_t prev_access_rights,
185                                    sos_ui32_t     186                                    sos_ui32_t new_access_rights);
186                                                   187 
187                                                   188 
188 sos_ret_t sos_umem_vmm_subsystem_setup()          189 sos_ret_t sos_umem_vmm_subsystem_setup()
189 {                                                 190 {
190   sos_vaddr_t vaddr_zero_page;                 << 
191                                                << 
192   /* Allocate a new kernel physical page mappe    191   /* Allocate a new kernel physical page mapped into kernel space and
193      reset it with 0s */                          192      reset it with 0s */
194   vaddr_zero_page = sos_kmem_vmm_alloc(1, SOS_ !! 193   sos_zero_kernelpage = sos_kmem_vmm_alloc(1, SOS_KMEM_VMM_MAP);
195   if (vaddr_zero_page == (sos_vaddr_t)NULL)    !! 194   if (sos_zero_kernelpage == (sos_vaddr_t)NULL)
196     return -SOS_ENOMEM;                           195     return -SOS_ENOMEM;
197   memset((void*)vaddr_zero_page, 0x0, SOS_PAGE !! 196   memset((void*)sos_zero_kernelpage, 0x0, SOS_PAGE_SIZE);
198                                                   197   
199   /* Keep a reference to the underlying pphysi    198   /* Keep a reference to the underlying pphysical page... */
200   sos_zero_page = sos_paging_get_paddr(vaddr_z !! 199   sos_zero_physpage = sos_paging_get_paddr(sos_zero_kernelpage);
201   SOS_ASSERT_FATAL(NULL != (void*)sos_zero_pag !! 200   SOS_ASSERT_FATAL(NULL != (void*)sos_zero_physpage);
202   sos_physmem_ref_physpage_at(sos_zero_page);  !! 201   sos_physmem_ref_physpage_at(sos_zero_physpage);
203                                                << 
204   /* ... but it is not needed in kernel space  << 
205      safely unmap it from kernel space */      << 
206   sos_paging_unmap(vaddr_zero_page);           << 
207                                                   202 
208   /* Allocate the VR/AS caches */                 203   /* Allocate the VR/AS caches */
209   cache_of_as                                     204   cache_of_as
210     = sos_kmem_cache_create("Address space str    205     = sos_kmem_cache_create("Address space structures",
211                             sizeof(struct sos_    206                             sizeof(struct sos_umem_vmm_as),
212                             1, 0,                 207                             1, 0,
213                             SOS_KSLAB_CREATE_M    208                             SOS_KSLAB_CREATE_MAP
214                             | SOS_KSLAB_CREATE    209                             | SOS_KSLAB_CREATE_ZERO);
215   if (! cache_of_as)                              210   if (! cache_of_as)
216     {                                             211     {
217       sos_physmem_unref_physpage(sos_zero_page !! 212       sos_physmem_unref_physpage(sos_zero_physpage);
218       return -SOS_ENOMEM;                         213       return -SOS_ENOMEM;
219     }                                             214     }
220                                                   215 
221   cache_of_vr                                     216   cache_of_vr
222     = sos_kmem_cache_create("Virtual Region st    217     = sos_kmem_cache_create("Virtual Region structures",
223                             sizeof(struct sos_    218                             sizeof(struct sos_umem_vmm_vr),
224                             1, 0,                 219                             1, 0,
225                             SOS_KSLAB_CREATE_M    220                             SOS_KSLAB_CREATE_MAP
226                             | SOS_KSLAB_CREATE    221                             | SOS_KSLAB_CREATE_ZERO);
227   if (! cache_of_vr)                              222   if (! cache_of_vr)
228     {                                             223     {
229       sos_physmem_unref_physpage(sos_zero_page !! 224       sos_physmem_unref_physpage(sos_zero_physpage);
230       sos_kmem_cache_destroy(cache_of_as);        225       sos_kmem_cache_destroy(cache_of_as);
231       return -SOS_ENOMEM;                         226       return -SOS_ENOMEM;
232     }                                             227     }
233                                                   228 
234   return SOS_OK;                                  229   return SOS_OK;
235 }                                                 230 }
236                                                   231 
237                                                   232 
238 struct sos_umem_vmm_as *                          233 struct sos_umem_vmm_as *
239 sos_umem_vmm_create_empty_as(struct sos_proces    234 sos_umem_vmm_create_empty_as(struct sos_process *owner)
240 {                                                 235 {
241   struct sos_umem_vmm_as * as                     236   struct sos_umem_vmm_as * as
242     = (struct sos_umem_vmm_as *) sos_kmem_cach    237     = (struct sos_umem_vmm_as *) sos_kmem_cache_alloc(cache_of_as, 0);
243   if (! as)                                       238   if (! as)
244     return NULL;                                  239     return NULL;
245                                                   240 
246   as->mm_context = sos_mm_context_create();       241   as->mm_context = sos_mm_context_create();
247   if (NULL == as->mm_context)                     242   if (NULL == as->mm_context)
248     {                                             243     {
249       /* Error */                                 244       /* Error */
250       sos_kmem_cache_free((sos_vaddr_t)as);       245       sos_kmem_cache_free((sos_vaddr_t)as);
251       return NULL;                                246       return NULL;
252     }                                             247     }
253                                                   248 
254   as->process = owner;                            249   as->process = owner;
255   return as;                                      250   return as;
256 }                                                 251 }
257                                                   252 
258                                                   253 
259 struct sos_umem_vmm_as *                          254 struct sos_umem_vmm_as *
260 sos_umem_vmm_duplicate_current_thread_as(struc    255 sos_umem_vmm_duplicate_current_thread_as(struct sos_process *owner)
261 {                                                 256 {
262   __label__ undo_creation;                        257   __label__ undo_creation;
263   struct sos_umem_vmm_as * my_as;                 258   struct sos_umem_vmm_as * my_as;
264   struct sos_umem_vmm_vr * model_vr;              259   struct sos_umem_vmm_vr * model_vr;
265   int nb_vr;                                      260   int nb_vr;
266                                                   261 
267   struct sos_umem_vmm_as * new_as                 262   struct sos_umem_vmm_as * new_as
268     = (struct sos_umem_vmm_as *) sos_kmem_cach    263     = (struct sos_umem_vmm_as *) sos_kmem_cache_alloc(cache_of_as, 0);
269   if (! new_as)                                   264   if (! new_as)
270     return NULL;                                  265     return NULL;
271                                                   266 
272   my_as = sos_process_get_address_space(sos_th    267   my_as = sos_process_get_address_space(sos_thread_get_current()->process);
273   new_as->process = owner;                        268   new_as->process = owner;
274   list_init_named(new_as->list_vr, prev_in_as,    269   list_init_named(new_as->list_vr, prev_in_as, next_in_as);
275                                                   270 
276   /*                                              271   /*
277    * Switch to the current threads' mm_context    272    * Switch to the current threads' mm_context, as duplicating it implies
278    * being able to configure some of its mappi    273    * being able to configure some of its mappings as read-only (for
279    * COW)                                         274    * COW)
280    */                                             275    */
281   SOS_ASSERT_FATAL(SOS_OK                         276   SOS_ASSERT_FATAL(SOS_OK
282                    == sos_thread_prepare_user_    277                    == sos_thread_prepare_user_space_access(my_as,
283                                                   278                                                            (sos_vaddr_t)
284                                                   279                                                              NULL));
285                                                   280 
286   /* Copy the virtual regions */                  281   /* Copy the virtual regions */
287   list_foreach_named(my_as->list_vr, model_vr,    282   list_foreach_named(my_as->list_vr, model_vr, nb_vr, prev_in_as, next_in_as)
288     {                                             283     {
289       struct sos_umem_vmm_vr * vr;                284       struct sos_umem_vmm_vr * vr;
290                                                   285 
291       /* Prepare COW on the read/write private    286       /* Prepare COW on the read/write private mappings */
292       if ( !(model_vr->flags & SOS_VR_MAP_SHAR    287       if ( !(model_vr->flags & SOS_VR_MAP_SHARED)
293            && (model_vr->access_rights & SOS_V    288            && (model_vr->access_rights & SOS_VM_MAP_PROT_WRITE) )
294         {                                         289         {
295           /* Mark the underlying physical page    290           /* Mark the underlying physical pages (if any) as
296              read-only */                         291              read-only */
297           SOS_ASSERT_FATAL(SOS_OK                 292           SOS_ASSERT_FATAL(SOS_OK
298                            == sos_paging_prepa    293                            == sos_paging_prepare_COW(model_vr->start,
299                                                   294                                                      model_vr->size));
300         }                                         295         }
301                                                   296 
302       /* Allocate a new virtual region and cop    297       /* Allocate a new virtual region and copy the 'model' into it */
303       vr = (struct sos_umem_vmm_vr *) sos_kmem    298       vr = (struct sos_umem_vmm_vr *) sos_kmem_cache_alloc(cache_of_vr, 0);
304       if (! vr)                                   299       if (! vr)
305         goto undo_creation;                       300         goto undo_creation;
306       memcpy(vr, model_vr, sizeof(*vr));          301       memcpy(vr, model_vr, sizeof(*vr));
307       vr->address_space = new_as;                 302       vr->address_space = new_as;
308                                                   303 
309       /* Signal the "new" mapping to the under    304       /* Signal the "new" mapping to the underlying VR mapper */
310       if (vr->ops && vr->ops->ref)                305       if (vr->ops && vr->ops->ref)
311         vr->ops->ref(vr);                         306         vr->ops->ref(vr);
312                                                   307 
313       /* Insert the new VR into the new AS */     308       /* Insert the new VR into the new AS */
314       list_add_tail_named(new_as->list_vr, vr,    309       list_add_tail_named(new_as->list_vr, vr, prev_in_as, next_in_as);
315                                                   310 
316       /* Insert the new VR into the list of ma    311       /* Insert the new VR into the list of mappings of the resource */
317       list_add_tail_named(model_vr->mapped_res    312       list_add_tail_named(model_vr->mapped_resource->list_vr, vr,
318                           prev_in_mapped_resou    313                           prev_in_mapped_resource,
319                           next_in_mapped_resou    314                           next_in_mapped_resource);
320     }                                             315     }
321                                                   316 
322   /* Now copy the current MMU configuration */    317   /* Now copy the current MMU configuration */
323   new_as->mm_context = sos_mm_context_duplicat    318   new_as->mm_context = sos_mm_context_duplicate(my_as->mm_context);
324   if (NULL == new_as->mm_context)                 319   if (NULL == new_as->mm_context)
325     goto undo_creation;                           320     goto undo_creation;
326                                                   321 
327   /* Correct behavior */                          322   /* Correct behavior */
328   new_as->heap_start = my_as->heap_start;         323   new_as->heap_start = my_as->heap_start;
329   new_as->heap_size  = my_as->heap_size;          324   new_as->heap_size  = my_as->heap_size;
330   new_as->phys_total = my_as->phys_total;         325   new_as->phys_total = my_as->phys_total;
331   memcpy(& new_as->vm_total, & my_as->vm_total    326   memcpy(& new_as->vm_total, & my_as->vm_total, sizeof(struct vm_usage));
332   memcpy(& new_as->vm_shrd, & my_as->vm_shrd,     327   memcpy(& new_as->vm_shrd, & my_as->vm_shrd, sizeof(struct vm_usage));
333   SOS_ASSERT_FATAL(SOS_OK == sos_thread_end_us    328   SOS_ASSERT_FATAL(SOS_OK == sos_thread_end_user_space_access());
334   return new_as;                                  329   return new_as;
335                                                   330 
336   /* Handle erroneous behavior */                 331   /* Handle erroneous behavior */
337  undo_creation:                                   332  undo_creation:
338   SOS_ASSERT_FATAL(SOS_OK == sos_thread_end_us    333   SOS_ASSERT_FATAL(SOS_OK == sos_thread_end_user_space_access());
339   sos_umem_vmm_delete_as(new_as);                 334   sos_umem_vmm_delete_as(new_as);
340   return NULL;                                    335   return NULL;
341 }                                                 336 }
342                                                   337 
343                                                   338 
344 sos_ret_t                                         339 sos_ret_t
345 sos_umem_vmm_delete_as(struct sos_umem_vmm_as     340 sos_umem_vmm_delete_as(struct sos_umem_vmm_as * as)
346 {                                                 341 {
347   while(! list_is_empty_named(as->list_vr, pre    342   while(! list_is_empty_named(as->list_vr, prev_in_as, next_in_as))
348     {                                             343     {
349       struct sos_umem_vmm_vr * vr;                344       struct sos_umem_vmm_vr * vr;
350       vr = list_get_head_named(as->list_vr, pr    345       vr = list_get_head_named(as->list_vr, prev_in_as, next_in_as);
351                                                   346 
352       /* Remove the vr from the lists */          347       /* Remove the vr from the lists */
353       list_pop_head_named(as->list_vr, prev_in    348       list_pop_head_named(as->list_vr, prev_in_as, next_in_as);
354       list_delete_named(vr->mapped_resource->l    349       list_delete_named(vr->mapped_resource->list_vr, vr,
355                         prev_in_mapped_resourc    350                         prev_in_mapped_resource,
356                         next_in_mapped_resourc    351                         next_in_mapped_resource);
357                                                   352 
358       /* Signal to the underlying VR mapper th    353       /* Signal to the underlying VR mapper that the mapping is
359          suppressed */                            354          suppressed */
360       if (vr->ops)                                355       if (vr->ops)
361         {                                         356         {
362           if (vr->ops->unmap)                     357           if (vr->ops->unmap)
363             vr->ops->unmap(vr, vr->start, vr->    358             vr->ops->unmap(vr, vr->start, vr->size);
364           if (vr->ops->unref)                     359           if (vr->ops->unref)
365             vr->ops->unref(vr);                   360             vr->ops->unref(vr);
366         }                                         361         }
367                                                   362 
368       sos_kmem_cache_free((sos_vaddr_t)vr);       363       sos_kmem_cache_free((sos_vaddr_t)vr);
369     }                                             364     }
370                                                   365   
371   /* Release MMU configuration */                 366   /* Release MMU configuration */
372   if (as->mm_context)                             367   if (as->mm_context)
373     sos_mm_context_unref(as->mm_context);         368     sos_mm_context_unref(as->mm_context);
374                                                   369 
375   /* Now unallocate main address space constru    370   /* Now unallocate main address space construct */
376   sos_kmem_cache_free((sos_vaddr_t)as);           371   sos_kmem_cache_free((sos_vaddr_t)as);
377                                                   372 
378   return SOS_OK;                                  373   return SOS_OK;
379 }                                                 374 }
380                                                   375 
381                                                   376 
382 struct sos_process *                              377 struct sos_process *
383 sos_umem_vmm_get_process(struct sos_umem_vmm_a    378 sos_umem_vmm_get_process(struct sos_umem_vmm_as * as)
384 {                                                 379 {
385   return as->process;                             380   return as->process;
386 }                                                 381 }
387                                                   382 
388                                                   383 
389 struct sos_mm_context *                           384 struct sos_mm_context *
390 sos_umem_vmm_get_mm_context(struct sos_umem_vm    385 sos_umem_vmm_get_mm_context(struct sos_umem_vmm_as * as)
391 {                                                 386 {
392   return as->mm_context;                          387   return as->mm_context;
393 }                                                 388 }
394                                                   389 
395                                                   390 
396 struct sos_umem_vmm_vr *                          391 struct sos_umem_vmm_vr *
397 sos_umem_vmm_get_vr_at_address(struct sos_umem    392 sos_umem_vmm_get_vr_at_address(struct sos_umem_vmm_as * as,
398                                sos_uaddr_t uad    393                                sos_uaddr_t uaddr)
399 {                                                 394 {
400   struct sos_umem_vmm_vr * vr;                    395   struct sos_umem_vmm_vr * vr;
401   vr = find_enclosing_or_next_vr(as, uaddr);      396   vr = find_enclosing_or_next_vr(as, uaddr);
402   if (! vr)                                       397   if (! vr)
403     return NULL;                                  398     return NULL;
404                                                   399 
405   /* Ok uaddr <= vr->end, but do we have uaddr    400   /* Ok uaddr <= vr->end, but do we have uaddr > vr->start ? */
406   if (uaddr < vr->start)                          401   if (uaddr < vr->start)
407     return NULL;                                  402     return NULL;
408                                                   403 
409   return vr;                                      404   return vr;
410 }                                                 405 }
411                                                   406 
412                                                   407 
413 struct sos_umem_vmm_as *                          408 struct sos_umem_vmm_as *
414 sos_umem_vmm_get_as_of_vr(struct sos_umem_vmm_    409 sos_umem_vmm_get_as_of_vr(struct sos_umem_vmm_vr * vr)
415 {                                                 410 {
416   return vr->address_space;                       411   return vr->address_space;
417 }                                                 412 }
418                                                   413 
419                                                   414 
420 struct sos_umem_vmm_vr_ops *                      415 struct sos_umem_vmm_vr_ops *
421 sos_umem_vmm_get_ops_of_vr(struct sos_umem_vmm    416 sos_umem_vmm_get_ops_of_vr(struct sos_umem_vmm_vr * vr)
422 {                                                 417 {
423   return vr->ops;                                 418   return vr->ops;
424 }                                                 419 }
425                                                   420 
426                                                   421 
427 sos_ui32_t sos_umem_vmm_get_prot_of_vr(struct     422 sos_ui32_t sos_umem_vmm_get_prot_of_vr(struct sos_umem_vmm_vr * vr)
428 {                                                 423 {
429   return vr->access_rights;                       424   return vr->access_rights;
430 }                                                 425 }
431                                                   426 
432                                                   427 
433 sos_ui32_t sos_umem_vmm_get_flags_of_vr(struct    428 sos_ui32_t sos_umem_vmm_get_flags_of_vr(struct sos_umem_vmm_vr * vr)
434 {                                                 429 {
435   return vr->flags;                               430   return vr->flags;
436 }                                                 431 }
437                                                   432 
438                                                   433 
439 struct sos_umem_vmm_mapped_resource *             434 struct sos_umem_vmm_mapped_resource *
440 sos_umem_vmm_get_mapped_resource_of_vr(struct     435 sos_umem_vmm_get_mapped_resource_of_vr(struct sos_umem_vmm_vr * vr)
441 {                                                 436 {
442   return vr->mapped_resource;                     437   return vr->mapped_resource;
443 }                                                 438 }
444                                                   439 
445                                                   440 
446 sos_uaddr_t sos_umem_vmm_get_start_of_vr(struc    441 sos_uaddr_t sos_umem_vmm_get_start_of_vr(struct sos_umem_vmm_vr * vr)
447 {                                                 442 {
448   return vr->start;                               443   return vr->start;
449 }                                                 444 }
450                                                   445 
451                                                   446 
452 sos_size_t sos_umem_vmm_get_size_of_vr(struct     447 sos_size_t sos_umem_vmm_get_size_of_vr(struct sos_umem_vmm_vr * vr)
453 {                                                 448 {
454   return vr->size;                                449   return vr->size;
455 }                                                 450 }
456                                                   451 
457                                                   452 
458 sos_luoffset_t sos_umem_vmm_get_offset_in_reso    453 sos_luoffset_t sos_umem_vmm_get_offset_in_resource(struct sos_umem_vmm_vr * vr)
459 {                                                 454 {
460   return vr->offset_in_resource;                  455   return vr->offset_in_resource;
461 }                                                 456 }
462                                                   457 
463                                                   458 
464 sos_ret_t                                         459 sos_ret_t
465 sos_umem_vmm_set_ops_of_vr(struct sos_umem_vmm    460 sos_umem_vmm_set_ops_of_vr(struct sos_umem_vmm_vr * vr,
466                            struct sos_umem_vmm    461                            struct sos_umem_vmm_vr_ops * ops)
467 {                                                 462 {
468   /* Don't allow to overwrite any preceding VR    463   /* Don't allow to overwrite any preceding VR ops */
469   SOS_ASSERT_FATAL(NULL == vr->ops);              464   SOS_ASSERT_FATAL(NULL == vr->ops);
470                                                   465 
471   vr->ops = ops;                                  466   vr->ops = ops;
472   return SOS_OK;                                  467   return SOS_OK;
473 }                                                 468 }
474                                                   469 
475                                                   470 
476 /**                                               471 /**
477  * When resize asks to map the resource elsewh    472  * When resize asks to map the resource elsewhere, make sure not to
478  * overwrite the offset_in_resource field         473  * overwrite the offset_in_resource field
479  */                                               474  */
480 #define INTERNAL_MAP_CALLED_FROM_MREMAP (1 <<     475 #define INTERNAL_MAP_CALLED_FROM_MREMAP (1 << 8)
481                                                   476 
482 sos_ret_t                                         477 sos_ret_t
483 sos_umem_vmm_map(struct sos_umem_vmm_as * as,     478 sos_umem_vmm_map(struct sos_umem_vmm_as * as,
484                  sos_uaddr_t * /*in/out*/uaddr    479                  sos_uaddr_t * /*in/out*/uaddr, sos_size_t size,
485                  sos_ui32_t access_rights,        480                  sos_ui32_t access_rights,
486                  sos_ui32_t flags,                481                  sos_ui32_t flags,
487                  struct sos_umem_vmm_mapped_re    482                  struct sos_umem_vmm_mapped_resource * resource,
488                  sos_luoffset_t offset_in_reso    483                  sos_luoffset_t offset_in_resource)
489 {                                                 484 {
490   __label__ return_mmap;                          485   __label__ return_mmap;
491   sos_uaddr_t hint_uaddr;                         486   sos_uaddr_t hint_uaddr;
492   struct sos_umem_vmm_vr *prev_vr, *next_vr, *    487   struct sos_umem_vmm_vr *prev_vr, *next_vr, *vr, *preallocated_vr;
493   sos_bool_t merge_with_preceding, merge_with_    488   sos_bool_t merge_with_preceding, merge_with_next, used_preallocated_vr;
494   sos_bool_t internal_map_called_from_mremap      489   sos_bool_t internal_map_called_from_mremap
495     = (flags & INTERNAL_MAP_CALLED_FROM_MREMAP    490     = (flags & INTERNAL_MAP_CALLED_FROM_MREMAP);
496                                                   491 
497   sos_ret_t retval     = SOS_OK;                  492   sos_ret_t retval     = SOS_OK;
498   used_preallocated_vr = FALSE;                   493   used_preallocated_vr = FALSE;
499   hint_uaddr           = *uaddr;                  494   hint_uaddr           = *uaddr;
500                                                   495 
501   /* Default mapping address is NULL */           496   /* Default mapping address is NULL */
502   *uaddr = (sos_vaddr_t)NULL;                     497   *uaddr = (sos_vaddr_t)NULL;
503                                                   498 
504   if (! resource)                                 499   if (! resource)
505     return -SOS_EINVAL;                           500     return -SOS_EINVAL;
506   if (! resource->mmap)                           501   if (! resource->mmap)
507     return -SOS_EPERM;                            502     return -SOS_EPERM;
508                                                   503 
509   if (! SOS_IS_PAGE_ALIGNED(hint_uaddr))          504   if (! SOS_IS_PAGE_ALIGNED(hint_uaddr))
510     return -SOS_EINVAL;                           505     return -SOS_EINVAL;
511                                                   506 
512   if (size <= 0)                                  507   if (size <= 0)
513     return -SOS_EINVAL;                           508     return -SOS_EINVAL;
514   size = SOS_PAGE_ALIGN_SUP(size);                509   size = SOS_PAGE_ALIGN_SUP(size);
515                                                   510 
516   if (flags & SOS_VR_MAP_SHARED)                  511   if (flags & SOS_VR_MAP_SHARED)
517     {                                             512     {
518       /* Make sure the mapped resource allows     513       /* Make sure the mapped resource allows the required protection flags */
519       if ( ( (access_rights & SOS_VM_MAP_PROT_    514       if ( ( (access_rights & SOS_VM_MAP_PROT_READ)
520              && !(resource->allowed_access_rig    515              && !(resource->allowed_access_rights & SOS_VM_MAP_PROT_READ) )
521            || ( (access_rights & SOS_VM_MAP_PR    516            || ( (access_rights & SOS_VM_MAP_PROT_WRITE)
522                 && !(resource->allowed_access_    517                 && !(resource->allowed_access_rights & SOS_VM_MAP_PROT_WRITE) )
523            || ( (access_rights & SOS_VM_MAP_PR    518            || ( (access_rights & SOS_VM_MAP_PROT_EXEC)
524                 && !(resource->allowed_access_    519                 && !(resource->allowed_access_rights & SOS_VM_MAP_PROT_EXEC)) )
525         return -SOS_EPERM;                        520         return -SOS_EPERM;
526     }                                             521     }
527                                                   522 
528   /* Sanity checks over the offset_in_resource    523   /* Sanity checks over the offset_in_resource parameter */
529   if ( !internal_map_called_from_mremap           524   if ( !internal_map_called_from_mremap
530        && ( resource->flags & SOS_MAPPED_RESOU    525        && ( resource->flags & SOS_MAPPED_RESOURCE_ANONYMOUS ) )
531     /* Initial offset ignored for anonymous ma    526     /* Initial offset ignored for anonymous mappings */
532     {                                             527     {
533       /* Nothing to check */                      528       /* Nothing to check */
534     }                                             529     }
535                                                   530 
536   /* Make sure that the offset in resource won    531   /* Make sure that the offset in resource won't overflow */
537   else if (offset_in_resource + size <= offset    532   else if (offset_in_resource + size <= offset_in_resource)
538     return -SOS_EINVAL;                           533     return -SOS_EINVAL;
539                                                   534 
540   /* Filter out unsupported flags */              535   /* Filter out unsupported flags */
541   access_rights &= (SOS_VM_MAP_PROT_READ          536   access_rights &= (SOS_VM_MAP_PROT_READ
542                     | SOS_VM_MAP_PROT_WRITE       537                     | SOS_VM_MAP_PROT_WRITE
543                     | SOS_VM_MAP_PROT_EXEC);      538                     | SOS_VM_MAP_PROT_EXEC);
544   flags &= (SOS_VR_MAP_SHARED                     539   flags &= (SOS_VR_MAP_SHARED
545             | SOS_VR_MAP_FIXED);                  540             | SOS_VR_MAP_FIXED);
546                                                   541 
547   /* Pre-allocate a new VR. Because once we fo    542   /* Pre-allocate a new VR. Because once we found a valid slot inside
548      the VR list, we don't want the list to be    543      the VR list, we don't want the list to be altered by another
549      process */                                   544      process */
550   preallocated_vr                                 545   preallocated_vr
551     = (struct sos_umem_vmm_vr *)sos_kmem_cache    546     = (struct sos_umem_vmm_vr *)sos_kmem_cache_alloc(cache_of_vr, 0);
552   if (! preallocated_vr)                          547   if (! preallocated_vr)
553     return -SOS_ENOMEM;                           548     return -SOS_ENOMEM;
554                                                   549 
555   /* Compute the user address of the new mappi    550   /* Compute the user address of the new mapping */
556   if (flags & SOS_VR_MAP_FIXED)                   551   if (flags & SOS_VR_MAP_FIXED)
557     {                                             552     {
558       /*                                          553       /*
559        * The address is imposed                   554        * The address is imposed
560        */                                         555        */
561                                                   556 
562       /* Make sure the hint_uaddr hint is vali    557       /* Make sure the hint_uaddr hint is valid */
563       if (hint_uaddr < SOS_PAGING_BASE_USER_AD    558       if (hint_uaddr < SOS_PAGING_BASE_USER_ADDRESS)
564         { retval = -SOS_EINVAL; goto return_mm    559         { retval = -SOS_EINVAL; goto return_mmap; }
565       if (hint_uaddr > SOS_PAGING_TOP_USER_ADD    560       if (hint_uaddr > SOS_PAGING_TOP_USER_ADDRESS - size)
566         { retval = -SOS_EINVAL; goto return_mm    561         { retval = -SOS_EINVAL; goto return_mmap; }
567                                                   562 
568       /* Unmap any overlapped VR */               563       /* Unmap any overlapped VR */
569       retval = sos_umem_vmm_unmap(as, hint_uad    564       retval = sos_umem_vmm_unmap(as, hint_uaddr, size);
570       if (SOS_OK != retval)                       565       if (SOS_OK != retval)
571         { goto return_mmap; }                     566         { goto return_mmap; }
572     }                                             567     }
573   else                                            568   else
574     {                                             569     {
575       /*                                          570       /*
576        * A free range has to be determined        571        * A free range has to be determined
577        */                                         572        */
578                                                   573 
579       /* Find a suitable free VR */               574       /* Find a suitable free VR */
580       hint_uaddr = find_first_free_interval(as    575       hint_uaddr = find_first_free_interval(as, hint_uaddr, size);
581       if (! hint_uaddr)                           576       if (! hint_uaddr)
582         { retval = -SOS_ENOMEM; goto return_mm    577         { retval = -SOS_ENOMEM; goto return_mmap; }
583     }                                             578     }
584                                                   579 
585   /* For anonymous resource mappings, set the     580   /* For anonymous resource mappings, set the initial
586      offset_in_resource to the initial virtual    581      offset_in_resource to the initial virtual start address in user
587      space */                                     582      space */
588   if ( !internal_map_called_from_mremap           583   if ( !internal_map_called_from_mremap
589        && (resource->flags & SOS_MAPPED_RESOUR    584        && (resource->flags & SOS_MAPPED_RESOURCE_ANONYMOUS ) )
590     offset_in_resource = hint_uaddr;              585     offset_in_resource = hint_uaddr;
591                                                   586 
592   /* Lookup next and previous VR, if any. This    587   /* Lookup next and previous VR, if any. This will allow us to merge
593      the regions, when possible */                588      the regions, when possible */
594   next_vr = find_enclosing_or_next_vr(as, hint    589   next_vr = find_enclosing_or_next_vr(as, hint_uaddr);
595   if (next_vr)                                    590   if (next_vr)
596     {                                             591     {
597       /* Find previous VR, if any */              592       /* Find previous VR, if any */
598       prev_vr = next_vr->prev_in_as;              593       prev_vr = next_vr->prev_in_as;
599       /* The list is curcular: it may happen t    594       /* The list is curcular: it may happen that we looped over the
600          tail of the list (ie the list is a si    595          tail of the list (ie the list is a singleton) */
601       if (prev_vr->start > hint_uaddr)            596       if (prev_vr->start > hint_uaddr)
602         prev_vr = NULL; /* No preceding VR */     597         prev_vr = NULL; /* No preceding VR */
603     }                                             598     }
604   else                                            599   else
605     {                                             600     {
606       /* Otherwise we went beyond the last VR     601       /* Otherwise we went beyond the last VR */
607       prev_vr = list_get_tail_named(as->list_v    602       prev_vr = list_get_tail_named(as->list_vr, prev_in_as, next_in_as);
608     }                                             603     }
609                                                   604 
610   /* Merge with preceding VR ? */                 605   /* Merge with preceding VR ? */
611   merge_with_preceding                            606   merge_with_preceding
612     = ( (NULL != prev_vr)                         607     = ( (NULL != prev_vr)
613         && (prev_vr->mapped_resource == resour    608         && (prev_vr->mapped_resource == resource)
614         && (prev_vr->offset_in_resource + prev    609         && (prev_vr->offset_in_resource + prev_vr->size == offset_in_resource)
615         && (prev_vr->start + prev_vr->size ==     610         && (prev_vr->start + prev_vr->size == hint_uaddr)
616         && (prev_vr->flags == flags)              611         && (prev_vr->flags == flags)
617         && (prev_vr->access_rights == access_r    612         && (prev_vr->access_rights == access_rights) );
618                                                   613 
619   /* Merge with next VR ? */                      614   /* Merge with next VR ? */
620   merge_with_next                                 615   merge_with_next
621     = ( (NULL != next_vr)                         616     = ( (NULL != next_vr)
622         && (next_vr->mapped_resource == resour    617         && (next_vr->mapped_resource == resource)
623         && (offset_in_resource + size == next_    618         && (offset_in_resource + size == next_vr->offset_in_resource)
624         && (hint_uaddr + size == next_vr->star    619         && (hint_uaddr + size == next_vr->start)
625         && (next_vr->flags == flags)              620         && (next_vr->flags == flags)
626         && (next_vr->access_rights == access_r    621         && (next_vr->access_rights == access_rights) );
627                                                   622 
628   if (merge_with_preceding && merge_with_next)    623   if (merge_with_preceding && merge_with_next)
629     {                                             624     {
630       /* Widen the prev_vr VR to encompass bot    625       /* Widen the prev_vr VR to encompass both the new VR and the next_vr */
631       vr = prev_vr;                               626       vr = prev_vr;
632       vr->size += size + next_vr->size;           627       vr->size += size + next_vr->size;
633                                                   628       
634       /* Remove the next_vr VR */                 629       /* Remove the next_vr VR */
635       list_delete_named(as->list_vr, next_vr,     630       list_delete_named(as->list_vr, next_vr, prev_in_as, next_in_as);
636       list_delete_named(next_vr->mapped_resour    631       list_delete_named(next_vr->mapped_resource->list_vr, next_vr,
637                         prev_in_mapped_resourc    632                         prev_in_mapped_resource, next_in_mapped_resource);
638                                                   633 
639       if (next_vr->ops && next_vr->ops->unref)    634       if (next_vr->ops && next_vr->ops->unref)
640         next_vr->ops->unref(next_vr);             635         next_vr->ops->unref(next_vr);
641                                                   636 
642       sos_kmem_vmm_free((sos_vaddr_t) next_vr)    637       sos_kmem_vmm_free((sos_vaddr_t) next_vr);
643     }                                             638     }
644   else if (merge_with_preceding)                  639   else if (merge_with_preceding)
645     {                                             640     {
646       /* Widen the prev_vr VR to encompass the    641       /* Widen the prev_vr VR to encompass the new VR */
647       vr = prev_vr;                               642       vr = prev_vr;
648       vr->size += size;                           643       vr->size += size;
649     }                                             644     }
650   else if (merge_with_next)                       645   else if (merge_with_next)
651     {                                             646     {
652       /* Widen the next_vr VR to encompass the    647       /* Widen the next_vr VR to encompass the new VR */
653       vr = next_vr;                               648       vr = next_vr;
654       vr->start -= size;                          649       vr->start -= size;
655       vr->size  += size;                          650       vr->size  += size;
656     }                                             651     }
657   else                                            652   else
658     {                                             653     {
659       /* Allocate a brand new VR and insert it    654       /* Allocate a brand new VR and insert it into the list */
660                                                   655 
661       vr = preallocated_vr;                       656       vr = preallocated_vr;
662       used_preallocated_vr = TRUE;                657       used_preallocated_vr = TRUE;
663                                                   658 
664       vr->start              = hint_uaddr;        659       vr->start              = hint_uaddr;
665       vr->size               = size;              660       vr->size               = size;
666       vr->access_rights      = access_rights;     661       vr->access_rights      = access_rights;
667       vr->flags              = flags;             662       vr->flags              = flags;
668       vr->mapped_resource    = resource;          663       vr->mapped_resource    = resource;
669       vr->offset_in_resource = offset_in_resou    664       vr->offset_in_resource = offset_in_resource;
670                                                   665 
671       /* Insert VR in address space */            666       /* Insert VR in address space */
672       vr->address_space      = as;                667       vr->address_space      = as;
673       if (prev_vr)                                668       if (prev_vr)
674         list_insert_after_named(as->list_vr, p    669         list_insert_after_named(as->list_vr, prev_vr, vr,
675                                 prev_in_as, ne    670                                 prev_in_as, next_in_as);
676       else                                        671       else
677         list_add_head_named(as->list_vr, vr, p    672         list_add_head_named(as->list_vr, vr, prev_in_as, next_in_as);
                                                   >> 673 
678       list_add_tail_named(vr->mapped_resource-    674       list_add_tail_named(vr->mapped_resource->list_vr, vr,
679                           prev_in_mapped_resou    675                           prev_in_mapped_resource,
680                           next_in_mapped_resou    676                           next_in_mapped_resource);
681                                                   677       
682       /* Signal the resource we are mapping it    678       /* Signal the resource we are mapping it */
683       if (resource && resource->mmap)             679       if (resource && resource->mmap)
684         {                                         680         {
685           retval = resource->mmap(vr);            681           retval = resource->mmap(vr);
686           if (SOS_OK != retval)                   682           if (SOS_OK != retval)
687             {                                     683             {
688               retval = sos_umem_vmm_unmap(as,     684               retval = sos_umem_vmm_unmap(as, vr->start, vr->size);
689               goto return_mmap;                   685               goto return_mmap;
690             }                                     686             }
691                                                   687 
692           /* The page_in method is MANDATORY f    688           /* The page_in method is MANDATORY for mapped resources */
693           SOS_ASSERT_FATAL(vr->ops && vr->ops-    689           SOS_ASSERT_FATAL(vr->ops && vr->ops->page_in);
694         }                                         690         }
695                                                   691 
696       if (vr->ops && vr->ops->ref)                692       if (vr->ops && vr->ops->ref)
697         vr->ops->ref(vr);                         693         vr->ops->ref(vr);
698     }                                             694     }
699                                                   695 
700   /* Ok, fine, we got it right ! Return the ad    696   /* Ok, fine, we got it right ! Return the address to the caller */
701   *uaddr = hint_uaddr;                            697   *uaddr = hint_uaddr;
702   as_account_change_of_vr_protection(as, vr->f    698   as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
703                                      size, 0,     699                                      size, 0, vr->access_rights);
704   retval = SOS_OK;                                700   retval = SOS_OK;
705                                                   701 
706  return_mmap:                                     702  return_mmap:
707   if (! used_preallocated_vr)                     703   if (! used_preallocated_vr)
708     sos_kmem_vmm_free((sos_vaddr_t)preallocate    704     sos_kmem_vmm_free((sos_vaddr_t)preallocated_vr);
709                                                   705     
710   return retval;                                  706   return retval;
711 }                                                 707 }
712                                                   708 
713                                                   709 
714 sos_ret_t                                         710 sos_ret_t
715 sos_umem_vmm_unmap(struct sos_umem_vmm_as * as    711 sos_umem_vmm_unmap(struct sos_umem_vmm_as * as,
716                    sos_uaddr_t uaddr, sos_size    712                    sos_uaddr_t uaddr, sos_size_t size)
717 {                                                 713 {
718   struct sos_umem_vmm_vr *vr, *preallocated_vr    714   struct sos_umem_vmm_vr *vr, *preallocated_vr;
719   sos_bool_t need_to_setup_mmu;                   715   sos_bool_t need_to_setup_mmu;
720   sos_bool_t used_preallocated_vr;                716   sos_bool_t used_preallocated_vr;
721                                                   717 
722   if (! SOS_IS_PAGE_ALIGNED(uaddr))               718   if (! SOS_IS_PAGE_ALIGNED(uaddr))
723     return -SOS_EINVAL;                           719     return -SOS_EINVAL;
724   if (size <= 0)                                  720   if (size <= 0)
725     return -SOS_EINVAL;                           721     return -SOS_EINVAL;
726   size = SOS_PAGE_ALIGN_SUP(size);                722   size = SOS_PAGE_ALIGN_SUP(size);
727                                                   723 
728   /* Make sure the uaddr is valid */              724   /* Make sure the uaddr is valid */
729   if (uaddr < SOS_PAGING_BASE_USER_ADDRESS)       725   if (uaddr < SOS_PAGING_BASE_USER_ADDRESS)
730     return -SOS_EINVAL;                           726     return -SOS_EINVAL;
731   if (uaddr > SOS_PAGING_TOP_USER_ADDRESS - si    727   if (uaddr > SOS_PAGING_TOP_USER_ADDRESS - size)
732     return -SOS_EINVAL;                           728     return -SOS_EINVAL;
733                                                   729 
734   /* In some cases, the unmapping might imply     730   /* In some cases, the unmapping might imply a VR to be split into
735      2. Actually, allocating a new VR can be a    731      2. Actually, allocating a new VR can be a blocking operation, but
736      actually we can block now, it won't do no    732      actually we can block now, it won't do no harm. But we must be
737      careful not to block later, while alterin    733      careful not to block later, while altering the VR lists: that's
738      why we pre-allocate now. */                  734      why we pre-allocate now. */
739   used_preallocated_vr = FALSE;                   735   used_preallocated_vr = FALSE;
740   preallocated_vr                                 736   preallocated_vr
741     = (struct sos_umem_vmm_vr *)sos_kmem_cache    737     = (struct sos_umem_vmm_vr *)sos_kmem_cache_alloc(cache_of_vr, 0);
742   if (! preallocated_vr)                          738   if (! preallocated_vr)
743     return -SOS_ENOMEM;                           739     return -SOS_ENOMEM;
744                                                   740 
745   /* Find any VR intersecting with the given i    741   /* Find any VR intersecting with the given interval */
746   vr = find_first_intersecting_vr(as, uaddr, s    742   vr = find_first_intersecting_vr(as, uaddr, size);
747                                                   743 
748   /* Unmap (part of) the VR covered by [uaddr     744   /* Unmap (part of) the VR covered by [uaddr .. uaddr+size[ */
749   while (NULL != vr)                              745   while (NULL != vr)
750     {                                             746     {
751       /* Went past the end of the *circular* l    747       /* Went past the end of the *circular* list => back at the
752          beginning ? */                           748          beginning ? */
753       if (vr->start + vr->size <= uaddr)          749       if (vr->start + vr->size <= uaddr)
754         /* Yes, stop now */                       750         /* Yes, stop now */
755         break;                                    751         break;
756                                                   752 
757       /* Went beyond the region to unmap ? */     753       /* Went beyond the region to unmap ? */
758       if (uaddr + size <= vr->start)              754       if (uaddr + size <= vr->start)
759         /* Yes, stop now */                       755         /* Yes, stop now */
760         break;                                    756         break;
761                                                   757 
762       /* VR totally unmapped ? */                 758       /* VR totally unmapped ? */
763       if ((vr->start >= uaddr)                    759       if ((vr->start >= uaddr)
764           && (vr->start + vr->size <= uaddr +     760           && (vr->start + vr->size <= uaddr + size))
765         {                                         761         {
766           struct sos_umem_vmm_vr *next_vr;        762           struct sos_umem_vmm_vr *next_vr;
767                                                   763 
768           /* Yes: signal we remove it complete    764           /* Yes: signal we remove it completely */
769           if (vr->ops && vr->ops->unmap)          765           if (vr->ops && vr->ops->unmap)
770             vr->ops->unmap(vr, vr->start, vr->    766             vr->ops->unmap(vr, vr->start, vr->size);
771                                                   767 
772           /* Remove it from the AS list now */    768           /* Remove it from the AS list now */
773           next_vr = vr->next_in_as;               769           next_vr = vr->next_in_as;
774           if (next_vr == vr) /* singleton ? */    770           if (next_vr == vr) /* singleton ? */
775             next_vr = NULL;                       771             next_vr = NULL;
776           list_delete_named(as->list_vr, vr, p    772           list_delete_named(as->list_vr, vr, prev_in_as, next_in_as);
777                                                   773 
778           /* Remove from the list of VRs mappi    774           /* Remove from the list of VRs mapping the resource */
779           list_delete_named(vr->mapped_resourc    775           list_delete_named(vr->mapped_resource->list_vr, vr,
780                             prev_in_mapped_res    776                             prev_in_mapped_resource,
781                             next_in_mapped_res    777                             next_in_mapped_resource);
782                                                   778 
783           if (vr->ops && vr->ops->unref)          779           if (vr->ops && vr->ops->unref)
784             vr->ops->unref(vr);                   780             vr->ops->unref(vr);
785                                                   781           
786           as_account_change_of_vr_protection(a    782           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
787                                              v    783                                              vr->size, vr->access_rights, 0);
788           sos_kmem_vmm_free((sos_vaddr_t)vr);     784           sos_kmem_vmm_free((sos_vaddr_t)vr);
789                                                   785       
790           /* Prepare next iteration */            786           /* Prepare next iteration */
791           vr = next_vr;                           787           vr = next_vr;
792           continue;                               788           continue;
793         }                                         789         }
794                                                   790 
795       /* unmapped region lies completely INSID    791       /* unmapped region lies completely INSIDE the the VR */
796       else if ( (vr->start < uaddr)               792       else if ( (vr->start < uaddr)
797                 && (vr->start + vr->size > uad    793                 && (vr->start + vr->size > uaddr + size) )
798         {                                         794         {
799           /* VR has to be split into 2 */         795           /* VR has to be split into 2 */
800                                                   796 
801           /* Use the preallocated VR and copy     797           /* Use the preallocated VR and copy the VR into it */
802           used_preallocated_vr = TRUE;            798           used_preallocated_vr = TRUE;
803           memcpy(preallocated_vr, vr, sizeof(*    799           memcpy(preallocated_vr, vr, sizeof(*vr));
804                                                   800 
805           /* Adjust the start/size of both VRs    801           /* Adjust the start/size of both VRs */
806           preallocated_vr->start = uaddr + siz    802           preallocated_vr->start = uaddr + size;
807           preallocated_vr->size  = vr->start +    803           preallocated_vr->size  = vr->start + vr->size - (uaddr + size);
808           preallocated_vr->offset_in_resource     804           preallocated_vr->offset_in_resource += uaddr + size - vr->start;
809           vr->size                                805           vr->size                             = uaddr - vr->start;
810                                                   806 
811           /* Insert the new VR into the list *    807           /* Insert the new VR into the list */
812           list_insert_after_named(as->list_vr,    808           list_insert_after_named(as->list_vr, vr, preallocated_vr,
813                                   prev_in_as,     809                                   prev_in_as, next_in_as);
814           list_add_tail_named(vr->mapped_resou    810           list_add_tail_named(vr->mapped_resource->list_vr, preallocated_vr,
815                               prev_in_mapped_r    811                               prev_in_mapped_resource,
816                               next_in_mapped_r    812                               next_in_mapped_resource);
817                                                   813 
818           /* Signal the changes to the underly    814           /* Signal the changes to the underlying resource */
819           if (vr->ops && vr->ops->unmap)          815           if (vr->ops && vr->ops->unmap)
820             vr->ops->unmap(vr, uaddr, size);      816             vr->ops->unmap(vr, uaddr, size);
821           if (preallocated_vr->ops && prealloc    817           if (preallocated_vr->ops && preallocated_vr->ops->ref)
822             preallocated_vr->ops->ref(prealloc    818             preallocated_vr->ops->ref(preallocated_vr);
823                                                   819 
824           /* Account for change in VRs */         820           /* Account for change in VRs */
825           as_account_change_of_vr_protection(a    821           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
826                                              s    822                                              size, vr->access_rights, 0);
827                                                   823 
828           /* No need to go further */             824           /* No need to go further */
829           break;                                  825           break;
830         }                                         826         }
831                                                   827 
832       /* Unmapped region only affects the STAR    828       /* Unmapped region only affects the START address of the VR */
833       else if (uaddr <= vr->start)                829       else if (uaddr <= vr->start)
834         {                                         830         {
835           sos_size_t translation = uaddr + siz    831           sos_size_t translation = uaddr + size - vr->start;
836                                                   832 
837           /* Shift the VR */                      833           /* Shift the VR */
838           vr->size               -= translatio    834           vr->size               -= translation;
839           vr->offset_in_resource += translatio    835           vr->offset_in_resource += translation;
840           vr->start              += translatio    836           vr->start              += translation;
841                                                   837           
842           /* Signal unmapping */                  838           /* Signal unmapping */
843           if (vr->ops && vr->ops->unmap)          839           if (vr->ops && vr->ops->unmap)
844             vr->ops->unmap(vr, uaddr + size,      840             vr->ops->unmap(vr, uaddr + size,
845                            translation);          841                            translation);
846                                                   842           
847           /* Account for change in VRs */         843           /* Account for change in VRs */
848           as_account_change_of_vr_protection(a    844           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
849                                              t    845                                              translation,
850                                              v    846                                              vr->access_rights, 0);
851                                                   847 
852           /* No need to go further, we reached    848           /* No need to go further, we reached the last VR that
853              overlaps the unmapped region */      849              overlaps the unmapped region */
854           break;                                  850           break;
855         }                                         851         }
856                                                   852 
857       /* Unmapped region only affects the ENDI    853       /* Unmapped region only affects the ENDING address of the VR */
858       else if (uaddr + size >= vr->start + vr-    854       else if (uaddr + size >= vr->start + vr->size)
859         {                                         855         {
860           sos_size_t unmapped_size = vr->start    856           sos_size_t unmapped_size = vr->start + vr->size - uaddr;
861                                                   857 
862           /* Resize VR */                         858           /* Resize VR */
863           vr->size = uaddr - vr->start;           859           vr->size = uaddr - vr->start;
864                                                   860           
865           /* Signal unmapping */                  861           /* Signal unmapping */
866           if (vr->ops && vr->ops->unmap)          862           if (vr->ops && vr->ops->unmap)
867             vr->ops->unmap(vr, uaddr, unmapped    863             vr->ops->unmap(vr, uaddr, unmapped_size);
868                                                   864 
869           /* Account for change in VRs */         865           /* Account for change in VRs */
870           as_account_change_of_vr_protection(a    866           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
871                                              u    867                                              unmapped_size,
872                                              v    868                                              vr->access_rights, 0);
873                                                   869           
874           vr = vr->next_in_as;                    870           vr = vr->next_in_as;
875           continue;                               871           continue;
876         }                                         872         }
877                                                   873 
878       sos_display_fatal_error("BUG uaddr=%x sz    874       sos_display_fatal_error("BUG uaddr=%x sz=%x vr_start=%x, vr_sz=%x",
879                               uaddr, size, vr-    875                               uaddr, size, vr->start, vr->size);
880     }                                             876     }
881                                                   877 
882   need_to_setup_mmu = (sos_thread_get_current(    878   need_to_setup_mmu = (sos_thread_get_current()->squatted_mm_context
883                        != as->mm_context);        879                        != as->mm_context);
884   if (need_to_setup_mmu)                          880   if (need_to_setup_mmu)
885     SOS_ASSERT_FATAL(SOS_OK                       881     SOS_ASSERT_FATAL(SOS_OK
886                      == sos_thread_prepare_use    882                      == sos_thread_prepare_user_space_access(as,
887                                                   883                                                              (sos_vaddr_t)
888                                                   884                                                                NULL));
889   {                                               885   {
890     sos_size_t sz_unmapped = sos_paging_unmap_ !! 886     sos_ret_t sz_unmapped = sos_paging_unmap_interval(uaddr, size);
891     SOS_ASSERT_FATAL(sz_unmapped >= 0);           887     SOS_ASSERT_FATAL(sz_unmapped >= 0);
892     as->phys_total -= sz_unmapped;                888     as->phys_total -= sz_unmapped;
893   }                                               889   }
894   if (need_to_setup_mmu)                          890   if (need_to_setup_mmu)
895     SOS_ASSERT_FATAL(SOS_OK == sos_thread_end_    891     SOS_ASSERT_FATAL(SOS_OK == sos_thread_end_user_space_access());
896                                                   892 
897   if (! used_preallocated_vr)                     893   if (! used_preallocated_vr)
898     sos_kmem_vmm_free((sos_vaddr_t)preallocate    894     sos_kmem_vmm_free((sos_vaddr_t)preallocated_vr);
899                                                   895 
900   return SOS_OK;                                  896   return SOS_OK;
901 }                                                 897 }
902                                                   898 
903                                                   899 
904 sos_ret_t                                         900 sos_ret_t
905 sos_umem_vmm_chprot(struct sos_umem_vmm_as * a    901 sos_umem_vmm_chprot(struct sos_umem_vmm_as * as,
906                     sos_uaddr_t uaddr, sos_siz    902                     sos_uaddr_t uaddr, sos_size_t size,
907                     sos_ui32_t new_access_righ    903                     sos_ui32_t new_access_rights)
908 {                                                 904 {
909   struct sos_umem_vmm_vr *start_vr, *vr,          905   struct sos_umem_vmm_vr *start_vr, *vr,
910     *preallocated_middle_vr, *preallocated_rig    906     *preallocated_middle_vr, *preallocated_right_vr;
911   sos_bool_t used_preallocated_middle_vr, used    907   sos_bool_t used_preallocated_middle_vr, used_preallocated_right_vr;
912                                                   908 
913   if (! SOS_IS_PAGE_ALIGNED(uaddr))               909   if (! SOS_IS_PAGE_ALIGNED(uaddr))
914     return -SOS_EINVAL;                           910     return -SOS_EINVAL;
915   if (size <= 0)                                  911   if (size <= 0)
916     return -SOS_EINVAL;                           912     return -SOS_EINVAL;
917   size = SOS_PAGE_ALIGN_SUP(size);                913   size = SOS_PAGE_ALIGN_SUP(size);
918                                                   914 
919   /* Make sure the uaddr is valid */              915   /* Make sure the uaddr is valid */
920   if (uaddr < SOS_PAGING_BASE_USER_ADDRESS)       916   if (uaddr < SOS_PAGING_BASE_USER_ADDRESS)
921     return -SOS_EINVAL;                           917     return -SOS_EINVAL;
922   if (uaddr > SOS_PAGING_TOP_USER_ADDRESS - si    918   if (uaddr > SOS_PAGING_TOP_USER_ADDRESS - size)
923     return -SOS_EINVAL;                           919     return -SOS_EINVAL;
924                                                   920 
925   /* Pre-allocate 2 new VRs (same reason as fo    921   /* Pre-allocate 2 new VRs (same reason as for unmap). Because chprot
926      may imply at most 2 regions to be split *    922      may imply at most 2 regions to be split */
927   used_preallocated_middle_vr = FALSE;            923   used_preallocated_middle_vr = FALSE;
928   used_preallocated_right_vr  = FALSE;            924   used_preallocated_right_vr  = FALSE;
929   preallocated_middle_vr                          925   preallocated_middle_vr
930     = (struct sos_umem_vmm_vr *)sos_kmem_cache    926     = (struct sos_umem_vmm_vr *)sos_kmem_cache_alloc(cache_of_vr, 0);
931   if (! preallocated_middle_vr)                   927   if (! preallocated_middle_vr)
932     return -SOS_ENOMEM;                           928     return -SOS_ENOMEM;
933   preallocated_right_vr                           929   preallocated_right_vr
934     = (struct sos_umem_vmm_vr *)sos_kmem_cache    930     = (struct sos_umem_vmm_vr *)sos_kmem_cache_alloc(cache_of_vr, 0);
935   if (! preallocated_right_vr)                    931   if (! preallocated_right_vr)
936     {                                             932     {
937       sos_kmem_vmm_free((sos_vaddr_t)prealloca    933       sos_kmem_vmm_free((sos_vaddr_t)preallocated_middle_vr);
938       return -SOS_ENOMEM;                         934       return -SOS_ENOMEM;
939     }                                             935     }
940                                                   936 
941   /* Find any VR intersecting with the given i    937   /* Find any VR intersecting with the given interval */
942   start_vr = find_first_intersecting_vr(as, ua    938   start_vr = find_first_intersecting_vr(as, uaddr, size);
943   if (NULL == start_vr)                           939   if (NULL == start_vr)
944     return SOS_OK;                                940     return SOS_OK;
945                                                   941 
946   /* First of all: make sure we are allowed to    942   /* First of all: make sure we are allowed to change the access
947      rights of all the VRs concerned by the ch    943      rights of all the VRs concerned by the chprot */
948   vr = start_vr;                                  944   vr = start_vr;
949   while (TRUE)                                    945   while (TRUE)
950     {                                             946     {
951       /* Went past the end of the *circular* l    947       /* Went past the end of the *circular* list => back at the
952          begining ? */                            948          begining ? */
953       if (vr->start + vr->size <= uaddr)          949       if (vr->start + vr->size <= uaddr)
954         /* Yes, stop now */                       950         /* Yes, stop now */
955         break;                                    951         break;
956                                                   952 
957       /* Went beyond the region to chprot ? */    953       /* Went beyond the region to chprot ? */
958       if (uaddr + size < vr->start)               954       if (uaddr + size < vr->start)
959         /* Yes, stop now */                       955         /* Yes, stop now */
960         break;                                    956         break;
961                                                   957 
962       if (vr->flags & SOS_VR_MAP_SHARED)          958       if (vr->flags & SOS_VR_MAP_SHARED)
963         {                                         959         {
964           /* Make sure the mapped resource all    960           /* Make sure the mapped resource allows the required
965              protection flags */                  961              protection flags */
966           if ( ( (new_access_rights & SOS_VM_M    962           if ( ( (new_access_rights & SOS_VM_MAP_PROT_READ)
967                  && !(vr->mapped_resource->all    963                  && !(vr->mapped_resource->allowed_access_rights
968                       & SOS_VM_MAP_PROT_READ)     964                       & SOS_VM_MAP_PROT_READ) )
969                || ( (new_access_rights & SOS_V    965                || ( (new_access_rights & SOS_VM_MAP_PROT_WRITE)
970                     && !(vr->mapped_resource->    966                     && !(vr->mapped_resource->allowed_access_rights
971                          & SOS_VM_MAP_PROT_WRI    967                          & SOS_VM_MAP_PROT_WRITE) )
972                || ( (new_access_rights & SOS_V    968                || ( (new_access_rights & SOS_VM_MAP_PROT_EXEC)
973                     && !(vr->mapped_resource->    969                     && !(vr->mapped_resource->allowed_access_rights
974                          & SOS_VM_MAP_PROT_EXE    970                          & SOS_VM_MAP_PROT_EXEC) ) )
975             return -SOS_EPERM;                    971             return -SOS_EPERM;
976         }                                         972         }
977                                                   973 
978       vr = vr->next_in_as;                        974       vr = vr->next_in_as;
979     }                                             975     }
980                                                   976 
981   /* Change the access rights of the VRs cover    977   /* Change the access rights of the VRs covered by [uaddr
982      .. uaddr+size[ */                            978      .. uaddr+size[ */
983   vr = start_vr;                                  979   vr = start_vr;
984   while (TRUE)                                    980   while (TRUE)
985     {                                             981     {
986                                                   982 
987       /* Went past the end of the *circular* l    983       /* Went past the end of the *circular* list => back at the
988          begining ? */                            984          begining ? */
989       if (vr->start + vr->size <= uaddr)          985       if (vr->start + vr->size <= uaddr)
990         /* Yes, stop now */                       986         /* Yes, stop now */
991         break;                                    987         break;
992                                                   988 
993       /* Went beyond the region to chprot ? */    989       /* Went beyond the region to chprot ? */
994       if (uaddr + size <= vr->start)              990       if (uaddr + size <= vr->start)
995         /* Yes, stop now */                       991         /* Yes, stop now */
996         break;                                    992         break;
997                                                   993 
998       /* Access rights unchanged ? */             994       /* Access rights unchanged ? */
999       if (vr->access_rights == new_access_righ    995       if (vr->access_rights == new_access_rights)
1000         /* nop */                                996         /* nop */
1001         {                                        997         {
1002           vr = vr->next_in_as;                   998           vr = vr->next_in_as;
1003           continue;                              999           continue;
1004         }                                        1000         }
1005                                                  1001 
1006       /* VR totally chprot ? */                  1002       /* VR totally chprot ? */
1007       if ((vr->start >= uaddr)                   1003       if ((vr->start >= uaddr)
1008           && (vr->start + vr->size <= uaddr +    1004           && (vr->start + vr->size <= uaddr + size))
1009         {                                        1005         {
1010           /* Account for change in VRs */        1006           /* Account for change in VRs */
1011           as_account_change_of_vr_protection(    1007           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
1012                                                  1008                                              vr->size, vr->access_rights,
1013                                                  1009                                              new_access_rights);
1014           vr->access_rights = new_access_righ    1010           vr->access_rights = new_access_rights;
1015                                                  1011 
1016           if (vr->flags & SOS_VR_MAP_SHARED)     1012           if (vr->flags & SOS_VR_MAP_SHARED)
1017             /* For shared mappings: effective    1013             /* For shared mappings: effectively change the access
1018                rights of the physical pages      1014                rights of the physical pages  */
1019             sos_paging_set_prot_of_interval(v    1015             sos_paging_set_prot_of_interval(vr->start, vr->size,
1020                                             n    1016                                             new_access_rights);
1021           else                                   1017           else
1022             /* Private mapping */                1018             /* Private mapping */
1023             {                                    1019             {
1024               /* For private mappings, we set    1020               /* For private mappings, we set the new access_rights
1025                  only if it becomes read-only    1021                  only if it becomes read-only. For private mappings
1026                  that become writable, we don    1022                  that become writable, we don't do anything: we keep
1027                  the access rights unchanged     1023                  the access rights unchanged to preserve the COW
1028                  semantics */                    1024                  semantics */
1029               if (! (new_access_rights & SOS_    1025               if (! (new_access_rights & SOS_VM_MAP_PROT_WRITE))
1030                 sos_paging_set_prot_of_interv    1026                 sos_paging_set_prot_of_interval(vr->start, vr->size,
1031                                                  1027                                                 new_access_rights);
1032             }                                    1028             }
1033                                                  1029 
1034           vr = vr->next_in_as;                   1030           vr = vr->next_in_as;
1035           continue;                              1031           continue;
1036         }                                        1032         }
1037                                                  1033 
1038       /* chprot region lies completely INSIDE    1034       /* chprot region lies completely INSIDE the VR */
1039       else if ( (vr->start < uaddr)              1035       else if ( (vr->start < uaddr)
1040                 && (vr->start + vr->size > ua    1036                 && (vr->start + vr->size > uaddr + size) )
1041         {                                        1037         {
1042           /* VR has to be split into 3 */        1038           /* VR has to be split into 3 */
1043                                                  1039 
1044           /* Use the preallocated VRs and cop    1040           /* Use the preallocated VRs and copy the VR into them */
1045           SOS_ASSERT_FATAL(! used_preallocate    1041           SOS_ASSERT_FATAL(! used_preallocated_middle_vr);
1046           SOS_ASSERT_FATAL(! used_preallocate    1042           SOS_ASSERT_FATAL(! used_preallocated_right_vr);
1047           used_preallocated_middle_vr = TRUE;    1043           used_preallocated_middle_vr = TRUE;
1048           memcpy(preallocated_middle_vr, vr,     1044           memcpy(preallocated_middle_vr, vr, sizeof(*vr));
1049           used_preallocated_right_vr = TRUE;     1045           used_preallocated_right_vr = TRUE;
1050           memcpy(preallocated_right_vr, vr, s    1046           memcpy(preallocated_right_vr, vr, sizeof(*vr));
1051                                                  1047 
1052           /* Adjust the start/size of the VRs    1048           /* Adjust the start/size of the VRs */
1053           preallocated_middle_vr->start = uad    1049           preallocated_middle_vr->start = uaddr;
1054           preallocated_middle_vr->size  = siz    1050           preallocated_middle_vr->size  = size;
1055           preallocated_right_vr->start  = uad    1051           preallocated_right_vr->start  = uaddr + size;
1056           preallocated_right_vr->size   = vr-    1052           preallocated_right_vr->size   = vr->start + vr->size
1057                                             -    1053                                             - (uaddr + size);
1058           preallocated_middle_vr->offset_in_r    1054           preallocated_middle_vr->offset_in_resource
1059             += uaddr - vr->start;                1055             += uaddr - vr->start;
1060           preallocated_right_vr->offset_in_re    1056           preallocated_right_vr->offset_in_resource
1061             += uaddr + size - vr->start;         1057             += uaddr + size - vr->start;
1062           vr->size = uaddr - vr->start;          1058           vr->size = uaddr - vr->start;
1063                                                  1059 
1064           /* Account for change in VRs */        1060           /* Account for change in VRs */
1065           preallocated_middle_vr->access_righ    1061           preallocated_middle_vr->access_rights = new_access_rights;
1066           as_account_change_of_vr_protection(    1062           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
1067                                                  1063                                              size, vr->access_rights,
1068                                                  1064                                              new_access_rights);
1069                                                  1065 
1070           /* Insert the new VRs into the list    1066           /* Insert the new VRs into the lists */
1071           list_insert_after_named(as->list_vr    1067           list_insert_after_named(as->list_vr, vr, preallocated_middle_vr,
1072                                   prev_in_as,    1068                                   prev_in_as, next_in_as);
1073           list_insert_after_named(as->list_vr    1069           list_insert_after_named(as->list_vr, preallocated_middle_vr,
1074                                   preallocate    1070                                   preallocated_right_vr,
1075                                   prev_in_as,    1071                                   prev_in_as, next_in_as);
1076                                                  1072 
1077           list_add_tail_named(vr->mapped_reso    1073           list_add_tail_named(vr->mapped_resource->list_vr,
1078                               preallocated_mi    1074                               preallocated_middle_vr,
1079                               prev_in_mapped_    1075                               prev_in_mapped_resource,
1080                               next_in_mapped_    1076                               next_in_mapped_resource);
1081           list_add_tail_named(vr->mapped_reso    1077           list_add_tail_named(vr->mapped_resource->list_vr,
1082                               preallocated_ri    1078                               preallocated_right_vr,
1083                               prev_in_mapped_    1079                               prev_in_mapped_resource,
1084                               next_in_mapped_    1080                               next_in_mapped_resource);
1085                                                  1081 
1086           /* Effectively change the access ri    1082           /* Effectively change the access rights of the physical pages */
1087           if (!(preallocated_middle_vr->flags    1083           if (!(preallocated_middle_vr->flags & SOS_VR_MAP_SHARED)
1088               && (new_access_rights & SOS_VM_    1084               && (new_access_rights & SOS_VM_MAP_PROT_WRITE))
1089             /* For private mappings with writ    1085             /* For private mappings with write access, prepare for COW */
1090             sos_paging_prepare_COW(preallocat    1086             sos_paging_prepare_COW(preallocated_middle_vr->start,
1091                                    preallocat    1087                                    preallocated_middle_vr->size);
1092           else                                   1088           else
1093             sos_paging_set_prot_of_interval(p    1089             sos_paging_set_prot_of_interval(preallocated_middle_vr->start,
1094                                             p    1090                                             preallocated_middle_vr->size,
1095                                             n    1091                                             new_access_rights);
1096                                                  1092 
1097           if (preallocated_right_vr->ops && p    1093           if (preallocated_right_vr->ops && preallocated_right_vr->ops->ref)
1098             preallocated_right_vr->ops->ref(p    1094             preallocated_right_vr->ops->ref(preallocated_right_vr);
1099           if (preallocated_middle_vr->ops &&     1095           if (preallocated_middle_vr->ops && preallocated_middle_vr->ops->ref)
1100             preallocated_middle_vr->ops->ref(    1096             preallocated_middle_vr->ops->ref(preallocated_middle_vr);
1101                                                  1097 
1102           /* No need to go further */            1098           /* No need to go further */
1103           break;                                 1099           break;
1104         }                                        1100         }
1105                                                  1101 
1106       /* Chprot region only affects the START    1102       /* Chprot region only affects the START address of the VR */
1107       else if (uaddr <= vr->start)               1103       else if (uaddr <= vr->start)
1108         {                                        1104         {
1109           /* Split the region into 2 */          1105           /* Split the region into 2 */
1110           sos_uoffset_t offset_in_region = ua    1106           sos_uoffset_t offset_in_region = uaddr + size - vr->start;
1111                                                  1107 
1112           /* Use the preallocated VRs and cop    1108           /* Use the preallocated VRs and copy the VR into them */
1113           SOS_ASSERT_FATAL(! used_preallocate    1109           SOS_ASSERT_FATAL(! used_preallocated_middle_vr);
1114           used_preallocated_middle_vr = TRUE;    1110           used_preallocated_middle_vr = TRUE;
1115           memcpy(preallocated_middle_vr, vr,     1111           memcpy(preallocated_middle_vr, vr, sizeof(*vr));
1116                                                  1112 
1117           /* Adjust the start/size of the VRs    1113           /* Adjust the start/size of the VRs */
1118           preallocated_middle_vr->start += of    1114           preallocated_middle_vr->start += offset_in_region;
1119           preallocated_middle_vr->size  -= of    1115           preallocated_middle_vr->size  -= offset_in_region;
1120           vr->size                       = of    1116           vr->size                       = offset_in_region;
1121           preallocated_middle_vr->offset_in_r    1117           preallocated_middle_vr->offset_in_resource += offset_in_region;
1122                                                  1118 
1123           /* Account for change in VRs */        1119           /* Account for change in VRs */
1124           as_account_change_of_vr_protection(    1120           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
1125                                                  1121                                              vr->size,
1126                                                  1122                                              vr->access_rights,
1127                                                  1123                                              new_access_rights);
1128           vr->access_rights = new_access_righ    1124           vr->access_rights = new_access_rights;
1129                                                  1125 
1130           /* Insert the new VR into the lists    1126           /* Insert the new VR into the lists */
1131           list_insert_after_named(as->list_vr    1127           list_insert_after_named(as->list_vr, vr,
1132                                   preallocate    1128                                   preallocated_middle_vr,
1133                                   prev_in_as,    1129                                   prev_in_as, next_in_as);
1134           list_add_tail_named(vr->mapped_reso    1130           list_add_tail_named(vr->mapped_resource->list_vr,
1135                               preallocated_mi    1131                               preallocated_middle_vr,
1136                               prev_in_mapped_    1132                               prev_in_mapped_resource,
1137                               next_in_mapped_    1133                               next_in_mapped_resource);
1138                                                  1134 
1139           /* Effectively change the access ri    1135           /* Effectively change the access rights of the physical pages */
1140           if (!(vr->flags & SOS_VR_MAP_SHARED    1136           if (!(vr->flags & SOS_VR_MAP_SHARED)
1141               && (new_access_rights & SOS_VM_    1137               && (new_access_rights & SOS_VM_MAP_PROT_WRITE))
1142             /* For private mappings with writ    1138             /* For private mappings with write access, prepare for COW */
1143             sos_paging_prepare_COW(vr->start,    1139             sos_paging_prepare_COW(vr->start, vr->size);
1144           else                                   1140           else
1145             sos_paging_set_prot_of_interval(v    1141             sos_paging_set_prot_of_interval(vr->start, vr->size,
1146                                             n    1142                                             new_access_rights);
1147                                                  1143 
1148           if (preallocated_middle_vr->ops &&     1144           if (preallocated_middle_vr->ops && preallocated_middle_vr->ops->ref)
1149             preallocated_middle_vr->ops->ref(    1145             preallocated_middle_vr->ops->ref(preallocated_middle_vr);
1150                                                  1146 
1151           /* Ne need to go further (we reache    1147           /* Ne need to go further (we reached the last VR that
1152              overlaps the given interval to c    1148              overlaps the given interval to chprot) */
1153           break;                                 1149           break;
1154         }                                        1150         }
1155                                                  1151 
1156       /* Chprot region only affects the ENDIN    1152       /* Chprot region only affects the ENDING address of the VR */
1157       else if (uaddr + size >= vr->start + vr    1153       else if (uaddr + size >= vr->start + vr->size)
1158         {                                        1154         {
1159           /* Split the region into 2 */          1155           /* Split the region into 2 */
1160           sos_uoffset_t offset_in_region = ua    1156           sos_uoffset_t offset_in_region = uaddr - vr->start;
1161                                                  1157 
1162           /* Use the preallocated VRs and cop    1158           /* Use the preallocated VRs and copy the VR into them */
1163           SOS_ASSERT_FATAL(! used_preallocate    1159           SOS_ASSERT_FATAL(! used_preallocated_right_vr);
1164           used_preallocated_right_vr = TRUE;     1160           used_preallocated_right_vr = TRUE;
1165           memcpy(preallocated_right_vr, vr, s    1161           memcpy(preallocated_right_vr, vr, sizeof(*vr));
1166                                                  1162 
1167           /* Adjust the start/size of the VRs    1163           /* Adjust the start/size of the VRs */
1168           preallocated_right_vr->start           1164           preallocated_right_vr->start        += offset_in_region;
1169           preallocated_right_vr->size            1165           preallocated_right_vr->size         -= offset_in_region;
1170           vr->size                               1166           vr->size                             = offset_in_region;
1171           preallocated_right_vr->offset_in_re    1167           preallocated_right_vr->offset_in_resource += offset_in_region;
1172                                                  1168 
1173           /* Account for change in VRs */        1169           /* Account for change in VRs */
1174           as_account_change_of_vr_protection(    1170           as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
1175                                                  1171                                              preallocated_right_vr->size,
1176                                                  1172                                              vr->access_rights,
1177                                                  1173                                              new_access_rights);
1178           preallocated_right_vr->access_right    1174           preallocated_right_vr->access_rights = new_access_rights;
1179                                                  1175 
1180           /* Insert the new VR into the lists    1176           /* Insert the new VR into the lists */
1181           list_insert_after_named(as->list_vr    1177           list_insert_after_named(as->list_vr, vr,
1182                                   preallocate    1178                                   preallocated_right_vr,
1183                                   prev_in_as,    1179                                   prev_in_as, next_in_as);
1184           list_add_tail_named(vr->mapped_reso    1180           list_add_tail_named(vr->mapped_resource->list_vr,
1185                               preallocated_ri    1181                               preallocated_right_vr,
1186                               prev_in_mapped_    1182                               prev_in_mapped_resource,
1187                               next_in_mapped_    1183                               next_in_mapped_resource);
1188                                                  1184 
1189           /* Effectively change the access ri    1185           /* Effectively change the access rights of the physical pages */
1190           if (!(preallocated_right_vr->flags     1186           if (!(preallocated_right_vr->flags & SOS_VR_MAP_SHARED)
1191               && (new_access_rights & SOS_VM_    1187               && (new_access_rights & SOS_VM_MAP_PROT_WRITE))
1192             /* For private mappings with writ    1188             /* For private mappings with write access, prepare for COW */
1193             sos_paging_prepare_COW(preallocat    1189             sos_paging_prepare_COW(preallocated_right_vr->start,
1194                                    preallocat    1190                                    preallocated_right_vr->size);
1195           else                                   1191           else
1196             sos_paging_set_prot_of_interval(p    1192             sos_paging_set_prot_of_interval(preallocated_right_vr->start,
1197                                             p    1193                                             preallocated_right_vr->size,
1198                                             n    1194                                             new_access_rights);
1199                                                  1195 
1200           if (preallocated_right_vr->ops && p    1196           if (preallocated_right_vr->ops && preallocated_right_vr->ops->ref)
1201             preallocated_right_vr->ops->ref(p    1197             preallocated_right_vr->ops->ref(preallocated_right_vr);
1202                                                  1198 
1203           vr = vr->next_in_as;                   1199           vr = vr->next_in_as;
1204           continue;                              1200           continue;
1205         }                                        1201         }
1206                                                  1202 
1207       sos_display_fatal_error("BUG");            1203       sos_display_fatal_error("BUG");
1208     }                                            1204     }
1209                                                  1205 
1210   if (! used_preallocated_middle_vr)             1206   if (! used_preallocated_middle_vr)
1211     sos_kmem_vmm_free((sos_vaddr_t)preallocat    1207     sos_kmem_vmm_free((sos_vaddr_t)preallocated_middle_vr);
1212   if (! used_preallocated_right_vr)              1208   if (! used_preallocated_right_vr)
1213     sos_kmem_vmm_free((sos_vaddr_t)preallocat    1209     sos_kmem_vmm_free((sos_vaddr_t)preallocated_right_vr);
                                                   >> 1210 
                                                   >> 1211   return SOS_OK;
                                                   >> 1212 }
                                                   >> 1213 
                                                   >> 1214 
                                                   >> 1215 sos_ret_t
                                                   >> 1216 sos_umem_vmm_sync(struct sos_umem_vmm_as * as,
                                                   >> 1217                   sos_uaddr_t uaddr, sos_size_t size,
                                                   >> 1218                   sos_ui32_t flags)
                                                   >> 1219 {
                                                   >> 1220   if (! SOS_IS_PAGE_ALIGNED(uaddr))
                                                   >> 1221     return -SOS_EINVAL;
                                                   >> 1222   if (size <= 0)
                                                   >> 1223     return -SOS_EINVAL;
                                                   >> 1224   size = SOS_PAGE_ALIGN_SUP(size);
                                                   >> 1225 
                                                   >> 1226   /* Make sure the uaddr is valid */
                                                   >> 1227   if (uaddr < SOS_PAGING_BASE_USER_ADDRESS)
                                                   >> 1228     return -SOS_EINVAL;
                                                   >> 1229   if (uaddr > SOS_PAGING_TOP_USER_ADDRESS - size)
                                                   >> 1230     return -SOS_EINVAL;
                                                   >> 1231 
                                                   >> 1232   /* Go from page to page, and for each dirty page in the region, call
                                                   >> 1233      the sync_page method */
                                                   >> 1234   while (TRUE)
                                                   >> 1235     {
                                                   >> 1236       struct sos_umem_vmm_vr *vr;
                                                   >> 1237 
                                                   >> 1238       if (size <= 0)
                                                   >> 1239         break;
                                                   >> 1240 
                                                   >> 1241       /* Find any VR intersecting with the given interval */
                                                   >> 1242       vr = find_first_intersecting_vr(as, uaddr, size);
                                                   >> 1243       if (NULL == vr)
                                                   >> 1244         break;
                                                   >> 1245 
                                                   >> 1246       /* For private or anonymous mappings => no backing store */
                                                   >> 1247       if ( !(vr->flags & SOS_VR_MAP_SHARED)
                                                   >> 1248            || (vr->mapped_resource->flags & SOS_MAPPED_RESOURCE_ANONYMOUS)
                                                   >> 1249 
                                                   >> 1250            /* Likewise for non msync-able regions */
                                                   >> 1251            || ! vr->ops->sync_page )
                                                   >> 1252         {
                                                   >> 1253           if (size <= vr->size)
                                                   >> 1254             break;
                                                   >> 1255 
                                                   >> 1256           uaddr += vr->size;
                                                   >> 1257           size  -= vr->size;
                                                   >> 1258         }
                                                   >> 1259 
                                                   >> 1260       /* Find the next dirty page in this VR */
                                                   >> 1261       for ( ; (size > 0)
                                                   >> 1262               && (uaddr - vr->start < vr->size) ;
                                                   >> 1263             uaddr += SOS_PAGE_SIZE,
                                                   >> 1264               size -= SOS_PAGE_SIZE)
                                                   >> 1265         if (sos_paging_is_dirty(uaddr))
                                                   >> 1266           {
                                                   >> 1267             /* Synchronize it with its backing store */
                                                   >> 1268             vr->ops->sync_page(vr, uaddr, flags);
                                                   >> 1269             uaddr += SOS_PAGE_SIZE;
                                                   >> 1270             size  -= SOS_PAGE_SIZE;
                                                   >> 1271             break;
                                                   >> 1272           }
                                                   >> 1273     }
1214                                                  1274 
1215   return SOS_OK;                                 1275   return SOS_OK;
1216 }                                                1276 }
1217                                                  1277 
1218                                                  1278 
1219 sos_ret_t                                        1279 sos_ret_t
1220 sos_umem_vmm_resize(struct sos_umem_vmm_as *     1280 sos_umem_vmm_resize(struct sos_umem_vmm_as * as,
1221                     sos_uaddr_t old_uaddr, so    1281                     sos_uaddr_t old_uaddr, sos_size_t old_size,
1222                     sos_uaddr_t *new_uaddr, s    1282                     sos_uaddr_t *new_uaddr, sos_size_t new_size,
1223                     sos_ui32_t flags)            1283                     sos_ui32_t flags)
1224 {                                                1284 {
1225   sos_luoffset_t new_offset_in_resource;         1285   sos_luoffset_t new_offset_in_resource;
1226   sos_bool_t must_move_vr = FALSE;               1286   sos_bool_t must_move_vr = FALSE;
1227   struct sos_umem_vmm_vr *vr, *prev_vr, *next    1287   struct sos_umem_vmm_vr *vr, *prev_vr, *next_vr;
1228                                                  1288 
1229   /* Make sure the new uaddr is valid */         1289   /* Make sure the new uaddr is valid */
1230   if (*new_uaddr < SOS_PAGING_BASE_USER_ADDRE    1290   if (*new_uaddr < SOS_PAGING_BASE_USER_ADDRESS)
1231     return -SOS_EINVAL;                          1291     return -SOS_EINVAL;
1232   if (*new_uaddr > SOS_PAGING_TOP_USER_ADDRES    1292   if (*new_uaddr > SOS_PAGING_TOP_USER_ADDRESS - new_size)
1233     return -SOS_EINVAL;                          1293     return -SOS_EINVAL;
1234                                                  1294 
1235   old_uaddr = SOS_PAGE_ALIGN_INF(old_uaddr);     1295   old_uaddr = SOS_PAGE_ALIGN_INF(old_uaddr);
1236   old_size  = SOS_PAGE_ALIGN_SUP(old_size);      1296   old_size  = SOS_PAGE_ALIGN_SUP(old_size);
1237   if (! SOS_IS_PAGE_ALIGNED(*new_uaddr))         1297   if (! SOS_IS_PAGE_ALIGNED(*new_uaddr))
1238     return -SOS_EINVAL;                          1298     return -SOS_EINVAL;
1239   if (new_size <= 0)                             1299   if (new_size <= 0)
1240     return -SOS_EINVAL;                          1300     return -SOS_EINVAL;
1241   new_size = SOS_PAGE_ALIGN_SUP(new_size);       1301   new_size = SOS_PAGE_ALIGN_SUP(new_size);
1242                                                  1302   
1243   /* Lookup a VR overlapping the address rang    1303   /* Lookup a VR overlapping the address range */
1244   vr = find_first_intersecting_vr(as, old_uad    1304   vr = find_first_intersecting_vr(as, old_uaddr, old_size);
1245   if (! vr)                                      1305   if (! vr)
1246     return -SOS_EINVAL;                          1306     return -SOS_EINVAL;
1247                                                  1307   
1248   /* Make sure there is exactly ONE VR overla    1308   /* Make sure there is exactly ONE VR overlapping the area */
1249   if ( (vr->start > old_uaddr)                   1309   if ( (vr->start > old_uaddr)
1250        || (vr->start + vr->size < old_uaddr +    1310        || (vr->start + vr->size < old_uaddr + old_size) )
1251     return -SOS_EINVAL;                          1311     return -SOS_EINVAL;
1252                                                  1312 
1253   /* Retrieve the prev/next VR if they exist     1313   /* Retrieve the prev/next VR if they exist (the VR are on circular
1254      list) */                                    1314      list) */
1255   prev_vr = vr->prev_in_as;                      1315   prev_vr = vr->prev_in_as;
1256   if (prev_vr->start >= vr->start)               1316   if (prev_vr->start >= vr->start)
1257     prev_vr = NULL;                              1317     prev_vr = NULL;
1258   next_vr = vr->prev_in_as;                      1318   next_vr = vr->prev_in_as;
1259   if (next_vr->start <= vr->start)               1319   if (next_vr->start <= vr->start)
1260     next_vr = NULL;                              1320     next_vr = NULL;
1261                                                  1321 
1262   /*                                             1322   /*
1263    * Compute new offset inside the mapped res    1323    * Compute new offset inside the mapped resource, if any
1264    */                                            1324    */
1265                                                  1325 
1266   /* Don't allow to resize if the uaddr goes     1326   /* Don't allow to resize if the uaddr goes beyond the 'offset 0' of
1267      the resource */                             1327      the resource */
1268   if ( (*new_uaddr < vr->start)                  1328   if ( (*new_uaddr < vr->start)
1269        && (vr->start - *new_uaddr > vr->offse    1329        && (vr->start - *new_uaddr > vr->offset_in_resource) )
1270     return -SOS_EINVAL;                          1330     return -SOS_EINVAL;
1271                                                  1331   
1272   /* Compute new offset in the resource (over    1332   /* Compute new offset in the resource (overflow-safe) */
1273   if (vr->start > *new_uaddr)                    1333   if (vr->start > *new_uaddr)
1274     new_offset_in_resource                       1334     new_offset_in_resource
1275       = vr->offset_in_resource                   1335       = vr->offset_in_resource
1276       - (vr->start - *new_uaddr);                1336       - (vr->start - *new_uaddr);
1277   else                                           1337   else
1278     new_offset_in_resource                       1338     new_offset_in_resource
1279       = vr->offset_in_resource                   1339       = vr->offset_in_resource
1280       + (*new_uaddr - vr->start);                1340       + (*new_uaddr - vr->start);
1281                                                  1341 
1282   /* If other VRs would be affected by this r    1342   /* If other VRs would be affected by this resizing, then the VR must
1283      be moved */                                 1343      be moved */
1284   if (prev_vr && (prev_vr->start + prev_vr->s    1344   if (prev_vr && (prev_vr->start + prev_vr->size > *new_uaddr))
1285     must_move_vr |= TRUE;                        1345     must_move_vr |= TRUE;
1286   if (next_vr && (next_vr->start < *new_uaddr    1346   if (next_vr && (next_vr->start < *new_uaddr + new_size))
1287     must_move_vr |= TRUE;                        1347     must_move_vr |= TRUE;
1288                                                  1348 
1289   /* If VR would be out-of-user-space, it mus    1349   /* If VR would be out-of-user-space, it must be moved */
1290   if (*new_uaddr < SOS_PAGING_BASE_USER_ADDRE    1350   if (*new_uaddr < SOS_PAGING_BASE_USER_ADDRESS)
1291     must_move_vr |= TRUE;                        1351     must_move_vr |= TRUE;
1292   if (*new_uaddr > SOS_PAGING_TOP_USER_ADDRES    1352   if (*new_uaddr > SOS_PAGING_TOP_USER_ADDRESS - new_size)
1293     must_move_vr |= TRUE;                        1353     must_move_vr |= TRUE;
1294                                                  1354 
1295   /* The VR must be moved but the user forbid    1355   /* The VR must be moved but the user forbids it */
1296   if ( must_move_vr && !(flags & SOS_VR_REMAP    1356   if ( must_move_vr && !(flags & SOS_VR_REMAP_MAYMOVE) )
1297     return -SOS_EINVAL;                          1357     return -SOS_EINVAL;
1298                                                  1358 
1299   /* If the VR must be moved, we simply map t    1359   /* If the VR must be moved, we simply map the resource elsewhere and
1300      unmap the current VR */                     1360      unmap the current VR */
1301   if (must_move_vr)                              1361   if (must_move_vr)
1302     {                                            1362     {
1303       sos_uaddr_t uaddr, result_uaddr;           1363       sos_uaddr_t uaddr, result_uaddr;
1304       sos_ret_t retval;                          1364       sos_ret_t retval;
1305                                                  1365 
1306       result_uaddr = *new_uaddr;                 1366       result_uaddr = *new_uaddr;
1307       retval = sos_umem_vmm_map(as, & result_    1367       retval = sos_umem_vmm_map(as, & result_uaddr, new_size,
1308                                 vr->access_ri    1368                                 vr->access_rights,
1309                                 vr->flags | I    1369                                 vr->flags | INTERNAL_MAP_CALLED_FROM_MREMAP,
1310                                 vr->mapped_re    1370                                 vr->mapped_resource,
1311                                 new_offset_in    1371                                 new_offset_in_resource);
1312       if (SOS_OK != retval)                      1372       if (SOS_OK != retval)
1313         return retval;                           1373         return retval;
1314                                                  1374 
1315       /* Remap the physical pages at their ne    1375       /* Remap the physical pages at their new address */
1316       for (uaddr = vr->start ;                   1376       for (uaddr = vr->start ;
1317            uaddr < vr->start + vr->size ;        1377            uaddr < vr->start + vr->size ;
1318            uaddr += SOS_PAGE_SIZE)               1378            uaddr += SOS_PAGE_SIZE)
1319         {                                        1379         {
1320           sos_paddr_t paddr;                     1380           sos_paddr_t paddr;
1321           sos_ui32_t  prot;                      1381           sos_ui32_t  prot;
1322           sos_uaddr_t vaddr;                     1382           sos_uaddr_t vaddr;
1323                                                  1383           
1324           if (uaddr < *new_uaddr)                1384           if (uaddr < *new_uaddr)
1325             continue;                            1385             continue;
1326           if (uaddr > *new_uaddr + new_size)     1386           if (uaddr > *new_uaddr + new_size)
1327             continue;                            1387             continue;
1328                                                  1388 
1329           /* Compute destination virtual addr    1389           /* Compute destination virtual address (should be
1330              overflow-safe) */                   1390              overflow-safe) */
1331           if (vr->start >= *new_uaddr)           1391           if (vr->start >= *new_uaddr)
1332             vaddr = result_uaddr                 1392             vaddr = result_uaddr
1333               + (uaddr - vr->start)              1393               + (uaddr - vr->start)
1334               + (vr->start - *new_uaddr);        1394               + (vr->start - *new_uaddr);
1335           else                                   1395           else
1336             vaddr = result_uaddr                 1396             vaddr = result_uaddr
1337               + (uaddr - vr->start)              1397               + (uaddr - vr->start)
1338               - (*new_uaddr - vr->start);        1398               - (*new_uaddr - vr->start);
1339                                                  1399 
1340           paddr = sos_paging_get_paddr(uaddr)    1400           paddr = sos_paging_get_paddr(uaddr);
1341           if (! paddr)                           1401           if (! paddr)
1342             /* No physical page mapped at thi    1402             /* No physical page mapped at this address yet */
1343             continue;                            1403             continue;
1344                                                  1404 
1345           prot  = sos_paging_get_prot(uaddr);    1405           prot  = sos_paging_get_prot(uaddr);
1346           SOS_ASSERT_FATAL(prot);                1406           SOS_ASSERT_FATAL(prot);
1347                                                  1407 
1348           /* Remap it at its destination addr    1408           /* Remap it at its destination address */
1349           retval = sos_paging_map(paddr, vadd    1409           retval = sos_paging_map(paddr, vaddr, TRUE, prot);
1350           if (SOS_OK != retval)                  1410           if (SOS_OK != retval)
1351             {                                    1411             {
1352               sos_umem_vmm_unmap(as, result_u    1412               sos_umem_vmm_unmap(as, result_uaddr, new_size);
1353               return retval;                     1413               return retval;
1354             }                                    1414             }
1355         }                                        1415         }
1356                                                  1416 
1357       retval = sos_umem_vmm_unmap(as, vr->sta    1417       retval = sos_umem_vmm_unmap(as, vr->start, vr->size);
1358       if (SOS_OK != retval)                      1418       if (SOS_OK != retval)
1359         {                                        1419         {
1360           sos_umem_vmm_unmap(as, result_uaddr    1420           sos_umem_vmm_unmap(as, result_uaddr, new_size);
1361           return retval;                         1421           return retval;
1362         }                                        1422         }
1363                                                  1423 
1364       *new_uaddr = result_uaddr;                 1424       *new_uaddr = result_uaddr;
1365       return retval;                             1425       return retval;
1366     }                                            1426     }
1367                                                  1427 
1368   /* Otherwise we simply resize the VR, takin    1428   /* Otherwise we simply resize the VR, taking care of unmapping
1369      what's been unmapped  */                    1429      what's been unmapped  */
1370                                                  1430 
1371   if (*new_uaddr + new_size < vr->start + vr-    1431   if (*new_uaddr + new_size < vr->start + vr->size)
1372     sos_umem_vmm_unmap(as, *new_uaddr + new_s    1432     sos_umem_vmm_unmap(as, *new_uaddr + new_size,
1373                        vr->start + vr->size -    1433                        vr->start + vr->size - (*new_uaddr + new_size));
1374   else                                           1434   else
1375     {                                            1435     {
1376       as_account_change_of_vr_protection(as,     1436       as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
1377                                          *new    1437                                          *new_uaddr + new_size
1378                                            -     1438                                            - (vr->start + vr->size),
1379                                          0, v    1439                                          0, vr->access_rights);
1380       vr->size += *new_uaddr + new_size - (vr    1440       vr->size += *new_uaddr + new_size - (vr->start + vr->size);
1381     }                                            1441     }
1382                                                  1442   
1383   if (*new_uaddr > vr->start)                    1443   if (*new_uaddr > vr->start)
1384     sos_umem_vmm_unmap(as, vr->start, *new_ua    1444     sos_umem_vmm_unmap(as, vr->start, *new_uaddr - vr->start);
1385   else                                           1445   else
1386     {                                            1446     {
1387       as_account_change_of_vr_protection(as,     1447       as_account_change_of_vr_protection(as, vr->flags & SOS_VR_MAP_SHARED,
1388                                          vr->    1448                                          vr->start - *new_uaddr,
1389                                          0, v    1449                                          0, vr->access_rights);
1390       vr->size  += vr->start - *new_uaddr;       1450       vr->size  += vr->start - *new_uaddr;
1391       vr->start  = *new_uaddr;                   1451       vr->start  = *new_uaddr;
1392       vr->offset_in_resource = new_offset_in_    1452       vr->offset_in_resource = new_offset_in_resource; 
1393     }                                            1453     }
1394                                                  1454 
1395   SOS_ASSERT_FATAL(vr->start == *new_uaddr);     1455   SOS_ASSERT_FATAL(vr->start == *new_uaddr);
1396   SOS_ASSERT_FATAL(vr->size  == new_size);       1456   SOS_ASSERT_FATAL(vr->size  == new_size);
1397   SOS_ASSERT_FATAL(vr->offset_in_resource ==     1457   SOS_ASSERT_FATAL(vr->offset_in_resource == new_offset_in_resource);
1398                                                  1458 
1399   return SOS_OK;                                 1459   return SOS_OK;
1400 }                                                1460 }
1401                                                  1461 
1402                                                  1462 
1403 sos_ret_t sos_umem_vmm_try_resolve_page_fault    1463 sos_ret_t sos_umem_vmm_try_resolve_page_fault(sos_uaddr_t uaddr,
1404                                                  1464                                               sos_bool_t write_access,
1405                                                  1465                                               sos_bool_t user_access)
1406 {                                                1466 {
1407   struct sos_process     *process = sos_threa    1467   struct sos_process     *process = sos_thread_get_current()->process;
1408   struct sos_umem_vmm_as *as;                    1468   struct sos_umem_vmm_as *as;
1409   struct sos_umem_vmm_vr *vr;                    1469   struct sos_umem_vmm_vr *vr;
1410                                                  1470 
1411   if (! process)                                 1471   if (! process)
1412     return -SOS_EFAULT;                          1472     return -SOS_EFAULT;
1413                                                  1473 
1414   as = sos_process_get_address_space(process)    1474   as = sos_process_get_address_space(process);
1415   if (! as)                                      1475   if (! as)
1416     return -SOS_EFAULT;                          1476     return -SOS_EFAULT;
1417                                                  1477 
1418   vr = find_first_intersecting_vr(as, uaddr,     1478   vr = find_first_intersecting_vr(as, uaddr, 1);
1419   if (! vr)                                      1479   if (! vr)
1420     return -SOS_EFAULT;                          1480     return -SOS_EFAULT;
1421                                                  1481 
1422   /* Write on a read-only VR */                  1482   /* Write on a read-only VR */
1423   if (write_access && !(vr->access_rights & S    1483   if (write_access && !(vr->access_rights & SOS_VM_MAP_PROT_WRITE))
1424     return -SOS_EFAULT;                          1484     return -SOS_EFAULT;
1425                                                  1485 
1426   /* Write on a COW VR */                        1486   /* Write on a COW VR */
1427   if (write_access && !(vr->flags & SOS_VR_MA    1487   if (write_access && !(vr->flags & SOS_VR_MAP_SHARED))
1428     {                                            1488     {
1429       if (SOS_OK == sos_paging_try_resolve_CO    1489       if (SOS_OK == sos_paging_try_resolve_COW(uaddr))
1430         {                                        1490         {
1431           as->pgflt_cow ++;                      1491           as->pgflt_cow ++;
1432           return SOS_OK;                         1492           return SOS_OK;
1433         }                                        1493         }
1434     }                                            1494     }
1435                                                  1495 
1436   /* Ask the underlying resource to resolve t    1496   /* Ask the underlying resource to resolve the page fault */
1437   if (SOS_OK != vr->ops->page_in(vr, uaddr, w    1497   if (SOS_OK != vr->ops->page_in(vr, uaddr, write_access))
1438     {                                            1498     {
1439       as->pgflt_invalid ++;                      1499       as->pgflt_invalid ++;
1440       return -SOS_EFAULT;                        1500       return -SOS_EFAULT;
1441     }                                            1501     }
1442                                                  1502 
1443   as->phys_total += SOS_PAGE_SIZE;               1503   as->phys_total += SOS_PAGE_SIZE;
1444   as->pgflt_page_in ++;                          1504   as->pgflt_page_in ++;
1445                                                  1505 
1446   /* For a private mapping, keep the mapping     1506   /* For a private mapping, keep the mapping read-only */
1447   if (!(vr->flags & SOS_VR_MAP_SHARED))          1507   if (!(vr->flags & SOS_VR_MAP_SHARED))
1448     {                                            1508     {
1449       sos_paging_prepare_COW(SOS_PAGE_ALIGN_I    1509       sos_paging_prepare_COW(SOS_PAGE_ALIGN_INF(uaddr),
1450                              SOS_PAGE_SIZE);     1510                              SOS_PAGE_SIZE);
1451     }                                            1511     }
1452                                                  1512 
1453   return SOS_OK;                                 1513   return SOS_OK;
1454 }                                                1514 }
1455                                                  1515 
1456                                                  1516 
1457 sos_ret_t                                        1517 sos_ret_t
1458 sos_umem_vmm_init_heap(struct sos_umem_vmm_as    1518 sos_umem_vmm_init_heap(struct sos_umem_vmm_as * as,
1459                        sos_uaddr_t heap_start    1519                        sos_uaddr_t heap_start)
1460 {                                                1520 {
1461   SOS_ASSERT_FATAL(! as->heap_start);            1521   SOS_ASSERT_FATAL(! as->heap_start);
1462                                                  1522 
1463   as->heap_start = heap_start;                   1523   as->heap_start = heap_start;
1464   as->heap_size  = 0;                            1524   as->heap_size  = 0;
1465   return SOS_OK;                                 1525   return SOS_OK;
1466 }                                                1526 }
1467                                                  1527 
1468                                                  1528 
1469 sos_uaddr_t                                      1529 sos_uaddr_t
1470 sos_umem_vmm_brk(struct sos_umem_vmm_as * as,    1530 sos_umem_vmm_brk(struct sos_umem_vmm_as * as,
1471                  sos_uaddr_t new_top_uaddr)      1531                  sos_uaddr_t new_top_uaddr)
1472 {                                                1532 {
1473   sos_uaddr_t new_start;                         1533   sos_uaddr_t new_start;
1474   sos_size_t  new_size;                          1534   sos_size_t  new_size;
1475   SOS_ASSERT_FATAL(as->heap_start);              1535   SOS_ASSERT_FATAL(as->heap_start);
1476                                                  1536 
1477   if (! new_top_uaddr)                           1537   if (! new_top_uaddr)
1478     return as->heap_start + as->heap_size;       1538     return as->heap_start + as->heap_size;
1479                                                  1539 
1480   if (new_top_uaddr == as->heap_start + as->h    1540   if (new_top_uaddr == as->heap_start + as->heap_size)
1481     return as->heap_start + as->heap_size;       1541     return as->heap_start + as->heap_size;
1482                                                  1542  
1483   if (new_top_uaddr < as->heap_start)            1543   if (new_top_uaddr < as->heap_start)
1484     return (sos_uaddr_t)NULL;                    1544     return (sos_uaddr_t)NULL;
1485                                                  1545 
1486   new_top_uaddr = SOS_PAGE_ALIGN_SUP(new_top_    1546   new_top_uaddr = SOS_PAGE_ALIGN_SUP(new_top_uaddr);
1487   new_start = as->heap_start;                    1547   new_start = as->heap_start;
1488   new_size  = new_top_uaddr - as->heap_start;    1548   new_size  = new_top_uaddr - as->heap_start;
1489                                                  1549 
1490   /* First call to brk: we must map /dev/zero    1550   /* First call to brk: we must map /dev/zero */
1491   if (! as->heap_size)                           1551   if (! as->heap_size)
1492     {                                            1552     {
1493       if (SOS_OK != sos_dev_zero_map(as, & as    1553       if (SOS_OK != sos_dev_zero_map(as, & as->heap_start,
1494                                      new_size    1554                                      new_size,
1495                                      SOS_VM_M    1555                                      SOS_VM_MAP_PROT_READ
1496                                      | SOS_VM    1556                                      | SOS_VM_MAP_PROT_WRITE,
1497                                      0 /* pri    1557                                      0 /* private non-fixed */))
1498         return (sos_uaddr_t)NULL;                1558         return (sos_uaddr_t)NULL;
1499                                                  1559 
1500       as->heap_size = new_size;                  1560       as->heap_size = new_size;
1501       return as->heap_start + as->heap_size;     1561       return as->heap_start + as->heap_size;
1502     }                                            1562     }
1503                                                  1563 
1504   /* Otherwise we just have to unmap or resiz    1564   /* Otherwise we just have to unmap or resize the region */
1505   if (new_size <= 0)                             1565   if (new_size <= 0)
1506     {                                            1566     {
1507       if (SOS_OK != sos_umem_vmm_unmap(as,       1567       if (SOS_OK != sos_umem_vmm_unmap(as,
1508                                        as->he    1568                                        as->heap_start, as->heap_size))
1509         return (sos_uaddr_t)NULL;                1569         return (sos_uaddr_t)NULL;
1510     }                                            1570     }
1511   else                                           1571   else
1512     {                                            1572     {
1513       if (SOS_OK != sos_umem_vmm_resize(as,      1573       if (SOS_OK != sos_umem_vmm_resize(as,
1514                                         as->h    1574                                         as->heap_start, as->heap_size,
1515                                         & new    1575                                         & new_start, new_size,
1516                                         0))      1576                                         0))
1517         return (sos_uaddr_t)NULL;                1577         return (sos_uaddr_t)NULL;
1518     }                                            1578     }
1519                                                  1579 
1520   SOS_ASSERT_FATAL(new_start == as->heap_star    1580   SOS_ASSERT_FATAL(new_start == as->heap_start);
1521   as->heap_size = new_size;                      1581   as->heap_size = new_size;
1522   return new_top_uaddr;                          1582   return new_top_uaddr;
1523 }                                                1583 }
1524                                                  1584 
1525                                                  1585 
1526 static struct sos_umem_vmm_vr *                  1586 static struct sos_umem_vmm_vr *
1527 find_enclosing_or_next_vr(struct sos_umem_vmm    1587 find_enclosing_or_next_vr(struct sos_umem_vmm_as * as,
1528                           sos_uaddr_t uaddr)     1588                           sos_uaddr_t uaddr)
1529 {                                                1589 {
1530   struct sos_umem_vmm_vr *vr;                    1590   struct sos_umem_vmm_vr *vr;
1531   int nb_vr;                                     1591   int nb_vr;
1532                                                  1592 
1533   if (uaddr < SOS_PAGING_BASE_USER_ADDRESS)      1593   if (uaddr < SOS_PAGING_BASE_USER_ADDRESS)
1534     return NULL;                                 1594     return NULL;
1535   if (uaddr > SOS_PAGING_TOP_USER_ADDRESS)       1595   if (uaddr > SOS_PAGING_TOP_USER_ADDRESS)
1536     return NULL;                                 1596     return NULL;
1537                                                  1597 
1538   list_foreach_named(as->list_vr, vr, nb_vr,     1598   list_foreach_named(as->list_vr, vr, nb_vr, prev_in_as, next_in_as)
1539     {                                            1599     {
1540       /* Equivalent to "if (uaddr < vr->start    1600       /* Equivalent to "if (uaddr < vr->start + vr->size)" but more
1541          robust (resilient to integer overflo    1601          robust (resilient to integer overflows) */
1542       if (uaddr <= vr->start + (vr->size - 1)    1602       if (uaddr <= vr->start + (vr->size - 1))
1543         return vr;                               1603         return vr;
1544     }                                            1604     }
1545                                                  1605 
1546   return NULL;                                   1606   return NULL;
1547 }                                                1607 }
1548                                                  1608 
1549                                                  1609 
1550 static struct sos_umem_vmm_vr *                  1610 static struct sos_umem_vmm_vr *
1551 find_first_intersecting_vr(struct sos_umem_vm    1611 find_first_intersecting_vr(struct sos_umem_vmm_as * as,
1552                            sos_uaddr_t start_    1612                            sos_uaddr_t start_uaddr, sos_size_t size)
1553 {                                                1613 {
1554   struct sos_umem_vmm_vr * vr;                   1614   struct sos_umem_vmm_vr * vr;
1555   vr = find_enclosing_or_next_vr(as, start_ua    1615   vr = find_enclosing_or_next_vr(as, start_uaddr);
1556   if (! vr)                                      1616   if (! vr)
1557     return NULL;                                 1617     return NULL;
1558                                                  1618 
1559   if (start_uaddr + size <= vr->start)           1619   if (start_uaddr + size <= vr->start)
1560     return NULL;                                 1620     return NULL;
1561                                                  1621 
1562   return vr;                                     1622   return vr;
1563 }                                                1623 }
1564                                                  1624 
1565                                                  1625 
1566 static sos_uaddr_t                               1626 static sos_uaddr_t
1567 find_first_free_interval(struct sos_umem_vmm_    1627 find_first_free_interval(struct sos_umem_vmm_as * as,
1568                          sos_uaddr_t hint_uad    1628                          sos_uaddr_t hint_uaddr, sos_size_t size)
1569 {                                                1629 {
1570   struct sos_umem_vmm_vr * initial_vr, * vr;     1630   struct sos_umem_vmm_vr * initial_vr, * vr;
1571                                                  1631 
1572   if (hint_uaddr < SOS_PAGING_BASE_USER_ADDRE    1632   if (hint_uaddr < SOS_PAGING_BASE_USER_ADDRESS)
1573     hint_uaddr = SOS_PAGING_BASE_USER_ADDRESS    1633     hint_uaddr = SOS_PAGING_BASE_USER_ADDRESS;
1574                                                  1634 
1575   if (hint_uaddr > SOS_PAGING_TOP_USER_ADDRES    1635   if (hint_uaddr > SOS_PAGING_TOP_USER_ADDRESS - size + 1)
1576     return (sos_uaddr_t)NULL;                    1636     return (sos_uaddr_t)NULL;
1577                                                  1637 
1578   initial_vr = vr = find_enclosing_or_next_vr    1638   initial_vr = vr = find_enclosing_or_next_vr(as, hint_uaddr);
1579   if (! vr)                                      1639   if (! vr)
1580     /* Great, there is nothing after ! */        1640     /* Great, there is nothing after ! */
1581     return hint_uaddr;                           1641     return hint_uaddr;
1582                                                  1642 
1583   /* Scan the remaining VRs in the list */       1643   /* Scan the remaining VRs in the list */
1584   do                                             1644   do
1585     {                                            1645     {
1586       /* Is there enough space /before/ that     1646       /* Is there enough space /before/ that VR ? */
1587       if (hint_uaddr + size <= vr->start)        1647       if (hint_uaddr + size <= vr->start)
1588         /* Great ! */                            1648         /* Great ! */
1589         return hint_uaddr;                       1649         return hint_uaddr;
1590                                                  1650 
1591       /* Is there any VR /after/ this one, or    1651       /* Is there any VR /after/ this one, or do we have to wrap back
1592          at the begining of the user space ?     1652          at the begining of the user space ? */
1593       if (vr->next_in_as->start >= hint_uaddr    1653       if (vr->next_in_as->start >= hint_uaddr)
1594         /* Ok, the next VR is really after us    1654         /* Ok, the next VR is really after us */
1595         hint_uaddr = vr->start + vr->size;       1655         hint_uaddr = vr->start + vr->size;
1596       else                                       1656       else
1597         {                                        1657         {
1598           /* No: wrapping up */                  1658           /* No: wrapping up */
1599                                                  1659 
1600           /* Is there any space before the en    1660           /* Is there any space before the end of user space ? */
1601           if (hint_uaddr <= SOS_PAGING_TOP_US    1661           if (hint_uaddr <= SOS_PAGING_TOP_USER_ADDRESS - size)
1602             return hint_uaddr;                   1662             return hint_uaddr;
1603                                                  1663 
1604           hint_uaddr = SOS_PAGING_BASE_USER_A    1664           hint_uaddr = SOS_PAGING_BASE_USER_ADDRESS;
1605         }                                        1665         }
1606                                                  1666 
1607       /* Prepare to look after this VR */        1667       /* Prepare to look after this VR */
1608       vr = vr->next_in_as;                       1668       vr = vr->next_in_as;
1609     }                                            1669     }
1610   while (vr != initial_vr);                      1670   while (vr != initial_vr);
1611                                                  1671 
1612   /* Reached the end of the list and did not     1672   /* Reached the end of the list and did not find anything ?... Look
1613      at the space after the last VR */           1673      at the space after the last VR */
1614                                                  1674 
1615   return (sos_uaddr_t)NULL;                      1675   return (sos_uaddr_t)NULL;
1616 }                                                1676 }
1617                                                  1677 
1618                                                  1678 
1619 static void                                      1679 static void
1620 as_account_change_of_vr_protection(struct sos    1680 as_account_change_of_vr_protection(struct sos_umem_vmm_as * as,
1621                                    sos_bool_t    1681                                    sos_bool_t is_shared,
1622                                    sos_size_t    1682                                    sos_size_t size,
1623                                    sos_ui32_t    1683                                    sos_ui32_t prev_access_rights,
1624                                    sos_ui32_t    1684                                    sos_ui32_t new_access_rights)
1625 {                                                1685 {
1626   if (prev_access_rights == new_access_rights    1686   if (prev_access_rights == new_access_rights)
1627     return;                                      1687     return;
1628                                                  1688 
1629 #define _UPDATE_VMSTAT(field,is_increment) \     1689 #define _UPDATE_VMSTAT(field,is_increment) \
1630   ({ if (is_increment > 0) \                     1690   ({ if (is_increment > 0) \
1631        as->field += size; \                      1691        as->field += size; \
1632      else \                                      1692      else \
1633        { SOS_ASSERT_FATAL(as->field >= size);    1693        { SOS_ASSERT_FATAL(as->field >= size); as->field -= size; } })
1634 #define UPDATE_VMSTAT(field,is_increment) \      1694 #define UPDATE_VMSTAT(field,is_increment) \
1635   ({ if (is_shared) _UPDATE_VMSTAT(vm_shrd.fi    1695   ({ if (is_shared) _UPDATE_VMSTAT(vm_shrd.field, is_increment); \
1636      _UPDATE_VMSTAT(vm_total.field, is_increm    1696      _UPDATE_VMSTAT(vm_total.field, is_increment); \
1637      SOS_ASSERT_FATAL(as->vm_total.field >= a    1697      SOS_ASSERT_FATAL(as->vm_total.field >= as->vm_shrd.field); })
1638                                                  1698 
1639   if ( (new_access_rights & SOS_VM_MAP_PROT_W    1699   if ( (new_access_rights & SOS_VM_MAP_PROT_WRITE)
1640        && !(prev_access_rights & SOS_VM_MAP_P    1700        && !(prev_access_rights & SOS_VM_MAP_PROT_WRITE))
1641     {                                            1701     {
1642       UPDATE_VMSTAT(rw, +1);                     1702       UPDATE_VMSTAT(rw, +1);
1643       if (prev_access_rights & SOS_VM_MAP_PRO    1703       if (prev_access_rights & SOS_VM_MAP_PROT_READ)
1644         UPDATE_VMSTAT(ro, -1);                   1704         UPDATE_VMSTAT(ro, -1);
1645     }                                            1705     }
1646   else if ( !(new_access_rights & SOS_VM_MAP_    1706   else if ( !(new_access_rights & SOS_VM_MAP_PROT_WRITE)
1647             && (prev_access_rights & SOS_VM_M    1707             && (prev_access_rights & SOS_VM_MAP_PROT_WRITE))
1648     {                                            1708     {
1649       if (new_access_rights & SOS_VM_MAP_PROT    1709       if (new_access_rights & SOS_VM_MAP_PROT_READ)
1650         UPDATE_VMSTAT(ro, +1);                   1710         UPDATE_VMSTAT(ro, +1);
1651       UPDATE_VMSTAT(rw, -1);                     1711       UPDATE_VMSTAT(rw, -1);
1652     }                                            1712     }
1653   else if (new_access_rights & SOS_VM_MAP_PRO    1713   else if (new_access_rights & SOS_VM_MAP_PROT_READ)
1654     UPDATE_VMSTAT(ro, +1);                       1714     UPDATE_VMSTAT(ro, +1);
1655   else if (!(new_access_rights & SOS_VM_MAP_P    1715   else if (!(new_access_rights & SOS_VM_MAP_PROT_READ))
1656     UPDATE_VMSTAT(ro, -1);                       1716     UPDATE_VMSTAT(ro, -1);
1657                                                  1717 
1658   if ( (new_access_rights & SOS_VM_MAP_PROT_E    1718   if ( (new_access_rights & SOS_VM_MAP_PROT_EXEC)
1659        && !(prev_access_rights & SOS_VM_MAP_P    1719        && !(prev_access_rights & SOS_VM_MAP_PROT_EXEC))
1660     {                                            1720     {
1661       UPDATE_VMSTAT(code, +1);                   1721       UPDATE_VMSTAT(code, +1);
1662     }                                            1722     }
1663   else if ( !(new_access_rights & SOS_VM_MAP_    1723   else if ( !(new_access_rights & SOS_VM_MAP_PROT_EXEC)
1664             && (prev_access_rights & SOS_VM_M    1724             && (prev_access_rights & SOS_VM_MAP_PROT_EXEC))
1665     {                                            1725     {
1666       UPDATE_VMSTAT(code, -1);                   1726       UPDATE_VMSTAT(code, -1);
1667     }                                            1727     }
1668                                                  1728 
1669   if (new_access_rights && !prev_access_right    1729   if (new_access_rights && !prev_access_rights)
1670     UPDATE_VMSTAT(overall, +1);                  1730     UPDATE_VMSTAT(overall, +1);
1671   else if (!new_access_rights && prev_access_    1731   else if (!new_access_rights && prev_access_rights)
1672     UPDATE_VMSTAT(overall, -1);                  1732     UPDATE_VMSTAT(overall, -1);
1673                                                  1733 
1674 }                                                1734 }
                                                      

source navigation ] diff markup ] identifier search ] general search ]