arch/all-pc/boot/grub2-aros/grub-core/disk/memdisk.c

   1 /* memdisk.c - Access embedded memory disk.  */
   2 /*
   3  *  GRUB  --  GRand Unified Bootloader
   4  *  Copyright (C) 2007,2008  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/disk.h>
  21 #include <grub/dl.h>
  22 #include <grub/kernel.h>
  23 #include <grub/misc.h>
  24 #include <grub/mm.h>
  25 #include <grub/types.h>
  26
  27 GRUB_MOD_LICENSE ("GPLv3+");
  28
  29 static char *memdisk_addr;
  30 static grub_off_t memdisk_size = 0;
  31
  32 static int
  33 grub_memdisk_iterate (grub_disk_dev_iterate_hook_t hook, void *hook_data,
  34                       grub_disk_pull_t pull)
  35 {
  36   if (pull != GRUB_DISK_PULL_NONE)
  37     return 0;
  38
  39   return hook ("memdisk", hook_data);
  40 }
  41
  42 static grub_err_t
  43 grub_memdisk_open (const char *name, grub_disk_t disk)
  44 {
  45   if (grub_strcmp (name, "memdisk"))
  46       return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "not a memdisk");
  47
  48   disk->total_sectors = memdisk_size / GRUB_DISK_SECTOR_SIZE;
  49   disk->max_agglomerate = GRUB_DISK_MAX_MAX_AGGLOMERATE;
  50   disk->id = 0;
  51
  52   return GRUB_ERR_NONE;
  53 }
  54
  55 static void
  56 grub_memdisk_close (grub_disk_t disk __attribute((unused)))
  57 {
  58 }
  59
  60 static grub_err_t
  61 grub_memdisk_read (grub_disk_t disk __attribute((unused)), grub_disk_addr_t sector,
  62                     grub_size_t size, char *buf)
  63 {
  64   grub_memcpy (buf, memdisk_addr + (sector << GRUB_DISK_SECTOR_BITS), size << GRUB_DISK_SECTOR_BITS);
  65   return 0;
  66 }
  67
  68 static grub_err_t
  69 grub_memdisk_write (grub_disk_t disk __attribute((unused)), grub_disk_addr_t sector,
  70                      grub_size_t size, const char *buf)
  71 {
  72   grub_memcpy (memdisk_addr + (sector << GRUB_DISK_SECTOR_BITS), buf, size << GRUB_DISK_SECTOR_BITS);
  73   return 0;
  74 }
  75
  76 static struct grub_disk_dev grub_memdisk_dev =
  77   {
  78     .name = "memdisk",
  79     .id = GRUB_DISK_DEVICE_MEMDISK_ID,
  80     .iterate = grub_memdisk_iterate,
  81     .open = grub_memdisk_open,
  82     .close = grub_memdisk_close,
  83     .read = grub_memdisk_read,
  84     .write = grub_memdisk_write,
  85     .next = 0
  86   };
  87
  88 GRUB_MOD_INIT(memdisk)
  89 {
  90   struct grub_module_header *header;
  91   FOR_MODULES (header)
  92     if (header->type == OBJ_TYPE_MEMDISK)
  93       {
  94         char *memdisk_orig_addr;
  95         memdisk_orig_addr = (char *) header + sizeof (struct grub_module_header);
  96
  97         grub_dprintf ("memdisk", "Found memdisk image at %p\n", memdisk_orig_addr);
  98
  99         memdisk_size = header->size - sizeof (struct grub_module_header);
 100         memdisk_addr = grub_malloc (memdisk_size);
 101
 102         grub_dprintf ("memdisk", "Copying memdisk image to dynamic memory\n");
 103         grub_memmove (memdisk_addr, memdisk_orig_addr, memdisk_size);
 104
 105         grub_disk_dev_register (&grub_memdisk_dev);
 106         break;
 107       }
 108 }
 109
 110 GRUB_MOD_FINI(memdisk)
 111 {
 112   if (! memdisk_size)
 113     return;
 114   grub_free (memdisk_addr);
 115   grub_disk_dev_unregister (&grub_memdisk_dev);
 116 }