3 * Copyright (C) 2006-2008 Aleksey Bragin <aleksey@reactos.org>
4 * Copyright (C) 2006-2009 Hervé Poussineau <hpoussin@reactos.org>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
24 DBG_DEFAULT_CHANNEL(MEMORY
);
31 } FREELDR_MEMORY_TYPE
, *PFREELDR_MEMORY_TYPE
;
33 FREELDR_MEMORY_TYPE MemoryTypeArray
[] =
35 { LoaderMaximum
, "Unknown memory" },
36 { LoaderFree
, "Free memory" },
37 { LoaderBad
, "Bad memory" },
38 { LoaderLoadedProgram
, "LoadedProgram" },
39 { LoaderFirmwareTemporary
, "FirmwareTemporary" },
40 { LoaderFirmwarePermanent
, "FirmwarePermanent" },
41 { LoaderOsloaderHeap
, "OsloaderHeap" },
42 { LoaderOsloaderStack
, "OsloaderStack" },
43 { LoaderSystemCode
, "SystemCode" },
44 { LoaderHalCode
, "HalCode" },
45 { LoaderBootDriver
, "BootDriver" },
46 { LoaderRegistryData
, "RegistryData" },
47 { LoaderMemoryData
, "MemoryData" },
48 { LoaderNlsData
, "NlsData" },
49 { LoaderSpecialMemory
, "SpecialMemory" },
50 { LoaderReserve
, "Reserve" },
52 ULONG MemoryTypeCount
= sizeof(MemoryTypeArray
) / sizeof(MemoryTypeArray
[0]);
55 PVOID PageLookupTableAddress
= NULL
;
56 PFN_NUMBER TotalPagesInLookupTable
= 0;
57 PFN_NUMBER FreePagesInLookupTable
= 0;
58 PFN_NUMBER LastFreePageHint
= 0;
59 PFN_NUMBER MmLowestPhysicalPage
= 0xFFFFFFFF;
60 PFN_NUMBER MmHighestPhysicalPage
= 0;
62 PFREELDR_MEMORY_DESCRIPTOR BiosMemoryMap
;
63 ULONG BiosMemoryMapEntryCount
;
65 extern ULONG_PTR MmHeapPointer
;
66 extern ULONG_PTR MmHeapStart
;
70 IN OUT PFREELDR_MEMORY_DESCRIPTOR List
,
72 IN PFN_NUMBER BasePage
,
73 IN PFN_NUMBER PageCount
,
74 IN TYPE_OF_MEMORY MemoryType
)
78 TRACE("AddMemoryDescriptor(0x%lx-0x%lx [0x%lx pages])\n",
79 BasePage
, BasePage
+ PageCount
, PageCount
);
81 /* Scan through all existing descriptors */
82 for (i
= 0, c
= 0; (c
< MaxCount
) && (List
[c
].PageCount
!= 0); c
++)
84 /* Count entries completely below the new range */
85 if (List
[i
].BasePage
+ List
[i
].PageCount
<= BasePage
) i
++;
88 /* Check if the list is full */
89 if (c
>= MaxCount
) return c
;
91 /* Is there an existing descriptor starting before the new range */
92 while ((i
< c
) && (List
[i
].BasePage
<= BasePage
))
94 /* The end of the existing one is the minimum for the new range */
95 NextBase
= List
[i
].BasePage
+ List
[i
].PageCount
;
97 /* Bail out, if everything is trimmed away */
98 if ((BasePage
+ PageCount
) <= NextBase
) return c
;
100 /* Trim the naew range at the lower end */
101 PageCount
-= (NextBase
- BasePage
);
104 /* Go to the next entry and repeat */
108 ASSERT(PageCount
> 0);
110 /* Are there still entries above? */
113 /* Shift the following entries one up */
114 RtlMoveMemory(&List
[i
+1], &List
[i
], (c
- i
) * sizeof(List
[0]));
116 /* Insert the new range */
117 List
[i
].BasePage
= BasePage
;
118 List
[i
].PageCount
= min(PageCount
, List
[i
+1].BasePage
- BasePage
);
119 List
[i
].MemoryType
= MemoryType
;
122 TRACE("Inserting at i=%ld: (0x%lx:0x%lx)\n",
123 i
, List
[i
].BasePage
, List
[i
].PageCount
);
125 /* Check if the range was trimmed */
126 if (PageCount
> List
[i
].PageCount
)
128 /* Recursively process the trimmed part */
129 c
= AddMemoryDescriptor(List
,
131 BasePage
+ List
[i
].PageCount
,
132 PageCount
- List
[i
].PageCount
,
138 /* We can simply add the range here */
139 TRACE("Adding i=%ld: (0x%lx:0x%lx)\n", i
, BasePage
, PageCount
);
140 List
[i
].BasePage
= BasePage
;
141 List
[i
].PageCount
= PageCount
;
142 List
[i
].MemoryType
= MemoryType
;
146 /* Return the new count */
150 const FREELDR_MEMORY_DESCRIPTOR
*
151 ArcGetMemoryDescriptor(const FREELDR_MEMORY_DESCRIPTOR
* Current
)
155 return BiosMemoryMap
;
160 if (Current
->PageCount
== 0) return NULL
;
167 MmCheckFreeldrImageFile()
169 PIMAGE_NT_HEADERS NtHeaders
;
170 PIMAGE_FILE_HEADER FileHeader
;
171 PIMAGE_OPTIONAL_HEADER OptionalHeader
;
173 /* Get the NT headers */
174 NtHeaders
= RtlImageNtHeader(&__ImageBase
);
177 ERR("Could not get NtHeaders!\n");
181 /* Check the file header */
182 FileHeader
= &NtHeaders
->FileHeader
;
183 if ((FileHeader
->Machine
!= IMAGE_FILE_MACHINE_NATIVE
) ||
184 (FileHeader
->NumberOfSections
!= FREELDR_SECTION_COUNT
) ||
185 (FileHeader
->PointerToSymbolTable
!= 0) ||
186 (FileHeader
->NumberOfSymbols
!= 0) ||
187 (FileHeader
->SizeOfOptionalHeader
!= sizeof(IMAGE_OPTIONAL_HEADER
)))
189 ERR("FreeLdr FileHeader is invalid.\n");
190 BugCheckInfo
[0] = FileHeader
->Machine
;
191 BugCheckInfo
[1] = FileHeader
->NumberOfSections
;
192 BugCheckInfo
[2] = FileHeader
->PointerToSymbolTable
;
193 BugCheckInfo
[3] = FileHeader
->NumberOfSymbols
;
194 BugCheckInfo
[4] = FileHeader
->SizeOfOptionalHeader
;
198 /* Check the optional header */
199 OptionalHeader
= &NtHeaders
->OptionalHeader
;
200 if ((OptionalHeader
->Magic
!= IMAGE_NT_OPTIONAL_HDR_MAGIC
) ||
201 (OptionalHeader
->Subsystem
!= 1) || // native
202 (OptionalHeader
->ImageBase
!= FREELDR_PE_BASE
) ||
203 (OptionalHeader
->SizeOfImage
> MAX_FREELDR_PE_SIZE
) ||
204 (OptionalHeader
->SectionAlignment
!= OptionalHeader
->FileAlignment
))
206 ERR("FreeLdr OptionalHeader is invalid.\n");
207 BugCheckInfo
[0] = 0x80000000 | (OptionalHeader
->Subsystem
<< 16) | OptionalHeader
->Magic
;
208 BugCheckInfo
[1] = OptionalHeader
->ImageBase
;
209 BugCheckInfo
[2] = OptionalHeader
->SizeOfImage
;
210 BugCheckInfo
[3] = OptionalHeader
->SectionAlignment
;
211 BugCheckInfo
[4] = OptionalHeader
->FileAlignment
;
218 BOOLEAN
MmInitializeMemoryManager(VOID
)
221 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
224 TRACE("Initializing Memory Manager.\n");
226 /* Check the freeldr binary */
227 if (!MmCheckFreeldrImageFile())
229 FrLdrBugCheck(FREELDR_IMAGE_CORRUPTION
);
232 BiosMemoryMap
= MachVtbl
.GetMemoryMap(&BiosMemoryMapEntryCount
);
235 // Dump the system memory map
236 TRACE("System Memory Map (Base Address, Length, Type):\n");
237 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
239 TRACE("%x\t %x\t %s\n",
240 MemoryDescriptor
->BasePage
* MM_PAGE_SIZE
,
241 MemoryDescriptor
->PageCount
* MM_PAGE_SIZE
,
242 MmGetSystemMemoryMapTypeString(MemoryDescriptor
->MemoryType
));
246 // Find address for the page lookup table
247 TotalPagesInLookupTable
= MmGetAddressablePageCountIncludingHoles();
248 PageLookupTableAddress
= MmFindLocationForPageLookupTable(TotalPagesInLookupTable
);
249 LastFreePageHint
= MmHighestPhysicalPage
;
251 if (PageLookupTableAddress
== 0)
253 // If we get here then we probably couldn't
254 // find a contiguous chunk of memory big
255 // enough to hold the page lookup table
256 printf("Error initializing memory manager!\n");
260 // Initialize the page lookup table
261 MmInitPageLookupTable(PageLookupTableAddress
, TotalPagesInLookupTable
);
263 MmUpdateLastFreePageHint(PageLookupTableAddress
, TotalPagesInLookupTable
);
265 FreePagesInLookupTable
= MmCountFreePagesInLookupTable(PageLookupTableAddress
,
266 TotalPagesInLookupTable
);
268 MmInitializeHeap(PageLookupTableAddress
);
270 TRACE("Memory Manager initialized. 0x%x pages available.\n", FreePagesInLookupTable
);
277 PCSTR
MmGetSystemMemoryMapTypeString(TYPE_OF_MEMORY Type
)
281 for (Index
=1; Index
<MemoryTypeCount
; Index
++)
283 if (MemoryTypeArray
[Index
].Type
== Type
)
285 return MemoryTypeArray
[Index
].TypeString
;
289 return MemoryTypeArray
[0].TypeString
;
293 PFN_NUMBER
MmGetPageNumberFromAddress(PVOID Address
)
295 return ((ULONG_PTR
)Address
) / MM_PAGE_SIZE
;
298 PFN_NUMBER
MmGetAddressablePageCountIncludingHoles(VOID
)
300 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
301 PFN_NUMBER PageCount
;
304 // Go through the whole memory map to get max address
306 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
309 // Check if we got a higher end page address
311 if (MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
> MmHighestPhysicalPage
)
314 // Yes, remember it if this is real memory
316 if (MemoryDescriptor
->MemoryType
== LoaderFree
)
317 MmHighestPhysicalPage
= MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
;
321 // Check if we got a higher (usable) start page address
323 if (MemoryDescriptor
->BasePage
< MmLowestPhysicalPage
)
326 // Yes, remember it if this is real memory
328 MmLowestPhysicalPage
= MemoryDescriptor
->BasePage
;
332 TRACE("lo/hi %lx %lx\n", MmLowestPhysicalPage
, MmHighestPhysicalPage
);
333 PageCount
= MmHighestPhysicalPage
- MmLowestPhysicalPage
;
334 TRACE("MmGetAddressablePageCountIncludingHoles() returning 0x%x\n", PageCount
);
338 PVOID
MmFindLocationForPageLookupTable(PFN_NUMBER TotalPageCount
)
340 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
341 SIZE_T PageLookupTableSize
;
342 PFN_NUMBER PageLookupTablePages
;
343 PFN_NUMBER PageLookupTableStartPage
= 0;
344 PVOID PageLookupTableMemAddress
= NULL
;
346 // Calculate how much pages we need to keep the page lookup table
347 PageLookupTableSize
= TotalPageCount
* sizeof(PAGE_LOOKUP_TABLE_ITEM
);
348 PageLookupTablePages
= PageLookupTableSize
/ MM_PAGE_SIZE
;
350 // Search the highest memory block big enough to contain lookup table
351 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
353 // Continue, if memory is not free
354 if (MemoryDescriptor
->MemoryType
!= LoaderFree
) continue;
356 // Continue, if the block is not big enough?
357 if (MemoryDescriptor
->PageCount
< PageLookupTablePages
) continue;
359 // Continue, if it is not at a higher address than previous address
360 if (MemoryDescriptor
->BasePage
< PageLookupTableStartPage
) continue;
362 // Continue, if the address is too high
363 if (MemoryDescriptor
->BasePage
>= MM_MAX_PAGE
) continue;
365 // Memory block is more suitable than the previous one
366 PageLookupTableStartPage
= MemoryDescriptor
->BasePage
;
367 PageLookupTableMemAddress
= (PVOID
)((ULONG_PTR
)
368 (MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
) * MM_PAGE_SIZE
369 - PageLookupTableSize
);
372 TRACE("MmFindLocationForPageLookupTable() returning 0x%x\n", PageLookupTableMemAddress
);
374 return PageLookupTableMemAddress
;
377 VOID
MmInitPageLookupTable(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
)
379 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
380 PFN_NUMBER PageLookupTableStartPage
;
381 PFN_NUMBER PageLookupTablePageCount
;
383 TRACE("MmInitPageLookupTable()\n");
385 // Mark every page as allocated initially
386 // We will go through and mark pages again according to the memory map
387 // But this will mark any holes not described in the map as allocated
388 MmMarkPagesInLookupTable(PageLookupTable
, MmLowestPhysicalPage
, TotalPageCount
, LoaderFirmwarePermanent
);
390 // Parse the whole memory map
391 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
393 // Mark used pages in the lookup table
395 if (MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
<= TotalPageCount
)
397 TRACE("Marking pages 0x%lx-0x%lx as type %s\n",
398 MemoryDescriptor
->BasePage
,
399 MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
,
400 MmGetSystemMemoryMapTypeString(MemoryDescriptor
->MemoryType
));
401 MmMarkPagesInLookupTable(PageLookupTable
,
402 MemoryDescriptor
->BasePage
,
403 MemoryDescriptor
->PageCount
,
404 MemoryDescriptor
->MemoryType
);
407 TRACE("Ignoring pages 0x%lx-0x%lx (%s)\n",
408 MemoryDescriptor
->BasePage
,
409 MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
,
410 MmGetSystemMemoryMapTypeString(MemoryDescriptor
->MemoryType
));
413 // Mark the pages that the lookup table occupies as reserved
414 PageLookupTableStartPage
= MmGetPageNumberFromAddress(PageLookupTable
);
415 PageLookupTablePageCount
= MmGetPageNumberFromAddress((PVOID
)((ULONG_PTR
)PageLookupTable
+ ROUND_UP(TotalPageCount
* sizeof(PAGE_LOOKUP_TABLE_ITEM
), MM_PAGE_SIZE
))) - PageLookupTableStartPage
;
416 TRACE("Marking the page lookup table pages as reserved StartPage: 0x%x PageCount: 0x%x\n", PageLookupTableStartPage
, PageLookupTablePageCount
);
417 MmMarkPagesInLookupTable(PageLookupTable
, PageLookupTableStartPage
, PageLookupTablePageCount
, LoaderFirmwareTemporary
);
420 VOID
MmMarkPagesInLookupTable(PVOID PageLookupTable
, PFN_NUMBER StartPage
, PFN_NUMBER PageCount
, TYPE_OF_MEMORY PageAllocated
)
422 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
424 TRACE("MmMarkPagesInLookupTable()\n");
426 /* Validate the range */
427 if ((StartPage
< MmLowestPhysicalPage
) ||
428 ((StartPage
+ PageCount
- 1) > MmHighestPhysicalPage
))
430 ERR("Memory (0x%lx:0x%lx) outside of lookup table! Valid range: 0x%lx-0x%lx.\n",
431 StartPage
, PageCount
, MmLowestPhysicalPage
, MmHighestPhysicalPage
);
435 StartPage
-= MmLowestPhysicalPage
;
436 for (Index
=StartPage
; Index
<(StartPage
+PageCount
); Index
++)
439 if ((Index
<= (StartPage
+ 16)) || (Index
>= (StartPage
+PageCount
-16)))
441 TRACE("Index = 0x%x StartPage = 0x%x PageCount = 0x%x\n", Index
, StartPage
, PageCount
);
444 RealPageLookupTable
[Index
].PageAllocated
= PageAllocated
;
445 RealPageLookupTable
[Index
].PageAllocationLength
= (PageAllocated
!= LoaderFree
) ? 1 : 0;
447 TRACE("MmMarkPagesInLookupTable() Done\n");
450 VOID
MmAllocatePagesInLookupTable(PVOID PageLookupTable
, PFN_NUMBER StartPage
, PFN_NUMBER PageCount
, TYPE_OF_MEMORY MemoryType
)
452 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
455 StartPage
-= MmLowestPhysicalPage
;
456 for (Index
=StartPage
; Index
<(StartPage
+PageCount
); Index
++)
458 RealPageLookupTable
[Index
].PageAllocated
= MemoryType
;
459 RealPageLookupTable
[Index
].PageAllocationLength
= (Index
== StartPage
) ? PageCount
: 0;
463 PFN_NUMBER
MmCountFreePagesInLookupTable(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
)
465 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
467 PFN_NUMBER FreePageCount
;
470 for (Index
=0; Index
<TotalPageCount
; Index
++)
472 if (RealPageLookupTable
[Index
].PageAllocated
== LoaderFree
)
478 return FreePageCount
;
481 PFN_NUMBER
MmFindAvailablePages(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
, PFN_NUMBER PagesNeeded
, BOOLEAN FromEnd
)
483 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
484 PFN_NUMBER AvailablePagesSoFar
;
487 if (LastFreePageHint
> TotalPageCount
)
489 LastFreePageHint
= TotalPageCount
;
492 AvailablePagesSoFar
= 0;
495 /* Allocate "high" (from end) pages */
496 for (Index
=LastFreePageHint
-1; Index
>0; Index
--)
498 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)
500 AvailablePagesSoFar
= 0;
505 AvailablePagesSoFar
++;
508 if (AvailablePagesSoFar
>= PagesNeeded
)
510 return Index
+ MmLowestPhysicalPage
;
516 TRACE("Alloc low memory, LastFreePageHint 0x%x, TPC 0x%x\n", LastFreePageHint
, TotalPageCount
);
517 /* Allocate "low" pages */
518 for (Index
=1; Index
< LastFreePageHint
; Index
++)
520 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)
522 AvailablePagesSoFar
= 0;
527 AvailablePagesSoFar
++;
530 if (AvailablePagesSoFar
>= PagesNeeded
)
532 return Index
- AvailablePagesSoFar
+ 1 + MmLowestPhysicalPage
;
540 PFN_NUMBER
MmFindAvailablePagesBeforePage(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
, PFN_NUMBER PagesNeeded
, PFN_NUMBER LastPage
)
542 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
543 PFN_NUMBER AvailablePagesSoFar
;
546 if (LastPage
> TotalPageCount
)
548 return MmFindAvailablePages(PageLookupTable
, TotalPageCount
, PagesNeeded
, TRUE
);
551 AvailablePagesSoFar
= 0;
552 for (Index
=LastPage
-1; Index
>0; Index
--)
554 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)
556 AvailablePagesSoFar
= 0;
561 AvailablePagesSoFar
++;
564 if (AvailablePagesSoFar
>= PagesNeeded
)
566 return Index
+ MmLowestPhysicalPage
;
573 VOID
MmUpdateLastFreePageHint(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
)
575 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
578 for (Index
=TotalPageCount
-1; Index
>0; Index
--)
580 if (RealPageLookupTable
[Index
].PageAllocated
== LoaderFree
)
582 LastFreePageHint
= Index
+ 1 + MmLowestPhysicalPage
;
588 BOOLEAN
MmAreMemoryPagesAvailable(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
, PVOID PageAddress
, PFN_NUMBER PageCount
)
590 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
591 PFN_NUMBER StartPage
;
594 StartPage
= MmGetPageNumberFromAddress(PageAddress
);
596 if (StartPage
< MmLowestPhysicalPage
) return FALSE
;
598 StartPage
-= MmLowestPhysicalPage
;
600 // Make sure they aren't trying to go past the
601 // end of availabe memory
602 if ((StartPage
+ PageCount
) > TotalPageCount
)
607 for (Index
= StartPage
; Index
< (StartPage
+ PageCount
); Index
++)
609 // If this page is allocated then there obviously isn't
610 // memory availabe so return FALSE
611 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)