arch/all-pc/boot/grub2-aros/grub-core/mmap/i386/mmap.c

   1 /* Mmap management. */
   2 /*
   3  *  GRUB  --  GRand Unified Bootloader
   4  *  Copyright (C) 2009  Free Software Foundation, Inc.
   5  *
   6  *  GRUB 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 3 of the License, or
   9  *  (at your option) any later version.
  10  *
  11  *  GRUB 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.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include <grub/machine/memory.h>
  21 #include <grub/i386/memory.h>
  22 #include <grub/memory.h>
  23 #include <grub/err.h>
  24 #include <grub/misc.h>
  25 #include <grub/mm.h>
  26
  27
  28 #ifndef GRUB_MMAP_REGISTER_BY_FIRMWARE
  29
  30 /* Context for grub_mmap_malign_and_register.  */
  31 struct grub_mmap_malign_and_register_ctx
  32 {
  33   grub_uint64_t align, size, highestlow;
  34 };
  35
  36 /* Helper for grub_mmap_malign_and_register.  */
  37 static int
  38 find_hook (grub_uint64_t start, grub_uint64_t rangesize,
  39            grub_memory_type_t memtype, void *data)
  40 {
  41   struct grub_mmap_malign_and_register_ctx *ctx = data;
  42   grub_uint64_t end = start + rangesize;
  43
  44   if (memtype != GRUB_MEMORY_AVAILABLE)
  45     return 0;
  46   if (end > 0x100000)
  47     end = 0x100000;
  48   if (end > start + ctx->size
  49       && ctx->highestlow < ((end - ctx->size)
  50                             - ((end - ctx->size) & (ctx->align - 1))))
  51     ctx->highestlow = (end - ctx->size)
  52                       - ((end - ctx->size) & (ctx->align - 1));
  53   return 0;
  54 }
  55
  56 void *
  57 grub_mmap_malign_and_register (grub_uint64_t align, grub_uint64_t size,
  58                                int *handle, int type, int flags)
  59 {
  60   struct grub_mmap_malign_and_register_ctx ctx = {
  61     .align = align,
  62     .size = size,
  63     .highestlow = 0
  64   };
  65
  66   void *ret;
  67   if (flags & GRUB_MMAP_MALLOC_LOW)
  68     {
  69       /* FIXME: use low-memory mm allocation once it's available. */
  70       grub_mmap_iterate (find_hook, &ctx);
  71       ret = (void *) (grub_addr_t) ctx.highestlow;
  72     }
  73   else
  74     ret = grub_memalign (align, size);
  75
  76   if (! ret)
  77     {
  78       *handle = 0;
  79       return 0;
  80     }
  81
  82   *handle = grub_mmap_register ((grub_addr_t) ret, size, type);
  83   if (! *handle)
  84     {
  85       grub_free (ret);
  86       return 0;
  87     }
  88
  89   return ret;
  90 }
  91
  92 void
  93 grub_mmap_free_and_unregister (int handle)
  94 {
  95   struct grub_mmap_region *cur;
  96   grub_uint64_t addr;
  97
  98   for (cur = grub_mmap_overlays; cur; cur = cur->next)
  99     if (cur->handle == handle)
 100       break;
 101
 102   if (! cur)
 103     return;
 104
 105   addr = cur->start;
 106
 107   grub_mmap_unregister (handle);
 108
 109   if (addr >= 0x100000)
 110     grub_free ((void *) (grub_addr_t) addr);
 111 }
 112
 113 #endif