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("Coult 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
->NumberOfSymbols
!= 0) ||
188 (FileHeader
->SizeOfOptionalHeader
!= 0xE0))
193 /* Check the optional header */
194 OptionalHeader
= &NtHeaders
->OptionalHeader
;
195 if ((OptionalHeader
->Magic
!= IMAGE_NT_OPTIONAL_HDR_MAGIC
) ||
196 (OptionalHeader
->Subsystem
!= 1) || // native
197 (OptionalHeader
->ImageBase
!= FREELDR_PE_BASE
) ||
198 (OptionalHeader
->SizeOfImage
> MAX_FREELDR_PE_SIZE
) ||
199 (OptionalHeader
->SectionAlignment
!= OptionalHeader
->FileAlignment
))
207 BOOLEAN
MmInitializeMemoryManager(VOID
)
210 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
213 TRACE("Initializing Memory Manager.\n");
215 /* Check the freeldr binary */
216 if (!MmCheckFreeldrImageFile())
218 FrLdrBugCheck(FREELDR_IMAGE_CORRUPTION
);
221 BiosMemoryMap
= MachVtbl
.GetMemoryMap(&BiosMemoryMapEntryCount
);
224 // Dump the system memory map
225 TRACE("System Memory Map (Base Address, Length, Type):\n");
226 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
228 TRACE("%x\t %x\t %s\n",
229 MemoryDescriptor
->BasePage
* MM_PAGE_SIZE
,
230 MemoryDescriptor
->PageCount
* MM_PAGE_SIZE
,
231 MmGetSystemMemoryMapTypeString(MemoryDescriptor
->MemoryType
));
235 // Find address for the page lookup table
236 TotalPagesInLookupTable
= MmGetAddressablePageCountIncludingHoles();
237 PageLookupTableAddress
= MmFindLocationForPageLookupTable(TotalPagesInLookupTable
);
238 LastFreePageHint
= MmHighestPhysicalPage
;
240 if (PageLookupTableAddress
== 0)
242 // If we get here then we probably couldn't
243 // find a contiguous chunk of memory big
244 // enough to hold the page lookup table
245 printf("Error initializing memory manager!\n");
249 // Initialize the page lookup table
250 MmInitPageLookupTable(PageLookupTableAddress
, TotalPagesInLookupTable
);
252 MmUpdateLastFreePageHint(PageLookupTableAddress
, TotalPagesInLookupTable
);
254 FreePagesInLookupTable
= MmCountFreePagesInLookupTable(PageLookupTableAddress
,
255 TotalPagesInLookupTable
);
257 MmInitializeHeap(PageLookupTableAddress
);
259 TRACE("Memory Manager initialized. 0x%x pages available.\n", FreePagesInLookupTable
);
266 PCSTR
MmGetSystemMemoryMapTypeString(TYPE_OF_MEMORY Type
)
270 for (Index
=1; Index
<MemoryTypeCount
; Index
++)
272 if (MemoryTypeArray
[Index
].Type
== Type
)
274 return MemoryTypeArray
[Index
].TypeString
;
278 return MemoryTypeArray
[0].TypeString
;
282 PFN_NUMBER
MmGetPageNumberFromAddress(PVOID Address
)
284 return ((ULONG_PTR
)Address
) / MM_PAGE_SIZE
;
287 PFN_NUMBER
MmGetAddressablePageCountIncludingHoles(VOID
)
289 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
290 PFN_NUMBER PageCount
;
293 // Go through the whole memory map to get max address
295 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
298 // Check if we got a higher end page address
300 if (MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
> MmHighestPhysicalPage
)
303 // Yes, remember it if this is real memory
305 if (MemoryDescriptor
->MemoryType
== LoaderFree
)
306 MmHighestPhysicalPage
= MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
;
310 // Check if we got a higher (usable) start page address
312 if (MemoryDescriptor
->BasePage
< MmLowestPhysicalPage
)
315 // Yes, remember it if this is real memory
317 MmLowestPhysicalPage
= MemoryDescriptor
->BasePage
;
321 TRACE("lo/hi %lx %lx\n", MmLowestPhysicalPage
, MmHighestPhysicalPage
);
322 PageCount
= MmHighestPhysicalPage
- MmLowestPhysicalPage
;
323 TRACE("MmGetAddressablePageCountIncludingHoles() returning 0x%x\n", PageCount
);
327 PVOID
MmFindLocationForPageLookupTable(PFN_NUMBER TotalPageCount
)
329 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
330 SIZE_T PageLookupTableSize
;
331 PFN_NUMBER PageLookupTablePages
;
332 PFN_NUMBER PageLookupTableStartPage
= 0;
333 PVOID PageLookupTableMemAddress
= NULL
;
335 // Calculate how much pages we need to keep the page lookup table
336 PageLookupTableSize
= TotalPageCount
* sizeof(PAGE_LOOKUP_TABLE_ITEM
);
337 PageLookupTablePages
= PageLookupTableSize
/ MM_PAGE_SIZE
;
339 // Search the highest memory block big enough to contain lookup table
340 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
342 // Continue, if memory is not free
343 if (MemoryDescriptor
->MemoryType
!= LoaderFree
) continue;
345 // Continue, if the block is not big enough?
346 if (MemoryDescriptor
->PageCount
< PageLookupTablePages
) continue;
348 // Continue, if it is not at a higher address than previous address
349 if (MemoryDescriptor
->BasePage
< PageLookupTableStartPage
) continue;
351 // Continue, if the address is too high
352 if (MemoryDescriptor
->BasePage
>= MM_MAX_PAGE
) continue;
354 // Memory block is more suitable than the previous one
355 PageLookupTableStartPage
= MemoryDescriptor
->BasePage
;
356 PageLookupTableMemAddress
= (PVOID
)((ULONG_PTR
)
357 (MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
) * MM_PAGE_SIZE
358 - PageLookupTableSize
);
361 TRACE("MmFindLocationForPageLookupTable() returning 0x%x\n", PageLookupTableMemAddress
);
363 return PageLookupTableMemAddress
;
366 VOID
MmInitPageLookupTable(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
)
368 const FREELDR_MEMORY_DESCRIPTOR
* MemoryDescriptor
= NULL
;
369 PFN_NUMBER PageLookupTableStartPage
;
370 PFN_NUMBER PageLookupTablePageCount
;
372 TRACE("MmInitPageLookupTable()\n");
374 // Mark every page as allocated initially
375 // We will go through and mark pages again according to the memory map
376 // But this will mark any holes not described in the map as allocated
377 MmMarkPagesInLookupTable(PageLookupTable
, MmLowestPhysicalPage
, TotalPageCount
, LoaderFirmwarePermanent
);
379 // Parse the whole memory map
380 while ((MemoryDescriptor
= ArcGetMemoryDescriptor(MemoryDescriptor
)) != NULL
)
382 // Mark used pages in the lookup table
384 if (MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
<= TotalPageCount
)
386 TRACE("Marking pages 0x%lx-0x%lx as type %s\n",
387 MemoryDescriptor
->BasePage
,
388 MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
,
389 MmGetSystemMemoryMapTypeString(MemoryDescriptor
->MemoryType
));
390 MmMarkPagesInLookupTable(PageLookupTable
,
391 MemoryDescriptor
->BasePage
,
392 MemoryDescriptor
->PageCount
,
393 MemoryDescriptor
->MemoryType
);
396 TRACE("Ignoring pages 0x%lx-0x%lx (%s)\n",
397 MemoryDescriptor
->BasePage
,
398 MemoryDescriptor
->BasePage
+ MemoryDescriptor
->PageCount
,
399 MmGetSystemMemoryMapTypeString(MemoryDescriptor
->MemoryType
));
402 // Mark the pages that the lookup table occupies as reserved
403 PageLookupTableStartPage
= MmGetPageNumberFromAddress(PageLookupTable
);
404 PageLookupTablePageCount
= MmGetPageNumberFromAddress((PVOID
)((ULONG_PTR
)PageLookupTable
+ ROUND_UP(TotalPageCount
* sizeof(PAGE_LOOKUP_TABLE_ITEM
), MM_PAGE_SIZE
))) - PageLookupTableStartPage
;
405 TRACE("Marking the page lookup table pages as reserved StartPage: 0x%x PageCount: 0x%x\n", PageLookupTableStartPage
, PageLookupTablePageCount
);
406 MmMarkPagesInLookupTable(PageLookupTable
, PageLookupTableStartPage
, PageLookupTablePageCount
, LoaderFirmwareTemporary
);
409 VOID
MmMarkPagesInLookupTable(PVOID PageLookupTable
, PFN_NUMBER StartPage
, PFN_NUMBER PageCount
, TYPE_OF_MEMORY PageAllocated
)
411 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
413 TRACE("MmMarkPagesInLookupTable()\n");
415 /* Validate the range */
416 if ((StartPage
< MmLowestPhysicalPage
) ||
417 ((StartPage
+ PageCount
- 1) > MmHighestPhysicalPage
))
419 ERR("Memory (0x%lx:0x%lx) outside of lookup table! Valid range: 0x%lx-0x%lx.\n",
420 StartPage
, PageCount
, MmLowestPhysicalPage
, MmHighestPhysicalPage
);
424 StartPage
-= MmLowestPhysicalPage
;
425 for (Index
=StartPage
; Index
<(StartPage
+PageCount
); Index
++)
428 if ((Index
<= (StartPage
+ 16)) || (Index
>= (StartPage
+PageCount
-16)))
430 TRACE("Index = 0x%x StartPage = 0x%x PageCount = 0x%x\n", Index
, StartPage
, PageCount
);
433 RealPageLookupTable
[Index
].PageAllocated
= PageAllocated
;
434 RealPageLookupTable
[Index
].PageAllocationLength
= (PageAllocated
!= LoaderFree
) ? 1 : 0;
436 TRACE("MmMarkPagesInLookupTable() Done\n");
439 VOID
MmAllocatePagesInLookupTable(PVOID PageLookupTable
, PFN_NUMBER StartPage
, PFN_NUMBER PageCount
, TYPE_OF_MEMORY MemoryType
)
441 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
444 StartPage
-= MmLowestPhysicalPage
;
445 for (Index
=StartPage
; Index
<(StartPage
+PageCount
); Index
++)
447 RealPageLookupTable
[Index
].PageAllocated
= MemoryType
;
448 RealPageLookupTable
[Index
].PageAllocationLength
= (Index
== StartPage
) ? PageCount
: 0;
452 PFN_NUMBER
MmCountFreePagesInLookupTable(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
)
454 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
456 PFN_NUMBER FreePageCount
;
459 for (Index
=0; Index
<TotalPageCount
; Index
++)
461 if (RealPageLookupTable
[Index
].PageAllocated
== LoaderFree
)
467 return FreePageCount
;
470 PFN_NUMBER
MmFindAvailablePages(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
, PFN_NUMBER PagesNeeded
, BOOLEAN FromEnd
)
472 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
473 PFN_NUMBER AvailablePagesSoFar
;
476 if (LastFreePageHint
> TotalPageCount
)
478 LastFreePageHint
= TotalPageCount
;
481 AvailablePagesSoFar
= 0;
484 /* Allocate "high" (from end) pages */
485 for (Index
=LastFreePageHint
-1; Index
>0; Index
--)
487 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)
489 AvailablePagesSoFar
= 0;
494 AvailablePagesSoFar
++;
497 if (AvailablePagesSoFar
>= PagesNeeded
)
499 return Index
+ MmLowestPhysicalPage
;
505 TRACE("Alloc low memory, LastFreePageHint 0x%x, TPC 0x%x\n", LastFreePageHint
, TotalPageCount
);
506 /* Allocate "low" pages */
507 for (Index
=1; Index
< LastFreePageHint
; Index
++)
509 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)
511 AvailablePagesSoFar
= 0;
516 AvailablePagesSoFar
++;
519 if (AvailablePagesSoFar
>= PagesNeeded
)
521 return Index
- AvailablePagesSoFar
+ 1 + MmLowestPhysicalPage
;
529 PFN_NUMBER
MmFindAvailablePagesBeforePage(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
, PFN_NUMBER PagesNeeded
, PFN_NUMBER LastPage
)
531 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
532 PFN_NUMBER AvailablePagesSoFar
;
535 if (LastPage
> TotalPageCount
)
537 return MmFindAvailablePages(PageLookupTable
, TotalPageCount
, PagesNeeded
, TRUE
);
540 AvailablePagesSoFar
= 0;
541 for (Index
=LastPage
-1; Index
>0; Index
--)
543 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)
545 AvailablePagesSoFar
= 0;
550 AvailablePagesSoFar
++;
553 if (AvailablePagesSoFar
>= PagesNeeded
)
555 return Index
+ MmLowestPhysicalPage
;
562 VOID
MmUpdateLastFreePageHint(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
)
564 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
567 for (Index
=TotalPageCount
-1; Index
>0; Index
--)
569 if (RealPageLookupTable
[Index
].PageAllocated
== LoaderFree
)
571 LastFreePageHint
= Index
+ 1 + MmLowestPhysicalPage
;
577 BOOLEAN
MmAreMemoryPagesAvailable(PVOID PageLookupTable
, PFN_NUMBER TotalPageCount
, PVOID PageAddress
, PFN_NUMBER PageCount
)
579 PPAGE_LOOKUP_TABLE_ITEM RealPageLookupTable
= (PPAGE_LOOKUP_TABLE_ITEM
)PageLookupTable
;
580 PFN_NUMBER StartPage
;
583 StartPage
= MmGetPageNumberFromAddress(PageAddress
);
585 if (StartPage
< MmLowestPhysicalPage
) return FALSE
;
587 StartPage
-= MmLowestPhysicalPage
;
589 // Make sure they aren't trying to go past the
590 // end of availabe memory
591 if ((StartPage
+ PageCount
) > TotalPageCount
)
596 for (Index
= StartPage
; Index
< (StartPage
+ PageCount
); Index
++)
598 // If this page is allocated then there obviously isn't
599 // memory availabe so return FALSE
600 if (RealPageLookupTable
[Index
].PageAllocated
!= LoaderFree
)