18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (C) 2015 Josh Poimboeuf <jpoimboe@redhat.com>
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci/*
78c2ecf20Sopenharmony_ci * This file reads all the special sections which have alternate instructions
88c2ecf20Sopenharmony_ci * which can be patched in or redirected to at runtime.
98c2ecf20Sopenharmony_ci */
108c2ecf20Sopenharmony_ci
118c2ecf20Sopenharmony_ci#include <stdlib.h>
128c2ecf20Sopenharmony_ci#include <string.h>
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#include "builtin.h"
158c2ecf20Sopenharmony_ci#include "special.h"
168c2ecf20Sopenharmony_ci#include "warn.h"
178c2ecf20Sopenharmony_ci#include "arch_special.h"
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_cistruct special_entry {
208c2ecf20Sopenharmony_ci	const char *sec;
218c2ecf20Sopenharmony_ci	bool group, jump_or_nop;
228c2ecf20Sopenharmony_ci	unsigned char size, orig, new;
238c2ecf20Sopenharmony_ci	unsigned char orig_len, new_len; /* group only */
248c2ecf20Sopenharmony_ci	unsigned char feature; /* ALTERNATIVE macro CPU feature */
258c2ecf20Sopenharmony_ci};
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_cistruct special_entry entries[] = {
288c2ecf20Sopenharmony_ci	{
298c2ecf20Sopenharmony_ci		.sec = ".altinstructions",
308c2ecf20Sopenharmony_ci		.group = true,
318c2ecf20Sopenharmony_ci		.size = ALT_ENTRY_SIZE,
328c2ecf20Sopenharmony_ci		.orig = ALT_ORIG_OFFSET,
338c2ecf20Sopenharmony_ci		.orig_len = ALT_ORIG_LEN_OFFSET,
348c2ecf20Sopenharmony_ci		.new = ALT_NEW_OFFSET,
358c2ecf20Sopenharmony_ci		.new_len = ALT_NEW_LEN_OFFSET,
368c2ecf20Sopenharmony_ci		.feature = ALT_FEATURE_OFFSET,
378c2ecf20Sopenharmony_ci	},
388c2ecf20Sopenharmony_ci	{
398c2ecf20Sopenharmony_ci		.sec = "__jump_table",
408c2ecf20Sopenharmony_ci		.jump_or_nop = true,
418c2ecf20Sopenharmony_ci		.size = JUMP_ENTRY_SIZE,
428c2ecf20Sopenharmony_ci		.orig = JUMP_ORIG_OFFSET,
438c2ecf20Sopenharmony_ci		.new = JUMP_NEW_OFFSET,
448c2ecf20Sopenharmony_ci	},
458c2ecf20Sopenharmony_ci	{
468c2ecf20Sopenharmony_ci		.sec = "__ex_table",
478c2ecf20Sopenharmony_ci		.size = EX_ENTRY_SIZE,
488c2ecf20Sopenharmony_ci		.orig = EX_ORIG_OFFSET,
498c2ecf20Sopenharmony_ci		.new = EX_NEW_OFFSET,
508c2ecf20Sopenharmony_ci	},
518c2ecf20Sopenharmony_ci	{},
528c2ecf20Sopenharmony_ci};
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_civoid __weak arch_handle_alternative(unsigned short feature, struct special_alt *alt)
558c2ecf20Sopenharmony_ci{
568c2ecf20Sopenharmony_ci}
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_cistatic void reloc_to_sec_off(struct reloc *reloc, struct section **sec,
598c2ecf20Sopenharmony_ci			     unsigned long *off)
608c2ecf20Sopenharmony_ci{
618c2ecf20Sopenharmony_ci	*sec = reloc->sym->sec;
628c2ecf20Sopenharmony_ci	*off = reloc->sym->offset + reloc->addend;
638c2ecf20Sopenharmony_ci}
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_cistatic int get_alt_entry(struct elf *elf, struct special_entry *entry,
668c2ecf20Sopenharmony_ci			 struct section *sec, int idx,
678c2ecf20Sopenharmony_ci			 struct special_alt *alt)
688c2ecf20Sopenharmony_ci{
698c2ecf20Sopenharmony_ci	struct reloc *orig_reloc, *new_reloc;
708c2ecf20Sopenharmony_ci	unsigned long offset;
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci	offset = idx * entry->size;
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_ci	alt->group = entry->group;
758c2ecf20Sopenharmony_ci	alt->jump_or_nop = entry->jump_or_nop;
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_ci	if (alt->group) {
788c2ecf20Sopenharmony_ci		alt->orig_len = *(unsigned char *)(sec->data->d_buf + offset +
798c2ecf20Sopenharmony_ci						   entry->orig_len);
808c2ecf20Sopenharmony_ci		alt->new_len = *(unsigned char *)(sec->data->d_buf + offset +
818c2ecf20Sopenharmony_ci						  entry->new_len);
828c2ecf20Sopenharmony_ci	}
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	if (entry->feature) {
858c2ecf20Sopenharmony_ci		unsigned short feature;
868c2ecf20Sopenharmony_ci
878c2ecf20Sopenharmony_ci		feature = *(unsigned short *)(sec->data->d_buf + offset +
888c2ecf20Sopenharmony_ci					      entry->feature);
898c2ecf20Sopenharmony_ci		arch_handle_alternative(feature, alt);
908c2ecf20Sopenharmony_ci	}
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_ci	orig_reloc = find_reloc_by_dest(elf, sec, offset + entry->orig);
938c2ecf20Sopenharmony_ci	if (!orig_reloc) {
948c2ecf20Sopenharmony_ci		WARN_FUNC("can't find orig reloc", sec, offset + entry->orig);
958c2ecf20Sopenharmony_ci		return -1;
968c2ecf20Sopenharmony_ci	}
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_ci	reloc_to_sec_off(orig_reloc, &alt->orig_sec, &alt->orig_off);
998c2ecf20Sopenharmony_ci
1008c2ecf20Sopenharmony_ci	if (!entry->group || alt->new_len) {
1018c2ecf20Sopenharmony_ci		new_reloc = find_reloc_by_dest(elf, sec, offset + entry->new);
1028c2ecf20Sopenharmony_ci		if (!new_reloc) {
1038c2ecf20Sopenharmony_ci			WARN_FUNC("can't find new reloc",
1048c2ecf20Sopenharmony_ci				  sec, offset + entry->new);
1058c2ecf20Sopenharmony_ci			return -1;
1068c2ecf20Sopenharmony_ci		}
1078c2ecf20Sopenharmony_ci
1088c2ecf20Sopenharmony_ci		reloc_to_sec_off(new_reloc, &alt->new_sec, &alt->new_off);
1098c2ecf20Sopenharmony_ci
1108c2ecf20Sopenharmony_ci		/* _ASM_EXTABLE_EX hack */
1118c2ecf20Sopenharmony_ci		if (alt->new_off >= 0x7ffffff0)
1128c2ecf20Sopenharmony_ci			alt->new_off -= 0x7ffffff0;
1138c2ecf20Sopenharmony_ci	}
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	return 0;
1168c2ecf20Sopenharmony_ci}
1178c2ecf20Sopenharmony_ci
1188c2ecf20Sopenharmony_ci/*
1198c2ecf20Sopenharmony_ci * Read all the special sections and create a list of special_alt structs which
1208c2ecf20Sopenharmony_ci * describe all the alternate instructions which can be patched in or
1218c2ecf20Sopenharmony_ci * redirected to at runtime.
1228c2ecf20Sopenharmony_ci */
1238c2ecf20Sopenharmony_ciint special_get_alts(struct elf *elf, struct list_head *alts)
1248c2ecf20Sopenharmony_ci{
1258c2ecf20Sopenharmony_ci	struct special_entry *entry;
1268c2ecf20Sopenharmony_ci	struct section *sec;
1278c2ecf20Sopenharmony_ci	unsigned int nr_entries;
1288c2ecf20Sopenharmony_ci	struct special_alt *alt;
1298c2ecf20Sopenharmony_ci	int idx, ret;
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_ci	INIT_LIST_HEAD(alts);
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ci	for (entry = entries; entry->sec; entry++) {
1348c2ecf20Sopenharmony_ci		sec = find_section_by_name(elf, entry->sec);
1358c2ecf20Sopenharmony_ci		if (!sec)
1368c2ecf20Sopenharmony_ci			continue;
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci		if (sec->len % entry->size != 0) {
1398c2ecf20Sopenharmony_ci			WARN("%s size not a multiple of %d",
1408c2ecf20Sopenharmony_ci			     sec->name, entry->size);
1418c2ecf20Sopenharmony_ci			return -1;
1428c2ecf20Sopenharmony_ci		}
1438c2ecf20Sopenharmony_ci
1448c2ecf20Sopenharmony_ci		nr_entries = sec->len / entry->size;
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci		for (idx = 0; idx < nr_entries; idx++) {
1478c2ecf20Sopenharmony_ci			alt = malloc(sizeof(*alt));
1488c2ecf20Sopenharmony_ci			if (!alt) {
1498c2ecf20Sopenharmony_ci				WARN("malloc failed");
1508c2ecf20Sopenharmony_ci				return -1;
1518c2ecf20Sopenharmony_ci			}
1528c2ecf20Sopenharmony_ci			memset(alt, 0, sizeof(*alt));
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_ci			ret = get_alt_entry(elf, entry, sec, idx, alt);
1558c2ecf20Sopenharmony_ci			if (ret > 0)
1568c2ecf20Sopenharmony_ci				continue;
1578c2ecf20Sopenharmony_ci			if (ret < 0)
1588c2ecf20Sopenharmony_ci				return ret;
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_ci			list_add_tail(&alt->list, alts);
1618c2ecf20Sopenharmony_ci		}
1628c2ecf20Sopenharmony_ci	}
1638c2ecf20Sopenharmony_ci
1648c2ecf20Sopenharmony_ci	return 0;
1658c2ecf20Sopenharmony_ci}
166