payloads/coreinfo/multiboot_module.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2
   3 #include <multiboot_tables.h>
   4 #include "coreinfo.h"
   5
   6 #if CONFIG(MODULE_MULTIBOOT)
   7
   8 #define MAX_MEMORY_COUNT  10
   9
  10 static struct {
  11         int mem_count;
  12
  13         struct {
  14                 u64 start;
  15                 u64 size;
  16                 int type;
  17         } range[MAX_MEMORY_COUNT];
  18 } cb_info;
  19
  20 static int tables_good = 0;
  21
  22 static int multiboot_module_redraw(WINDOW *win)
  23 {
  24         int row = 2;
  25         int i;
  26
  27         print_module_title(win, "Multiboot Tables");
  28
  29         if (tables_good == 0) {
  30                 mvwprintw(win, row++, 1, "No multiboot tables were found");
  31                 return 0;
  32         }
  33
  34         row++;
  35         mvwprintw(win, row++, 1, "-- Memory Map --");
  36
  37         for (i = 0; i < cb_info.mem_count; i++) {
  38
  39                 if (cb_info.range[i].type == 1)
  40                         mvwprintw(win, row++, 3, "     RAM: ");
  41                 else
  42                         mvwprintw(win, row++, 3, "Reserved: ");
  43
  44                 wprintw(win, "%16.16llx - %16.16llx",
  45                         cb_info.range[i].start,
  46                         cb_info.range[i].start + cb_info.range[i].size - 1);
  47         }
  48
  49         return 0;
  50 }
  51
  52 static void parse_memory(struct multiboot_header *table)
  53 {
  54         u8 *start = (u8 *) phys_to_virt(table->mmap_addr);
  55         u8 *ptr = start;
  56         int i = 0;
  57
  58         cb_info.mem_count = 0;
  59
  60         while(ptr < (start + table->mmap_length)) {
  61                 struct multiboot_mmap *mmap = (struct multiboot_mmap *) ptr;
  62
  63                 cb_info.range[i].start = mmap->addr;
  64                 cb_info.range[i].size = mmap->length;
  65                 cb_info.range[i].type = mmap->type;
  66
  67                 if (++cb_info.mem_count == MAX_MEMORY_COUNT)
  68                         return;
  69
  70                 ptr += (mmap->size + sizeof(mmap->size));
  71                 i++;
  72         }
  73 }
  74
  75 static void parse_header(unsigned long addr)
  76 {
  77         struct multiboot_header *table = (struct multiboot_header *) addr;
  78
  79         if (table->flags & MULTIBOOT_FLAGS_MMAP)
  80                 parse_memory(table);
  81 }
  82
  83 static int multiboot_module_init(void)
  84 {
  85         unsigned long mbaddr;
  86         tables_good = sysinfo_have_multiboot(&mbaddr);
  87
  88         parse_header(mbaddr);
  89
  90         return tables_good ? 0 : -1;
  91 }
  92
  93 struct coreinfo_module multiboot_module = {
  94         .name = "Multiboot",
  95         .init = multiboot_module_init,
  96         .redraw = multiboot_module_redraw,
  97 };
  98
  99 #else
 100
 101 struct coreinfo_module multiboot_module = {
 102 };
 103
 104 #endif /* CONFIG_MODULE_MULTIBOOT */