KernelLand/Kernel/vfs/mmap.c

   1 /*
   2  * Acess2 Kernel VFS
   3  * - By John Hodge (thePowersGang)
   4  *
   5  * mmap.c
   6  * - VFS_MMap support
   7  */
   8 #define DEBUG   0
   9 #include <acess.h>
  10 #include <vfs.h>
  11 #include <vfs_ext.h>
  12 #include <vfs_int.h>
  13
  14 #define MMAP_PAGES_PER_BLOCK    16
  15
  16 // === STRUCTURES ===
  17 typedef struct sVFS_MMapPageBlock       tVFS_MMapPageBlock;
  18 struct sVFS_MMapPageBlock
  19 {
  20         tVFS_MMapPageBlock      *Next;
  21         Uint64  BaseOffset;     // Must be a multiple of MMAP_PAGES_PER_BLOCK*PAGE_SIZE
  22         tPAddr  PhysAddrs[MMAP_PAGES_PER_BLOCK];
  23 };
  24
  25 // === CODE ===
  26 void *VFS_MMap(void *DestHint, size_t Length, int Protection, int Flags, int FD, Uint64 Offset)
  27 {
  28         tVFS_Handle     *h;
  29         tVAddr  mapping_dest, mapping_base;
  30          int    npages, pagenum;
  31         tVFS_MMapPageBlock      *pb, *prev;
  32
  33         ENTER("pDestHint iLength xProtection xFlags xFD XOffset", DestHint, Length, Protection, Flags, FD, Offset);
  34
  35         if( Flags & MMAP_MAP_ANONYMOUS )
  36                 Offset = (tVAddr)DestHint & 0xFFF;
  37
  38         npages = ((Offset & (PAGE_SIZE-1)) + Length + (PAGE_SIZE - 1)) / PAGE_SIZE;
  39         pagenum = Offset / PAGE_SIZE;
  40
  41         mapping_base = (tVAddr)DestHint;
  42         mapping_dest = mapping_base & ~(PAGE_SIZE-1);
  43
  44         // TODO: Locate space for the allocation
  45
  46         // Handle anonymous mappings
  47         if( Flags & MMAP_MAP_ANONYMOUS )
  48         {
  49                 size_t  ofs = 0;
  50                 LOG("%i pages anonymous to %p", npages, mapping_dest);
  51                 for( ; npages --; mapping_dest += PAGE_SIZE, ofs += PAGE_SIZE )
  52                 {
  53                         if( MM_GetPhysAddr((void*)mapping_dest) ) {
  54                                 // TODO: Set flags to COW if needed (well, if shared)
  55                                 MM_SetFlags(mapping_dest, MM_PFLAG_COW, MM_PFLAG_COW);
  56                                 LOG("clear from %p, %i bytes", (void*)(mapping_base + ofs),
  57                                         PAGE_SIZE - (mapping_base & (PAGE_SIZE-1))
  58                                         );
  59                                 memset( (void*)(mapping_base + ofs), 0, PAGE_SIZE - (mapping_base & (PAGE_SIZE-1)));
  60                                 LOG("dune");
  61                         }
  62                         else {
  63                                 LOG("New empty page");
  64                                 // TODO: Map a COW zero page instead
  65                                 if( !MM_Allocate(mapping_dest) ) {
  66                                         // TODO: Error
  67                                         Log_Warning("VFS", "VFS_MMap: Anon alloc to %p failed", mapping_dest);
  68                                 }
  69                                 memset((void*)mapping_dest, 0, PAGE_SIZE);
  70                                 LOG("Anon map to %p", mapping_dest);
  71                         }
  72                 }
  73                 LEAVE_RET('p', (void*)mapping_base);
  74         }
  75
  76         h = VFS_GetHandle(FD);
  77         if( !h || !h->Node )    LEAVE_RET('n', NULL);
  78
  79         LOG("h = %p", h);
  80
  81         Mutex_Acquire( &h->Node->Lock );
  82
  83         // Search for existing mapping for each page
  84         // - Sorted list of 16 page blocks
  85         for(
  86                 pb = h->Node->MMapInfo, prev = NULL;
  87                 pb && pb->BaseOffset + MMAP_PAGES_PER_BLOCK < pagenum;
  88                 prev = pb, pb = pb->Next
  89                 );
  90
  91         LOG("pb = %p, pb->BaseOffset = %X", pb, pb ? pb->BaseOffset : 0);
  92
  93         // - Allocate a block if needed
  94         if( !pb || pb->BaseOffset > pagenum )
  95         {
  96                 void    *old_pb = pb;
  97                 pb = calloc( 1, sizeof(tVFS_MMapPageBlock) );
  98                 if(!pb) {
  99                         Mutex_Release( &h->Node->Lock );
 100                         LEAVE_RET('n', NULL);
 101                 }
 102                 pb->Next = old_pb;
 103                 pb->BaseOffset = pagenum - pagenum % MMAP_PAGES_PER_BLOCK;
 104                 if(prev)
 105                         prev->Next = pb;
 106                 else
 107                         h->Node->MMapInfo = pb;
 108         }
 109
 110         // - Map (and allocate) pages
 111         while( npages -- )
 112         {
 113                 if( MM_GetPhysAddr( (void*)mapping_dest ) == 0 )
 114                 {
 115                         if( pb->PhysAddrs[pagenum - pb->BaseOffset] == 0 )
 116                         {
 117                                 tVFS_NodeType   *nt = h->Node->Type;
 118                                 if( !nt )
 119                                 {
 120                                         // TODO: error
 121                                 }
 122                                 else if( nt->MMap )
 123                                         nt->MMap(h->Node, pagenum*PAGE_SIZE, PAGE_SIZE, (void*)mapping_dest);
 124                                 else
 125                                 {
 126                                          int    read_len;
 127                                         // Allocate pages and read data
 128                                         if( MM_Allocate(mapping_dest) == 0 ) {
 129                                                 // TODO: Unwrap
 130                                                 Mutex_Release( &h->Node->Lock );
 131                                                 LEAVE('n');
 132                                                 return NULL;
 133                                         }
 134                                         // TODO: Clip read length
 135                                         read_len = nt->Read(h->Node, pagenum*PAGE_SIZE, PAGE_SIZE, (void*)mapping_dest);
 136                                         // TODO: This was commented out, why?
 137                                         if( read_len != PAGE_SIZE ) {
 138                                                 memset( (void*)(mapping_dest+read_len), 0, PAGE_SIZE-read_len );
 139                                         }
 140                                 }
 141                                 pb->PhysAddrs[pagenum - pb->BaseOffset] = MM_GetPhysAddr( (void*)mapping_dest );
 142                                 MM_SetPageNode( pb->PhysAddrs[pagenum - pb->BaseOffset], h->Node );
 143                                 MM_RefPhys( pb->PhysAddrs[pagenum - pb->BaseOffset] );
 144                                 LOG("Read and map %X to %p (%P)", pagenum*PAGE_SIZE, mapping_dest,
 145                                         pb->PhysAddrs[pagenum - pb->BaseOffset]);
 146                         }
 147                         else
 148                         {
 149                                 MM_Map( mapping_dest, pb->PhysAddrs[pagenum - pb->BaseOffset] );
 150                                 MM_RefPhys( pb->PhysAddrs[pagenum - pb->BaseOffset] );
 151                                 LOG("Cached map %X to %p (%P)", pagenum*PAGE_SIZE, mapping_dest,
 152                                         pb->PhysAddrs[pagenum - pb->BaseOffset]);
 153                         }
 154                         h->Node->ReferenceCount ++;
 155
 156                         // Set flags
 157                         if( !(Protection & MMAP_PROT_WRITE) ) {
 158                                 MM_SetFlags(mapping_dest, MM_PFLAG_RO, MM_PFLAG_RO);
 159                         }
 160                         else {
 161                                 MM_SetFlags(mapping_dest, 0, MM_PFLAG_RO);
 162                         }
 163
 164                         if( Protection & MMAP_PROT_EXEC ) {
 165                                 MM_SetFlags(mapping_dest, MM_PFLAG_EXEC, MM_PFLAG_EXEC);
 166                         }
 167                         else {
 168                                 MM_SetFlags(mapping_dest, 0, MM_PFLAG_EXEC);
 169                         }
 170                 }
 171                 else
 172                 {
 173                         LOG("Flag update on %p", mapping_dest);
 174                         if( (MM_GetFlags(mapping_dest) & MM_PFLAG_RO) && (Protection & MMAP_PROT_WRITE) )
 175                         {
 176                                 MM_SetFlags(mapping_dest, 0, MM_PFLAG_RO);
 177                         }
 178                 }
 179                 if( Flags & MMAP_MAP_PRIVATE )
 180                         MM_SetFlags(mapping_dest, MM_PFLAG_COW, MM_PFLAG_COW);
 181                 pagenum ++;
 182                 mapping_dest += PAGE_SIZE;
 183
 184                 // Roll on to next block if needed
 185                 if(pagenum - pb->BaseOffset == MMAP_PAGES_PER_BLOCK)
 186                 {
 187                         if( pb->Next && pb->Next->BaseOffset == pagenum )
 188                                 pb = pb->Next;
 189                         else
 190                         {
 191                                 tVFS_MMapPageBlock      *oldpb = pb;
 192                                 pb = malloc( sizeof(tVFS_MMapPageBlock) );
 193                                 pb->Next = oldpb->Next;
 194                                 pb->BaseOffset = pagenum;
 195                                 memset(pb->PhysAddrs, 0, sizeof(pb->PhysAddrs));
 196                                 oldpb->Next = pb;
 197                         }
 198                 }
 199         }
 200
 201         Mutex_Release( &h->Node->Lock );
 202
 203         LEAVE('p', mapping_base);
 204         return (void*)mapping_base;
 205 }
 206
 207 int VFS_MUnmap(void *Addr, size_t Length)
 208 {
 209         return 0;
 210 }