123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317 |
- #ifdef PCBIOS
-
- #include "etherboot.h"
- #include "realmode.h" /* for real_mode_stack */
-
- /* Routines to allocate base memory in a BIOS-compatible way, by
- * updating the Free Base Memory Size counter at 40:13h.
- *
- * Michael Brown <mbrown@fensystems.co.uk> (mcb30)
- * $Id$
- */
-
- #define fbms ( ( uint16_t * ) phys_to_virt ( 0x413 ) )
- #define BASE_MEMORY_MAX ( 640 )
- #define FREE_BLOCK_MAGIC ( ('!'<<0) + ('F'<<8) + ('R'<<16) + ('E'<<24) )
- #define FREE_BASE_MEMORY ( (uint32_t) ( *fbms << 10 ) )
-
- /* Prototypes */
- void * _allot_base_memory ( size_t size );
- void _forget_base_memory ( void *ptr, size_t size );
-
- typedef struct free_base_memory_block {
- uint32_t magic;
- uint16_t size_kb;
- } free_base_memory_block_t;
-
- /* Return amount of free base memory in bytes
- */
-
- uint32_t get_free_base_memory ( void ) {
- return FREE_BASE_MEMORY;
- }
-
- /* Start of our image in base memory.
- */
- #define __text16_nocompress __attribute__ ((section (".text16.nocompress")))
- uint32_t image_basemem __text16_nocompress = 0;
- uint32_t image_basemem_size __text16_nocompress = 0;
-
- /* Allot/free the real-mode stack
- */
-
- void allot_real_mode_stack ( void )
- {
- void *new_real_mode_stack;
-
- if ( lock_real_mode_stack )
- return;
-
- /* This is evil hack.
- * Until we have a real_mode stack use 0x7c00.
- * Except for 0 - 0x600 membory below 0x7c00 is hardly every used.
- * This stack should never be used unless the stack allocation fails,
- * or if someone has placed a print statement in a dangerous location.
- */
- if (!real_mode_stack) {
- real_mode_stack = 0x7c00;
- }
- new_real_mode_stack = _allot_base_memory ( real_mode_stack_size );
- if ( ! new_real_mode_stack ) {
- printf ( "FATAL: No real-mode stack\n" );
- while ( 1 ) {};
- }
- real_mode_stack = virt_to_phys ( new_real_mode_stack );
- get_memsizes();
- }
-
- void forget_real_mode_stack ( void )
- {
- if ( lock_real_mode_stack )
- return;
-
- if ( real_mode_stack) {
- _forget_base_memory ( phys_to_virt(real_mode_stack),
- real_mode_stack_size );
- /* get_memsizes() uses the real_mode stack we just freed
- * for it's BIOS calls.
- */
- get_memsizes();
- real_mode_stack = 0;
- }
- }
-
- /* Allocate N bytes of base memory. Amount allocated will be rounded
- * up to the nearest kB, since that's the granularity of the BIOS FBMS
- * counter. Returns NULL if memory cannot be allocated.
- */
-
- static void * _allot_base_memory ( size_t size )
- {
- uint16_t size_kb = ( size + 1023 ) >> 10;
- void *ptr = NULL;
-
- #ifdef DEBUG_BASEMEM
- printf ( "Trying to allocate %d kB of base memory from %d kB free\n",
- size_kb, *fbms );
- #endif
-
- /* Free up any unused memory before we start */
- free_unused_base_memory();
-
- /* Check available base memory */
- if ( size_kb > *fbms ) { return NULL; }
-
- /* Reduce available base memory */
- *fbms -= size_kb;
-
- /* Calculate address of memory allocated */
- ptr = phys_to_virt ( FREE_BASE_MEMORY );
-
- /* Zero out memory. We do this so that allocation of
- * already-used space will show up in the form of a crash as
- * soon as possible.
- *
- * Update: there's another reason for doing this. If we don't
- * zero the contents, then they could still retain our "free
- * block" markers and be liable to being freed whenever a
- * base-memory allocation routine is next called.
- */
- memset ( ptr, 0, size_kb << 10 );
-
- #ifdef DEBUG_BASEMEM
- printf ( "Allocated %d kB at [%x,%x)\n", size_kb,
- virt_to_phys ( ptr ),
- virt_to_phys ( ptr ) + size_kb * 1024 );
- #endif
-
- return ptr;
- }
-
- void * allot_base_memory ( size_t size )
- {
- void *ptr;
-
- /* Free real-mode stack, allocate memory, reallocate real-mode
- * stack.
- */
- forget_real_mode_stack();
- ptr = _allot_base_memory ( size );
- get_memsizes();
- return ptr;
- }
-
- /* Free base memory allocated by allot_base_memory. The BIOS provides
- * nothing better than a LIFO mechanism for freeing memory (i.e. it
- * just has the single "total free memory" counter), but we improve
- * upon this slightly; as long as you free all the allotted blocks, it
- * doesn't matter what order you free them in. (This will only work
- * for blocks that are freed via forget_base_memory()).
- *
- * Yes, it's annoying that you have to remember the size of the blocks
- * you've allotted. However, since our granularity of allocation is
- * 1K, the alternative is to risk wasting the occasional kB of base
- * memory, which is a Bad Thing. Really, you should be using as
- * little base memory as possible, so consider the awkwardness of the
- * API to be a feature! :-)
- */
-
- static void _forget_base_memory ( void *ptr, size_t size )
- {
- uint16_t remainder = virt_to_phys(ptr) & 1023;
- uint16_t size_kb = ( size + remainder + 1023 ) >> 10;
- free_base_memory_block_t *free_block =
- ( free_base_memory_block_t * ) ( ptr - remainder );
-
- if ( ( ptr == NULL ) || ( size == 0 ) ) {
- return;
- }
-
- #ifdef DEBUG_BASEMEM
- printf ( "Trying to free %d bytes base memory at 0x%x\n",
- size, virt_to_phys ( ptr ) );
- if ( remainder > 0 ) {
- printf ( "WARNING: destructively expanding free block "
- "downwards to 0x%x\n",
- virt_to_phys ( ptr - remainder ) );
- }
- #endif
-
- /* Mark every kilobyte within this block as free. This is
- * overkill for normal purposes, but helps when something has
- * allocated base memory with a granularity finer than the
- * BIOS granularity of 1kB. PXE ROMs tend to do this when
- * they allocate their own memory. This method allows us to
- * free their blocks (admittedly in a rather dangerous,
- * tread-on-anything-either-side sort of way, but there's no
- * other way to do it).
- *
- * Since we're marking every kB as free, there's actually no
- * need for recording the size of the blocks. However, we
- * keep this in so that debug messages are friendlier. It
- * probably adds around 8 bytes to the overall code size.
- */
- while ( size_kb > 0 ) {
- /* Mark this block as unused */
- free_block->magic = FREE_BLOCK_MAGIC;
- free_block->size_kb = size_kb;
- /* Move up by 1 kB */
- free_block = (void *)(((char *)free_block) + (1 << 10));
- size_kb--;
- }
-
- /* Free up unused base memory */
- free_unused_base_memory();
- }
-
- void forget_base_memory ( void *ptr, size_t size )
- {
- /* Free memory, free real-mode stack, re-allocate real-mode
- * stack. Do this so that we don't end up wasting a huge
- * block of memory trapped behind the real-mode stack.
- */
- _forget_base_memory ( ptr, size );
- forget_real_mode_stack();
- get_memsizes();
- }
-
- /* Do the actual freeing of memory. This is split out from
- * forget_base_memory() so that it may be called separately. It
- * should be called whenever base memory is deallocated by an external
- * entity (if we can detect that it has done so) so that we get the
- * chance to free up our own blocks.
- */
- static void free_unused_base_memory ( void ) {
- free_base_memory_block_t *free_block = NULL;
-
- /* Try to release memory back to the BIOS. Free all
- * consecutive blocks marked as free.
- */
- while ( 1 ) {
- /* Calculate address of next potential free block */
- free_block = ( free_base_memory_block_t * )
- phys_to_virt ( FREE_BASE_MEMORY );
-
- /* Stop processing if we're all the way up to 640K or
- * if this is not a free block
- */
- if ( ( *fbms == BASE_MEMORY_MAX ) ||
- ( free_block->magic != FREE_BLOCK_MAGIC ) ) {
- break;
- }
-
- /* Return memory to BIOS */
- *fbms += free_block->size_kb;
-
- #ifdef DEBUG_BASEMEM
- printf ( "Freed %d kB base memory, %d kB now free\n",
- free_block->size_kb, *fbms );
- #endif
-
- /* Zero out freed block. We do this in case
- * the block contained any structures that
- * might be located by scanning through
- * memory.
- */
- memset ( free_block, 0, free_block->size_kb << 10 );
- }
- }
-
- /* Free base memory used by the prefix. Called once at start of
- * Etherboot by arch_main().
- */
- void forget_prefix_base_memory ( void )
- {
- /* runtime_start_kb is _text rounded down to a physical kB boundary */
- uint32_t runtime_start_kb = virt_to_phys(_text) & ~0x3ff;
- /* prefix_size_kb is the prefix size excluding any portion
- * that overlaps into the first kB used by the runtime image
- */
- uint32_t prefix_size_kb = runtime_start_kb - image_basemem;
-
- #ifdef DEBUG_BASEMEM
- printf ( "Attempting to free base memory used by prefix\n" );
- #endif
-
- /* If the decompressor is in allocated base memory
- * *and* the Etherboot text is in base
- * memory, then free the decompressor.
- */
- if ( ( image_basemem >= FREE_BASE_MEMORY ) &&
- ( runtime_start_kb >= FREE_BASE_MEMORY ) &&
- ( runtime_start_kb <= ( BASE_MEMORY_MAX << 10 ) ) )
- {
- forget_base_memory ( phys_to_virt ( image_basemem ),
- prefix_size_kb );
- /* Update image_basemem and image_basemem_size to
- * indicate that our allocation now starts with _text
- */
- image_basemem = runtime_start_kb;
- image_basemem_size -= prefix_size_kb;
- }
- }
-
- /* Free base memory used by the runtime image. Called after
- * relocation by arch_relocated_from().
- */
- void forget_runtime_base_memory ( unsigned long old_addr )
- {
- /* text_start_kb is old _text rounded down to a physical KB boundary */
- uint32_t old_text_start_kb = old_addr & ~0x3ff;
-
- #ifdef DEBUG_BASEMEM
- printf ( "Attempting to free base memory used by runtime image\n" );
- #endif
-
- if ( ( image_basemem >= FREE_BASE_MEMORY ) &&
- ( image_basemem == old_text_start_kb ) )
- {
- forget_base_memory ( phys_to_virt ( image_basemem ),
- image_basemem_size );
- /* Update image_basemem to show no longer in use */
- image_basemem = 0;
- image_basemem_size = 0;
- }
- }
-
- #endif /* PCBIOS */
|