src/arch/i386/boot/multiboot.c

   1 /*
   2  * support for Multiboot payloads
   3  *
   4  * Copyright (C) 2008 Robert Millan
   5  *
   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.
  10  *
  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.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18  *
  19  */
  20
  21 #include <cpu/x86/multiboot.h>
  22 #include <string.h>
  23 #include <device/resource.h>
  24 #include <console/console.h>
  25
  26 static struct multiboot_mmap_entry *mb_mem;
  27 struct multiboot_info *mbi = NULL;
  28
  29 static struct {
  30         u64 addr;
  31         u64 len;
  32 } reserved_mem[2];
  33
  34 static void build_mb_mem_range_nooverlap(u64 addr, u64 len)
  35 {
  36         int i;
  37         for (i = 0; i < sizeof(reserved_mem) / sizeof(reserved_mem[0]); i++) {
  38                 /* free region fully contained in reserved region, abort */
  39                 if (addr >= reserved_mem[i].addr && addr + len <= reserved_mem[i].addr + reserved_mem[i].len)
  40                         return;
  41                 /* reserved region splits free region */
  42                 if (addr < reserved_mem[i].addr && addr + len > reserved_mem[i].addr + reserved_mem[i].len) {
  43                         build_mb_mem_range_nooverlap(addr, reserved_mem[i].addr - addr);
  44                         build_mb_mem_range_nooverlap(reserved_mem[i].addr + reserved_mem[i].len, (addr + len) - (reserved_mem[i].addr + reserved_mem[i].len));
  45                         return;
  46                 }
  47                 /* left overlap */
  48                 if (addr < reserved_mem[i].addr + reserved_mem[i].len && addr + len > reserved_mem[i].addr + reserved_mem[i].len) {
  49                         len += addr;
  50                         addr = reserved_mem[i].addr + reserved_mem[i].len;
  51                         len -= addr;
  52                         /* len += addr - old_addr */
  53                         continue;
  54                 }
  55                 /* right overlap */
  56                 if (addr < reserved_mem[i].addr && addr + len > reserved_mem[i].addr) {
  57                         len = reserved_mem[i].addr - addr;
  58                         continue;
  59                 }
  60                 /* none of the above, just add it */
  61         }
  62
  63         mb_mem->addr = addr;
  64         mb_mem->len = len;
  65         mb_mem->type = 1;
  66         mb_mem->size = sizeof(*mb_mem) - sizeof(mb_mem->size);
  67         mb_mem++;
  68 }
  69
  70 static void build_mb_mem_range(void *gp, struct device *dev, struct resource *res)
  71 {
  72         build_mb_mem_range_nooverlap(res->base, res->size);
  73 }
  74
  75 #define ROUND(_r,_a) (((_r) + (((_a) - 1))) & ~((_a) - 1))
  76
  77 unsigned long write_multiboot_info(
  78         unsigned long low_table_start, unsigned long low_table_end,
  79         unsigned long rom_table_start, unsigned long rom_table_end)
  80 {
  81         int i;
  82
  83         mbi = (struct multiboot_info *)rom_table_end;
  84
  85         memset(mbi, 0, sizeof(*mbi));
  86         rom_table_end += sizeof(*mbi);
  87
  88         mbi->mmap_addr = (u32) rom_table_end;
  89         mb_mem = (struct multiboot_mmap_entry *)rom_table_end;
  90
  91         /* FIXME This code is broken, it does not know about high memory
  92          * tables, nor does it reserve the coreboot table area.
  93          */
  94         /* reserved regions */
  95         reserved_mem[0].addr = low_table_start;
  96         reserved_mem[0].len = ROUND(low_table_end - low_table_start, 4096);
  97         reserved_mem[1].addr = rom_table_start;
  98         reserved_mem[1].len = ROUND(rom_table_end - rom_table_start, 4096);
  99
 100         for (i = 0; i < sizeof(reserved_mem) / sizeof(reserved_mem[0]); i++) {
 101                 mb_mem->addr = reserved_mem[i].addr;
 102                 mb_mem->len = reserved_mem[i].len;
 103                 mb_mem->type = 2;
 104                 mb_mem->size = sizeof(*mb_mem) - sizeof(mb_mem->size);
 105                 mb_mem++;
 106         }
 107
 108         /* free regions */
 109         search_global_resources( IORESOURCE_MEM | IORESOURCE_CACHEABLE,
 110                 IORESOURCE_MEM | IORESOURCE_CACHEABLE, build_mb_mem_range, NULL);
 111
 112         mbi->mmap_length = ((u32) mb_mem) - mbi->mmap_addr;
 113         mbi->flags |= MB_INFO_MEM_MAP;
 114
 115         printk(BIOS_INFO, "Multiboot Information structure has been written.\n");
 116
 117         return (unsigned long)mb_mem;
 118 }