Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*  Kernel module help for PPC64.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)     Copyright (C) 2001, 2003 Rusty Russell IBM Corporation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/elf.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/moduleloader.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/vmalloc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/ftrace.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/bug.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <asm/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <asm/firmware.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <asm/code-patching.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/sort.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <asm/setup.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <asm/sections.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <asm/inst.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) /* FIXME: We don't do .init separately.  To do this, we'd need to have
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26)    a separate r2 value in the init and core section, and stub between
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27)    them, too.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29)    Using a magic allocator which places modules within 32MB solves
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30)    this, and makes other things simpler.  Anton?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31)    --RR.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #ifdef PPC64_ELF_ABI_v2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) /* An address is simply the address of the function. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) typedef unsigned long func_desc_t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) static func_desc_t func_desc(unsigned long addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	return addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) static unsigned long func_addr(unsigned long addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	return addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) static unsigned long stub_func_addr(func_desc_t func)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	return func;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) /* PowerPC64 specific values for the Elf64_Sym st_other field.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) #define STO_PPC64_LOCAL_BIT	5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) #define STO_PPC64_LOCAL_MASK	(7 << STO_PPC64_LOCAL_BIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) #define PPC64_LOCAL_ENTRY_OFFSET(other)					\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55)  (((1 << (((other) & STO_PPC64_LOCAL_MASK) >> STO_PPC64_LOCAL_BIT)) >> 2) << 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) static unsigned int local_entry_offset(const Elf64_Sym *sym)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	/* sym->st_other indicates offset to local entry point
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	 * (otherwise it will assume r12 is the address of the start
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	 * of function and try to derive r2 from it). */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	return PPC64_LOCAL_ENTRY_OFFSET(sym->st_other);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) /* An address is address of the OPD entry, which contains address of fn. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) typedef struct ppc64_opd_entry func_desc_t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) static func_desc_t func_desc(unsigned long addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	return *(struct ppc64_opd_entry *)addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) static unsigned long func_addr(unsigned long addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	return func_desc(addr).funcaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) static unsigned long stub_func_addr(func_desc_t func)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	return func.funcaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) static unsigned int local_entry_offset(const Elf64_Sym *sym)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) void *dereference_module_function_descriptor(struct module *mod, void *ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	if (ptr < (void *)mod->arch.start_opd ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 			ptr >= (void *)mod->arch.end_opd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		return ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	return dereference_function_descriptor(ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) #define STUB_MAGIC 0x73747562 /* stub */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) /* Like PPC32, we need little trampolines to do > 24-bit jumps (into
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99)    the kernel itself).  But on PPC64, these need to be used for every
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)    jump, actually, to reset r2 (TOC+0x8000). */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) struct ppc64_stub_entry
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	/* 28 byte jump instruction sequence (7 instructions). We only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	 * need 6 instructions on ABIv2 but we always allocate 7 so
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	 * so we don't have to modify the trampoline load instruction. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	u32 jump[7];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	/* Used by ftrace to identify stubs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	u32 magic;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	/* Data for the above code */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	func_desc_t funcdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)  * PPC64 uses 24 bit jumps, but we need to jump into other modules or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)  * the kernel which may be further.  So we jump to a stub.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)  * For ELFv1 we need to use this to set up the new r2 value (aka TOC
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)  * pointer).  For ELFv2 it's the callee's responsibility to set up the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)  * new r2, but for both we need to save the old r2.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)  * We could simply patch the new r2 value and function pointer into
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)  * the stub, but it's significantly shorter to put these values at the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)  * end of the stub code, and patch the stub address (32-bits relative
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)  * to the TOC ptr, r2) into the stub.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)  * addis   r11,r2, <high>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)  * addi    r11,r11, <low>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)  * std     r2,R2_STACK_OFFSET(r1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)  * ld      r12,32(r11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)  * ld      r2,40(r11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)  * mtctr   r12
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)  * bctr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) static u32 ppc64_stub_insns[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	PPC_INST_ADDIS | __PPC_RT(R11) | __PPC_RA(R2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	PPC_INST_ADDI | __PPC_RT(R11) | __PPC_RA(R11),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	/* Save current r2 value in magic place on the stack. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	PPC_INST_STD | __PPC_RS(R2) | __PPC_RA(R1) | R2_STACK_OFFSET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	PPC_INST_LD | __PPC_RT(R12) | __PPC_RA(R11) | 32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) #ifdef PPC64_ELF_ABI_v1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	/* Set up new r2 from function descriptor */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	PPC_INST_LD | __PPC_RT(R2) | __PPC_RA(R11) | 40,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	PPC_INST_MTCTR | __PPC_RS(R12),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	PPC_INST_BCTR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) /* Count how many different 24-bit relocations (different symbol,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)    different addend) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) static unsigned int count_relocs(const Elf64_Rela *rela, unsigned int num)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	unsigned int i, r_info, r_addend, _count_relocs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	/* FIXME: Only count external ones --RR */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	_count_relocs = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	r_info = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	r_addend = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	for (i = 0; i < num; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 		/* Only count 24-bit relocs, others don't need stubs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 		if (ELF64_R_TYPE(rela[i].r_info) == R_PPC_REL24 &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 		    (r_info != ELF64_R_SYM(rela[i].r_info) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		     r_addend != rela[i].r_addend)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 			_count_relocs++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 			r_info = ELF64_R_SYM(rela[i].r_info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 			r_addend = rela[i].r_addend;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	return _count_relocs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) static int relacmp(const void *_x, const void *_y)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	const Elf64_Rela *x, *y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	y = (Elf64_Rela *)_x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	x = (Elf64_Rela *)_y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	/* Compare the entire r_info (as opposed to ELF64_R_SYM(r_info) only) to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	 * make the comparison cheaper/faster. It won't affect the sorting or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	 * the counting algorithms' performance
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	if (x->r_info < y->r_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	else if (x->r_info > y->r_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	else if (x->r_addend < y->r_addend)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	else if (x->r_addend > y->r_addend)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) /* Get size of potential trampolines required. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) static unsigned long get_stubs_size(const Elf64_Ehdr *hdr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 				    const Elf64_Shdr *sechdrs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	/* One extra reloc so it's always 0-funcaddr terminated */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	unsigned long relocs = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	unsigned i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	/* Every relocated section... */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	for (i = 1; i < hdr->e_shnum; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		if (sechdrs[i].sh_type == SHT_RELA) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 			pr_debug("Found relocations in section %u\n", i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 			pr_debug("Ptr: %p.  Number: %Lu\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 			       (void *)sechdrs[i].sh_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 			       sechdrs[i].sh_size / sizeof(Elf64_Rela));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 			/* Sort the relocation information based on a symbol and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 			 * addend key. This is a stable O(n*log n) complexity
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 			 * alogrithm but it will reduce the complexity of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 			 * count_relocs() to linear complexity O(n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 			 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 			sort((void *)sechdrs[i].sh_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 			     sechdrs[i].sh_size / sizeof(Elf64_Rela),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 			     sizeof(Elf64_Rela), relacmp, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 			relocs += count_relocs((void *)sechdrs[i].sh_addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 					       sechdrs[i].sh_size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 					       / sizeof(Elf64_Rela));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) #ifdef CONFIG_DYNAMIC_FTRACE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	/* make the trampoline to the ftrace_caller */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	relocs++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	/* an additional one for ftrace_regs_caller */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	relocs++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	pr_debug("Looks like a total of %lu stubs, max\n", relocs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	return relocs * sizeof(struct ppc64_stub_entry);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) /* Still needed for ELFv2, for .TOC. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) static void dedotify_versions(struct modversion_info *vers,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 			      unsigned long size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	struct modversion_info *end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	for (end = (void *)vers + size; vers < end; vers++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		if (vers->name[0] == '.') {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 			memmove(vers->name, vers->name+1, strlen(vers->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)  * Undefined symbols which refer to .funcname, hack to funcname. Make .TOC.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252)  * seem to be defined (value set later).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) static void dedotify(Elf64_Sym *syms, unsigned int numsyms, char *strtab)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	for (i = 1; i < numsyms; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 		if (syms[i].st_shndx == SHN_UNDEF) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 			char *name = strtab + syms[i].st_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 			if (name[0] == '.') {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 				if (strcmp(name+1, "TOC.") == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 					syms[i].st_shndx = SHN_ABS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 				syms[i].st_name++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) static Elf64_Sym *find_dot_toc(Elf64_Shdr *sechdrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 			       const char *strtab,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 			       unsigned int symindex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	unsigned int i, numsyms;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	Elf64_Sym *syms;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	syms = (Elf64_Sym *)sechdrs[symindex].sh_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	numsyms = sechdrs[symindex].sh_size / sizeof(Elf64_Sym);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	for (i = 1; i < numsyms; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 		if (syms[i].st_shndx == SHN_ABS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 		    && strcmp(strtab + syms[i].st_name, "TOC.") == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 			return &syms[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) int module_frob_arch_sections(Elf64_Ehdr *hdr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 			      Elf64_Shdr *sechdrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 			      char *secstrings,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 			      struct module *me)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	/* Find .toc and .stubs sections, symtab and strtab */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	for (i = 1; i < hdr->e_shnum; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 		char *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 		if (strcmp(secstrings + sechdrs[i].sh_name, ".stubs") == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 			me->arch.stubs_section = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		else if (strcmp(secstrings + sechdrs[i].sh_name, ".toc") == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 			me->arch.toc_section = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 			if (sechdrs[i].sh_addralign < 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 				sechdrs[i].sh_addralign = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		else if (strcmp(secstrings+sechdrs[i].sh_name,"__versions")==0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 			dedotify_versions((void *)hdr + sechdrs[i].sh_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 					  sechdrs[i].sh_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 		/* We don't handle .init for the moment: rename to _init */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 		while ((p = strstr(secstrings + sechdrs[i].sh_name, ".init")))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 			p[0] = '_';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 		if (sechdrs[i].sh_type == SHT_SYMTAB)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 			dedotify((void *)hdr + sechdrs[i].sh_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 				 sechdrs[i].sh_size / sizeof(Elf64_Sym),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 				 (void *)hdr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 				 + sechdrs[sechdrs[i].sh_link].sh_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	if (!me->arch.stubs_section) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 		pr_err("%s: doesn't contain .stubs.\n", me->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 		return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	/* If we don't have a .toc, just use .stubs.  We need to set r2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 	   to some reasonable value in case the module calls out to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	   other functions via a stub, or if a function pointer escapes
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	   the module by some means.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	if (!me->arch.toc_section)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 		me->arch.toc_section = me->arch.stubs_section;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	/* Override the stubs size */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	sechdrs[me->arch.stubs_section].sh_size = get_stubs_size(hdr, sechdrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) #ifdef CONFIG_MPROFILE_KERNEL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) #define PACATOC offsetof(struct paca_struct, kernel_toc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)  * ld      r12,PACATOC(r13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)  * addis   r12,r12,<high>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344)  * addi    r12,r12,<low>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)  * mtctr   r12
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)  * bctr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) static u32 stub_insns[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	PPC_INST_LD | __PPC_RT(R12) | __PPC_RA(R13) | PACATOC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	PPC_INST_ADDIS | __PPC_RT(R12) | __PPC_RA(R12),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 	PPC_INST_ADDI | __PPC_RT(R12) | __PPC_RA(R12),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	PPC_INST_MTCTR | __PPC_RS(R12),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	PPC_INST_BCTR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)  * For mprofile-kernel we use a special stub for ftrace_caller() because we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)  * can't rely on r2 containing this module's TOC when we enter the stub.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360)  * That can happen if the function calling us didn't need to use the toc. In
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)  * that case it won't have setup r2, and the r2 value will be either the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)  * kernel's toc, or possibly another modules toc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)  * To deal with that this stub uses the kernel toc, which is always accessible
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)  * via the paca (in r13). The target (ftrace_caller()) is responsible for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)  * saving and restoring the toc before returning.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) static inline int create_ftrace_stub(struct ppc64_stub_entry *entry,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 					unsigned long addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 					struct module *me)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 	long reladdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 	memcpy(entry->jump, stub_insns, sizeof(stub_insns));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 	/* Stub uses address relative to kernel toc (from the paca) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 	reladdr = addr - kernel_toc_addr();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 	if (reladdr > 0x7FFFFFFF || reladdr < -(0x80000000L)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 		pr_err("%s: Address of %ps out of range of kernel_toc.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 							me->name, (void *)addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 	entry->jump[1] |= PPC_HA(reladdr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 	entry->jump[2] |= PPC_LO(reladdr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 	/* Eventhough we don't use funcdata in the stub, it's needed elsewhere. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 	entry->funcdata = func_desc(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	entry->magic = STUB_MAGIC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) static bool is_mprofile_ftrace_call(const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	if (!strcmp("_mcount", name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 		return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) #ifdef CONFIG_DYNAMIC_FTRACE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	if (!strcmp("ftrace_caller", name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 		return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	if (!strcmp("ftrace_regs_caller", name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 		return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 	return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) static inline int create_ftrace_stub(struct ppc64_stub_entry *entry,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 					unsigned long addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 					struct module *me)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) static bool is_mprofile_ftrace_call(const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 	return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)  * r2 is the TOC pointer: it actually points 0x8000 into the TOC (this gives the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)  * value maximum span in an instruction which uses a signed offset). Round down
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)  * to a 256 byte boundary for the odd case where we are setting up r2 without a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427)  * .toc section.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) static inline unsigned long my_r2(const Elf64_Shdr *sechdrs, struct module *me)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 	return (sechdrs[me->arch.toc_section].sh_addr & ~0xfful) + 0x8000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) /* Patch stub to reference function and correct r2 value. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) static inline int create_stub(const Elf64_Shdr *sechdrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 			      struct ppc64_stub_entry *entry,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 			      unsigned long addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 			      struct module *me,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 			      const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 	long reladdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 	if (is_mprofile_ftrace_call(name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 		return create_ftrace_stub(entry, addr, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 	memcpy(entry->jump, ppc64_stub_insns, sizeof(ppc64_stub_insns));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 	/* Stub uses address relative to r2. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 	reladdr = (unsigned long)entry - my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 	if (reladdr > 0x7FFFFFFF || reladdr < -(0x80000000L)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 		pr_err("%s: Address %p of stub out of range of %p.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 		       me->name, (void *)reladdr, (void *)my_r2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 	pr_debug("Stub %p get data from reladdr %li\n", entry, reladdr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 	entry->jump[0] |= PPC_HA(reladdr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 	entry->jump[1] |= PPC_LO(reladdr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 	entry->funcdata = func_desc(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 	entry->magic = STUB_MAGIC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) /* Create stub to jump to function described in this OPD/ptr: we need the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)    stub to set up the TOC ptr (r2) for the function. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) static unsigned long stub_for_addr(const Elf64_Shdr *sechdrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 				   unsigned long addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 				   struct module *me,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) 				   const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) 	struct ppc64_stub_entry *stubs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) 	unsigned int i, num_stubs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) 	num_stubs = sechdrs[me->arch.stubs_section].sh_size / sizeof(*stubs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 	/* Find this stub, or if that fails, the next avail. entry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 	stubs = (void *)sechdrs[me->arch.stubs_section].sh_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) 	for (i = 0; stub_func_addr(stubs[i].funcdata); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) 		if (WARN_ON(i >= num_stubs))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) 		if (stub_func_addr(stubs[i].funcdata) == func_addr(addr))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) 			return (unsigned long)&stubs[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) 	if (!create_stub(sechdrs, &stubs[i], addr, me, name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) 	return (unsigned long)&stubs[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) /* We expect a noop next: if it is, replace it with instruction to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)    restore r2. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) static int restore_r2(const char *name, u32 *instruction, struct module *me)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) 	u32 *prev_insn = instruction - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) 	if (is_mprofile_ftrace_call(name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) 	 * Make sure the branch isn't a sibling call.  Sibling calls aren't
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) 	 * "link" branches and they don't return, so they don't need the r2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) 	 * restore afterwards.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) 	if (!instr_is_relative_link_branch(ppc_inst(*prev_insn)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) 	if (*instruction != PPC_INST_NOP) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) 		pr_err("%s: Expected nop after call, got %08x at %pS\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) 			me->name, *instruction, instruction);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) 	/* ld r2,R2_STACK_OFFSET(r1) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) 	*instruction = PPC_INST_LD_TOC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) int apply_relocate_add(Elf64_Shdr *sechdrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) 		       const char *strtab,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) 		       unsigned int symindex,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) 		       unsigned int relsec,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) 		       struct module *me)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) 	unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) 	Elf64_Rela *rela = (void *)sechdrs[relsec].sh_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) 	Elf64_Sym *sym;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) 	unsigned long *location;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) 	unsigned long value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) 	pr_debug("Applying ADD relocate section %u to %u\n", relsec,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) 	       sechdrs[relsec].sh_info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) 	/* First time we're called, we can fix up .TOC. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) 	if (!me->arch.toc_fixed) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) 		sym = find_dot_toc(sechdrs, strtab, symindex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) 		/* It's theoretically possible that a module doesn't want a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) 		 * .TOC. so don't fail it just for that. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) 		if (sym)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) 			sym->st_value = my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) 		me->arch.toc_fixed = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) 	for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rela); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) 		/* This is where to make the change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) 		location = (void *)sechdrs[sechdrs[relsec].sh_info].sh_addr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) 			+ rela[i].r_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) 		/* This is the symbol it is referring to */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) 		sym = (Elf64_Sym *)sechdrs[symindex].sh_addr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) 			+ ELF64_R_SYM(rela[i].r_info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) 		pr_debug("RELOC at %p: %li-type as %s (0x%lx) + %li\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 		       location, (long)ELF64_R_TYPE(rela[i].r_info),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) 		       strtab + sym->st_name, (unsigned long)sym->st_value,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) 		       (long)rela[i].r_addend);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) 		/* `Everything is relative'. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) 		value = sym->st_value + rela[i].r_addend;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) 		switch (ELF64_R_TYPE(rela[i].r_info)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) 		case R_PPC64_ADDR32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) 			/* Simply set it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) 			*(u32 *)location = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) 		case R_PPC64_ADDR64:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) 			/* Simply set it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) 			*(unsigned long *)location = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) 		case R_PPC64_TOC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) 			*(unsigned long *)location = my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) 		case R_PPC64_TOC16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) 			/* Subtract TOC pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) 			value -= my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) 			if (value + 0x8000 > 0xffff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) 				pr_err("%s: bad TOC16 relocation (0x%lx)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) 				       me->name, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) 				return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) 			*((uint16_t *) location)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) 				= (*((uint16_t *) location) & ~0xffff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) 				| (value & 0xffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) 		case R_PPC64_TOC16_LO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) 			/* Subtract TOC pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) 			value -= my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) 			*((uint16_t *) location)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) 				= (*((uint16_t *) location) & ~0xffff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) 				| (value & 0xffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) 		case R_PPC64_TOC16_DS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) 			/* Subtract TOC pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) 			value -= my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) 			if ((value & 3) != 0 || value + 0x8000 > 0xffff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) 				pr_err("%s: bad TOC16_DS relocation (0x%lx)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) 				       me->name, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) 				return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) 			*((uint16_t *) location)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) 				= (*((uint16_t *) location) & ~0xfffc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) 				| (value & 0xfffc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) 		case R_PPC64_TOC16_LO_DS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) 			/* Subtract TOC pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) 			value -= my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) 			if ((value & 3) != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) 				pr_err("%s: bad TOC16_LO_DS relocation (0x%lx)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) 				       me->name, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) 				return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) 			*((uint16_t *) location)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) 				= (*((uint16_t *) location) & ~0xfffc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) 				| (value & 0xfffc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) 		case R_PPC64_TOC16_HA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) 			/* Subtract TOC pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) 			value -= my_r2(sechdrs, me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) 			value = ((value + 0x8000) >> 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) 			*((uint16_t *) location)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) 				= (*((uint16_t *) location) & ~0xffff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) 				| (value & 0xffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) 		case R_PPC_REL24:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) 			/* FIXME: Handle weak symbols here --RR */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) 			if (sym->st_shndx == SHN_UNDEF ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) 			    sym->st_shndx == SHN_LIVEPATCH) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) 				/* External: go via stub */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) 				value = stub_for_addr(sechdrs, value, me,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) 						strtab + sym->st_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) 				if (!value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) 					return -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) 				if (!restore_r2(strtab + sym->st_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) 							(u32 *)location + 1, me))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) 					return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) 			} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) 				value += local_entry_offset(sym);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) 			/* Convert value to relative */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) 			value -= (unsigned long)location;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) 			if (value + 0x2000000 > 0x3ffffff || (value & 3) != 0){
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) 				pr_err("%s: REL24 %li out of range!\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) 				       me->name, (long int)value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) 				return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) 			/* Only replace bits 2 through 26 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) 			*(uint32_t *)location
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) 				= (*(uint32_t *)location & ~0x03fffffc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) 				| (value & 0x03fffffc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) 		case R_PPC64_REL64:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) 			/* 64 bits relative (used by features fixups) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) 			*location = value - (unsigned long)location;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) 		case R_PPC64_REL32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) 			/* 32 bits relative (used by relative exception tables) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) 			/* Convert value to relative */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) 			value -= (unsigned long)location;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) 			if (value + 0x80000000 > 0xffffffff) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) 				pr_err("%s: REL32 %li out of range!\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) 				       me->name, (long int)value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) 				return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) 			*(u32 *)location = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) 		case R_PPC64_TOCSAVE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) 			/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) 			 * Marker reloc indicates we don't have to save r2.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) 			 * That would only save us one instruction, so ignore
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) 			 * it.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) 			 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) 		case R_PPC64_ENTRY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) 			/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) 			 * Optimize ELFv2 large code model entry point if
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) 			 * the TOC is within 2GB range of current location.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) 			 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) 			value = my_r2(sechdrs, me) - (unsigned long)location;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) 			if (value + 0x80008000 > 0xffffffff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) 			/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) 			 * Check for the large code model prolog sequence:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) 		         *	ld r2, ...(r12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) 			 *	add r2, r2, r12
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) 			 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) 			if ((((uint32_t *)location)[0] & ~0xfffc) !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) 			    (PPC_INST_LD | __PPC_RT(R2) | __PPC_RA(R12)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) 			if (((uint32_t *)location)[1] !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) 			    (PPC_INST_ADD | __PPC_RT(R2) | __PPC_RA(R2) | __PPC_RB(R12)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) 			/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) 			 * If found, replace it with:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) 			 *	addis r2, r12, (.TOC.-func)@ha
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) 			 *	addi  r2,  r2, (.TOC.-func)@l
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) 			 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) 			((uint32_t *)location)[0] = PPC_INST_ADDIS | __PPC_RT(R2) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) 						    __PPC_RA(R12) | PPC_HA(value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) 			((uint32_t *)location)[1] = PPC_INST_ADDI | __PPC_RT(R2) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) 						    __PPC_RA(R2) | PPC_LO(value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) 		case R_PPC64_REL16_HA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) 			/* Subtract location pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) 			value -= (unsigned long)location;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) 			value = ((value + 0x8000) >> 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) 			*((uint16_t *) location)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) 				= (*((uint16_t *) location) & ~0xffff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) 				| (value & 0xffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) 		case R_PPC64_REL16_LO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) 			/* Subtract location pointer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) 			value -= (unsigned long)location;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) 			*((uint16_t *) location)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) 				= (*((uint16_t *) location) & ~0xffff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) 				| (value & 0xffff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) 			pr_err("%s: Unknown ADD relocation: %lu\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) 			       me->name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) 			       (unsigned long)ELF64_R_TYPE(rela[i].r_info));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) 			return -ENOEXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) #ifdef CONFIG_DYNAMIC_FTRACE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) int module_trampoline_target(struct module *mod, unsigned long addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) 			     unsigned long *target)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) 	struct ppc64_stub_entry *stub;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) 	func_desc_t funcdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) 	u32 magic;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) 	if (!within_module_core(addr, mod)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) 		pr_err("%s: stub %lx not in module %s\n", __func__, addr, mod->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) 	stub = (struct ppc64_stub_entry *)addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) 	if (copy_from_kernel_nofault(&magic, &stub->magic,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) 			sizeof(magic))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) 		pr_err("%s: fault reading magic for stub %lx for %s\n", __func__, addr, mod->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) 	if (magic != STUB_MAGIC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) 		pr_err("%s: bad magic for stub %lx for %s\n", __func__, addr, mod->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) 	if (copy_from_kernel_nofault(&funcdata, &stub->funcdata,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) 			sizeof(funcdata))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) 		pr_err("%s: fault reading funcdata for stub %lx for %s\n", __func__, addr, mod->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773)                 return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) 	*target = stub_func_addr(funcdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) int module_finalize_ftrace(struct module *mod, const Elf_Shdr *sechdrs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) 	mod->arch.tramp = stub_for_addr(sechdrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) 					(unsigned long)ftrace_caller,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) 					mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) 					"ftrace_caller");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) 	mod->arch.tramp_regs = stub_for_addr(sechdrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) 					(unsigned long)ftrace_regs_caller,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) 					mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) 					"ftrace_regs_caller");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) 	if (!mod->arch.tramp_regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) 		return -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) 	if (!mod->arch.tramp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) 		return -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) #endif