1 /* 2 * sfi.c - driver for parsing sfi mmap table and build e820 table 3 * 4 * Copyright (c) 2009, Intel Corporation. 5 * 6 * This program is free software; you can redistribute it and/or modify it 7 * under the terms and conditions of the GNU General Public License, 8 * version 2, as published by the Free Software Foundation. 9 * 10 * This program is distributed in the hope it will be useful, but WITHOUT 11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 13 * more details. 14 * 15 * You should have received a copy of the GNU General Public License along with 16 * this program; if not, write to the Free Software Foundation, Inc., 17 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. 18 */ 19 20 #include "types.h" 21 #include "bootparam.h" 22 #include "bootstub.h" 23 #include "mb.h" 24 #include "sfi.h" 25 26 #define SFI_BASE_ADDR 0x000E0000 27 #define SFI_LENGTH 0x00020000 28 29 static unsigned long sfi_search_mmap(unsigned long start, int len) 30 { 31 unsigned long i = 0; 32 char *pchar = (char *)start; 33 34 for (i = 0; i < len; i++, pchar++) { 35 if (pchar[0] == 'M' 36 && pchar[1] == 'M' 37 && pchar[2] == 'A' 38 && pchar[3] == 'P') 39 return start + i; 40 } 41 return 0; 42 } 43 44 int sfi_add_e820_entry(struct boot_params *bp, memory_map_t *mb_mmap, u64 start, u64 size, int type) 45 { 46 struct e820entry * e820_entry; 47 memory_map_t *mb_mmap_entry; 48 int i; 49 50 if (!bp || !mb_mmap) { 51 bs_printk("Bootstub: sfi_add_e820_entry failed\n"); 52 return -1; 53 } 54 55 for (i=0; i < bp->e820_entries; i++) { 56 e820_entry = &(bp->e820_map[i]); 57 mb_mmap_entry = &(mb_mmap[i]); 58 if (e820_entry->addr == start) { 59 /* Override size and type */ 60 e820_entry->size = size; 61 e820_entry->type = type; 62 mb_mmap_entry->length_low = size; 63 mb_mmap_entry->length_high = 0; 64 mb_mmap_entry->type = (type == E820_RAM)?1:0; 65 return 0; 66 } 67 } 68 69 /* ASSERT: no duplicate start address found */ 70 if (bp->e820_entries == E820MAX) 71 return -1; 72 73 e820_entry = &(bp->e820_map[bp->e820_entries]); 74 mb_mmap_entry = &(mb_mmap[bp->e820_entries]); 75 76 e820_entry->addr = start; 77 e820_entry->size = size; 78 e820_entry->type = type; 79 80 mb_mmap_entry->size = 20; 81 mb_mmap_entry->base_addr_low = start; 82 mb_mmap_entry->base_addr_high = 0; 83 mb_mmap_entry->length_low = size; 84 mb_mmap_entry->length_high = 0; 85 mb_mmap_entry->type = (type == E820_RAM)?1:0; 86 87 bp->e820_entries++; 88 89 return 0; 90 } 91 92 void sfi_setup_mmap(struct boot_params *bp, memory_map_t *mb_mmap) 93 { 94 struct sfi_table *sb; 95 struct sfi_mem_entry *mentry; 96 unsigned long long start, end, size; 97 int i, num, type; 98 99 if (!bp || !mb_mmap) { 100 bs_printk("Bootstub: sfi_setup_mmap failed\n"); 101 return; 102 } 103 104 bp->e820_entries = 0; 105 106 /* search for sfi mmap table */ 107 sb = (struct sfi_table *)sfi_search_mmap(SFI_BASE_ADDR, SFI_LENGTH); 108 if (!sb) { 109 bs_printk("Bootstub: SFI MMAP table not found\n"); 110 return; 111 } 112 bs_printk("Bootstub: map SFI MMAP to e820 table\n"); 113 num = SFI_GET_ENTRY_NUM(sb, sfi_mem_entry); 114 mentry = (struct sfi_mem_entry *)sb->pentry; 115 116 for (i = 0; i < num; i++) { 117 start = mentry->phy_start; 118 size = mentry->pages << 12; 119 end = start + size; 120 121 if (start > end) 122 continue; 123 124 /* translate SFI mmap type to E820 map type */ 125 switch (mentry->type) { 126 case SFI_MEM_CONV: 127 type = E820_RAM; 128 break; 129 case SFI_MEM_UNUSABLE: 130 case SFI_RUNTIME_SERVICE_DATA: 131 mentry++; 132 continue; 133 default: 134 type = E820_RESERVED; 135 } 136 137 if (sfi_add_e820_entry(bp, mb_mmap, start, size, type) != 0) 138 break; 139 140 mentry++; 141 } 142 143 } 144
