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