97 lines · 2.5 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd. #include <linux/moduleloader.h>#include <linux/elf.h>#include <linux/mm.h>#include <linux/vmalloc.h>#include <linux/slab.h>#include <linux/fs.h>#include <linux/string.h>#include <linux/kernel.h>#include <linux/spinlock.h> #ifdef CONFIG_CPU_CK810#define IS_BSR32(hi16, lo16)		(((hi16) & 0xFC00) == 0xE000)#define IS_JSRI32(hi16, lo16)		((hi16) == 0xEAE0) #define CHANGE_JSRI_TO_LRW(addr) do {					\	*(uint16_t *)(addr) = (*(uint16_t *)(addr) & 0xFF9F) | 0x001a;	\	*((uint16_t *)(addr) + 1) = *((uint16_t *)(addr) + 1) & 0xFFFF;	\} while (0) #define SET_JSR32_R26(addr) do {		\	*(uint16_t *)(addr) = 0xE8Fa;		\	*((uint16_t *)(addr) + 1) = 0x0000;	\} while (0) static void jsri_2_lrw_jsr(uint32_t *location){	uint16_t *location_tmp = (uint16_t *)location; 	if (IS_BSR32(*location_tmp, *(location_tmp + 1)))		return; 	if (IS_JSRI32(*location_tmp, *(location_tmp + 1))) {		/* jsri 0x...  --> lrw r26, 0x... */		CHANGE_JSRI_TO_LRW(location);		/* lsli r0, r0 --> jsr r26 */		SET_JSR32_R26(location + 1);	}}#elsestatic void inline jsri_2_lrw_jsr(uint32_t *location){	return;}#endif int apply_relocate_add(Elf32_Shdr *sechdrs, const char *strtab,		unsigned int symindex, unsigned int relsec, struct module *me){	unsigned int i;	Elf32_Rela	*rel = (void *) sechdrs[relsec].sh_addr;	Elf32_Sym	*sym;	uint32_t	*location;	short		*temp; 	for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rel); i++) {		/* This is where to make the change */		location = (void *)sechdrs[sechdrs[relsec].sh_info].sh_addr							+ rel[i].r_offset;		sym = (Elf32_Sym *)sechdrs[symindex].sh_addr						+ ELF32_R_SYM(rel[i].r_info); 		switch (ELF32_R_TYPE(rel[i].r_info)) {		case R_CSKY_32:			/* We add the value into the location given */			*location = rel[i].r_addend + sym->st_value;			break;		case R_CSKY_PC32:			/* Add the value, subtract its position */			*location = rel[i].r_addend + sym->st_value							- (uint32_t)location;			break;		case R_CSKY_PCRELJSR_IMM11BY2:			break;		case R_CSKY_PCRELJSR_IMM26BY2:			jsri_2_lrw_jsr(location);			break;		case R_CSKY_ADDR_HI16:			temp = ((short  *)location) + 1;			*temp = (short)				((rel[i].r_addend + sym->st_value) >> 16);			break;		case R_CSKY_ADDR_LO16:			temp = ((short  *)location) + 1;			*temp = (short)				((rel[i].r_addend + sym->st_value) & 0xffff);			break;		default:			pr_err("module %s: Unknown relocation: %u\n",				me->name, ELF32_R_TYPE(rel[i].r_info));			return -ENOEXEC;		}	}	return 0;}