mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
97 lines
2.5 KiB
97 lines
2.5 KiB
// 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); |
|
} |
|
} |
|
#else |
|
static 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 postition */ |
|
*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; |
|
}
|
|
|