boot/pc/x86_64/multiboot.c

   1 #include <stdio.h>
   2 #include "stage2_priv.h"
   3 #include "multiboot.h"
   4
   5 static uint32 read32(const void *ptr, unsigned int offset)
   6 {
   7         return *(const uint32 *)((const char *)ptr + offset);
   8 }
   9
  10 static void dump_multiboot_mmap(const void *mmap_base, uint32 len)
  11 {
  12         unsigned int index = 0;
  13         struct multiboot_mmap *mmap = (struct multiboot_mmap *)mmap_base;
  14
  15         while (index < (len / sizeof(struct multiboot_mmap))) {
  16 //              dprintf("\t\tsize 0x%x\n", mmap[index].size);
  17                 uint64 addr = ((uint64)mmap[index].base_addr_high << 32) | mmap[index].base_addr_low;
  18                 dprintf("\t\taddr 0x%Lx, ", addr);
  19                 uint64 length = ((uint64)mmap[index].len_high << 32) | mmap[index].len_low;
  20                 dprintf("len 0x%Lx, ", length);
  21                 dprintf("type 0x%x\n", mmap[index].type);
  22
  23                 index++;
  24         }
  25 }
  26
  27 void dump_multiboot(const void *multiboot)
  28 {
  29         uint32 flags = read32(multiboot, 0);
  30
  31         dprintf("multiboot struct at %p\n", multiboot);
  32         dprintf("\tflags 0x%x\n", flags);
  33
  34         if (flags & (1<<0)) {
  35                 dprintf("\tmem_lower 0x%x\n", read32(multiboot, 4));
  36                 dprintf("\tmem_upper 0x%x\n", read32(multiboot, 8));
  37         }
  38         if (flags & (1<<1)) {
  39                 dprintf("\tboot_device 0x%x\n", read32(multiboot, 12));
  40         }
  41         if (flags & (1<<2)) {
  42                 dprintf("\tcmdline 0x%x\n", read32(multiboot, 16));
  43         }
  44         if (flags & (1<<3)) {
  45                 dprintf("\tmods_count 0x%x\n", read32(multiboot, 20));
  46                 dprintf("\tmods_addr 0x%x\n", read32(multiboot, 24));
  47         }
  48         if (flags & (1<<6)) {
  49                 dprintf("\tmmap_length 0x%x\n", read32(multiboot, 44));
  50                 dprintf("\tmmap_addr 0x%x\n", read32(multiboot, 48));
  51
  52                 dump_multiboot_mmap((void *)(unsigned long)read32(multiboot, 48), read32(multiboot, 44));
  53         }
  54 }
  55
  56 void fill_ka_memranges(const void *multiboot)
  57 {
  58         uint32 flags;
  59
  60         flags = read32(multiboot, 0);
  61
  62         if (flags & (1<<6)) {
  63                 unsigned int index = 0;
  64                 unsigned int len = read32(multiboot, 44);
  65                 struct multiboot_mmap *mmap = (struct multiboot_mmap *)(addr_t)read32(multiboot, 48);
  66
  67                 ka->num_phys_mem_ranges = 0;
  68
  69                 while (index < (len / sizeof(struct multiboot_mmap))) {
  70                         if (mmap[index].type == 1) {
  71                                 uint64 addr = ((uint64)mmap[index].base_addr_high << 32) | mmap[index].base_addr_low;
  72                                 uint64 length = ((uint64)mmap[index].len_high << 32) | mmap[index].len_low;
  73
  74                                 ka->phys_mem_range[ka->num_phys_mem_ranges].start = addr;
  75                                 ka->phys_mem_range[ka->num_phys_mem_ranges].size = length;
  76                                 ka->num_phys_mem_ranges++;
  77                         }
  78
  79                         index++;
  80                 }
  81         } else {
  82                 panic("no multiboot mmap\n");
  83         }
  84 }
  85