18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci#include <linux/types.h> 38c2ecf20Sopenharmony_ci#include <linux/string.h> 48c2ecf20Sopenharmony_ci#include <limits.h> 58c2ecf20Sopenharmony_ci#include <stdlib.h> 68c2ecf20Sopenharmony_ci 78c2ecf20Sopenharmony_ci#include <internal/lib.h> // page_size 88c2ecf20Sopenharmony_ci#include "../../../util/machine.h" 98c2ecf20Sopenharmony_ci#include "../../../util/map.h" 108c2ecf20Sopenharmony_ci#include "../../../util/symbol.h" 118c2ecf20Sopenharmony_ci#include <linux/ctype.h> 128c2ecf20Sopenharmony_ci 138c2ecf20Sopenharmony_ci#include <symbol/kallsyms.h> 148c2ecf20Sopenharmony_ci 158c2ecf20Sopenharmony_ci#if defined(__x86_64__) 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_cistruct extra_kernel_map_info { 188c2ecf20Sopenharmony_ci int cnt; 198c2ecf20Sopenharmony_ci int max_cnt; 208c2ecf20Sopenharmony_ci struct extra_kernel_map *maps; 218c2ecf20Sopenharmony_ci bool get_entry_trampolines; 228c2ecf20Sopenharmony_ci u64 entry_trampoline; 238c2ecf20Sopenharmony_ci}; 248c2ecf20Sopenharmony_ci 258c2ecf20Sopenharmony_cistatic int add_extra_kernel_map(struct extra_kernel_map_info *mi, u64 start, 268c2ecf20Sopenharmony_ci u64 end, u64 pgoff, const char *name) 278c2ecf20Sopenharmony_ci{ 288c2ecf20Sopenharmony_ci if (mi->cnt >= mi->max_cnt) { 298c2ecf20Sopenharmony_ci void *buf; 308c2ecf20Sopenharmony_ci size_t sz; 318c2ecf20Sopenharmony_ci 328c2ecf20Sopenharmony_ci mi->max_cnt = mi->max_cnt ? mi->max_cnt * 2 : 32; 338c2ecf20Sopenharmony_ci sz = sizeof(struct extra_kernel_map) * mi->max_cnt; 348c2ecf20Sopenharmony_ci buf = realloc(mi->maps, sz); 358c2ecf20Sopenharmony_ci if (!buf) 368c2ecf20Sopenharmony_ci return -1; 378c2ecf20Sopenharmony_ci mi->maps = buf; 388c2ecf20Sopenharmony_ci } 398c2ecf20Sopenharmony_ci 408c2ecf20Sopenharmony_ci mi->maps[mi->cnt].start = start; 418c2ecf20Sopenharmony_ci mi->maps[mi->cnt].end = end; 428c2ecf20Sopenharmony_ci mi->maps[mi->cnt].pgoff = pgoff; 438c2ecf20Sopenharmony_ci strlcpy(mi->maps[mi->cnt].name, name, KMAP_NAME_LEN); 448c2ecf20Sopenharmony_ci 458c2ecf20Sopenharmony_ci mi->cnt += 1; 468c2ecf20Sopenharmony_ci 478c2ecf20Sopenharmony_ci return 0; 488c2ecf20Sopenharmony_ci} 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_cistatic int find_extra_kernel_maps(void *arg, const char *name, char type, 518c2ecf20Sopenharmony_ci u64 start) 528c2ecf20Sopenharmony_ci{ 538c2ecf20Sopenharmony_ci struct extra_kernel_map_info *mi = arg; 548c2ecf20Sopenharmony_ci 558c2ecf20Sopenharmony_ci if (!mi->entry_trampoline && kallsyms2elf_binding(type) == STB_GLOBAL && 568c2ecf20Sopenharmony_ci !strcmp(name, "_entry_trampoline")) { 578c2ecf20Sopenharmony_ci mi->entry_trampoline = start; 588c2ecf20Sopenharmony_ci return 0; 598c2ecf20Sopenharmony_ci } 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_ci if (is_entry_trampoline(name)) { 628c2ecf20Sopenharmony_ci u64 end = start + page_size; 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ci return add_extra_kernel_map(mi, start, end, 0, name); 658c2ecf20Sopenharmony_ci } 668c2ecf20Sopenharmony_ci 678c2ecf20Sopenharmony_ci return 0; 688c2ecf20Sopenharmony_ci} 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_ciint machine__create_extra_kernel_maps(struct machine *machine, 718c2ecf20Sopenharmony_ci struct dso *kernel) 728c2ecf20Sopenharmony_ci{ 738c2ecf20Sopenharmony_ci struct extra_kernel_map_info mi = { .cnt = 0, }; 748c2ecf20Sopenharmony_ci char filename[PATH_MAX]; 758c2ecf20Sopenharmony_ci int ret; 768c2ecf20Sopenharmony_ci int i; 778c2ecf20Sopenharmony_ci 788c2ecf20Sopenharmony_ci machine__get_kallsyms_filename(machine, filename, PATH_MAX); 798c2ecf20Sopenharmony_ci 808c2ecf20Sopenharmony_ci if (symbol__restricted_filename(filename, "/proc/kallsyms")) 818c2ecf20Sopenharmony_ci return 0; 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ci ret = kallsyms__parse(filename, &mi, find_extra_kernel_maps); 848c2ecf20Sopenharmony_ci if (ret) 858c2ecf20Sopenharmony_ci goto out_free; 868c2ecf20Sopenharmony_ci 878c2ecf20Sopenharmony_ci if (!mi.entry_trampoline) 888c2ecf20Sopenharmony_ci goto out_free; 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_ci for (i = 0; i < mi.cnt; i++) { 918c2ecf20Sopenharmony_ci struct extra_kernel_map *xm = &mi.maps[i]; 928c2ecf20Sopenharmony_ci 938c2ecf20Sopenharmony_ci xm->pgoff = mi.entry_trampoline; 948c2ecf20Sopenharmony_ci ret = machine__create_extra_kernel_map(machine, kernel, xm); 958c2ecf20Sopenharmony_ci if (ret) 968c2ecf20Sopenharmony_ci goto out_free; 978c2ecf20Sopenharmony_ci } 988c2ecf20Sopenharmony_ci 998c2ecf20Sopenharmony_ci machine->trampolines_mapped = mi.cnt; 1008c2ecf20Sopenharmony_ciout_free: 1018c2ecf20Sopenharmony_ci free(mi.maps); 1028c2ecf20Sopenharmony_ci return ret; 1038c2ecf20Sopenharmony_ci} 1048c2ecf20Sopenharmony_ci 1058c2ecf20Sopenharmony_ci#endif 106