1 /* 2 * Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com> 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 */ 6 7 #include <common.h> 8 #include <asm/sfi.h> 9 #include <asm/mpspec.h> 10 #include <asm/smbios.h> 11 #include <asm/tables.h> 12 #include <asm/acpi_table.h> 13 14 /** 15 * Function prototype to write a specific configuration table 16 * 17 * @addr: start address to write the table 18 * @return: end address of the table 19 */ 20 typedef u32 (*table_write)(u32 addr); 21 22 static table_write table_write_funcs[] = { 23 #ifdef CONFIG_GENERATE_PIRQ_TABLE 24 write_pirq_routing_table, 25 #endif 26 #ifdef CONFIG_GENERATE_SFI_TABLE 27 write_sfi_table, 28 #endif 29 #ifdef CONFIG_GENERATE_MP_TABLE 30 write_mp_table, 31 #endif 32 #ifdef CONFIG_GENERATE_ACPI_TABLE 33 write_acpi_tables, 34 #endif 35 #ifdef CONFIG_GENERATE_SMBIOS_TABLE 36 write_smbios_table, 37 #endif 38 }; 39 40 u8 table_compute_checksum(void *v, int len) 41 { 42 u8 *bytes = v; 43 u8 checksum = 0; 44 int i; 45 46 for (i = 0; i < len; i++) 47 checksum -= bytes[i]; 48 49 return checksum; 50 } 51 52 void table_fill_string(char *dest, const char *src, size_t n, char pad) 53 { 54 int start, len; 55 int i; 56 57 strncpy(dest, src, n); 58 59 /* Fill the remaining bytes with pad */ 60 len = strlen(src); 61 start = len < n ? len : n; 62 for (i = start; i < n; i++) 63 dest[i] = pad; 64 } 65 66 void write_tables(void) 67 { 68 u32 rom_table_start = ROM_TABLE_ADDR; 69 u32 rom_table_end; 70 u32 high_table, table_size; 71 int i; 72 73 for (i = 0; i < ARRAY_SIZE(table_write_funcs); i++) { 74 rom_table_end = table_write_funcs[i](rom_table_start); 75 rom_table_end = ALIGN(rom_table_end, ROM_TABLE_ALIGN); 76 77 table_size = rom_table_end - rom_table_start; 78 high_table = (u32)memalign(ROM_TABLE_ALIGN, table_size); 79 if (high_table) { 80 memset((void *)high_table, 0, table_size); 81 table_write_funcs[i](high_table); 82 } else { 83 printf("%d: no memory for configuration tables\n", i); 84 } 85 86 rom_table_start = rom_table_end; 87 } 88 } 89