[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / c6x / kernel / module.c

/*
 *  Port on Texas Instruments TMS320C6x architecture
 *
 *  Copyright (C) 2005, 2009, 2010, 2011 Texas Instruments Incorporated
 *  Author: Thomas Charleux (thomas.charleux@jaluna.com)
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 *
 */
#include <linux/moduleloader.h>
#include <linux/elf.h>
#include <linux/vmalloc.h>
#include <linux/kernel.h>

static inline int fixup_pcr(u32 *ip, Elf32_Addr dest, u32 maskbits, int shift)
{
	u32 opcode;
	long ep = (long)ip & ~31;
	long delta = ((long)dest - ep) >> 2;
	long mask = (1 << maskbits) - 1;

	if ((delta >> (maskbits - 1)) == 0 ||
	    (delta >> (maskbits - 1)) == -1) {
		opcode = *ip;
		opcode &= ~(mask << shift);
		opcode |= ((delta & mask) << shift);
		*ip = opcode;

		pr_debug("REL PCR_S%d[%p] dest[%p] opcode[%08x]\n",
			 maskbits, ip, (void *)dest, opcode);

		return 0;
	}
	pr_err("PCR_S%d reloc %p -> %p out of range!\n",
	       maskbits, ip, (void *)dest);

	return -1;
}

/*
 * apply a RELA relocation
 */
int apply_relocate_add(Elf32_Shdr *sechdrs,
		       const char *strtab,
		       unsigned int symindex,
		       unsigned int relsec,
		       struct module *me)
{
	Elf32_Rela *rel = (void *) sechdrs[relsec].sh_addr;
	Elf_Sym *sym;
	u32 *location, opcode;
	unsigned int i;
	Elf32_Addr v;
	Elf_Addr offset = 0;

	pr_debug("Applying relocate section %u to %u with offset 0x%x\n",
		 relsec, sechdrs[relsec].sh_info, offset);

	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 - offset;

		/* This is the symbol it is referring to.  Note that all
		   undefined symbols have been resolved.  */
		sym = (Elf_Sym *)sechdrs[symindex].sh_addr
			+ ELF32_R_SYM(rel[i].r_info);

		/* this is the adjustment to be made */
		v = sym->st_value + rel[i].r_addend;

		switch (ELF32_R_TYPE(rel[i].r_info)) {
		case R_C6000_ABS32:
			pr_debug("RELA ABS32: [%p] = 0x%x\n", location, v);
			*location = v;
			break;
		case R_C6000_ABS16:
			pr_debug("RELA ABS16: [%p] = 0x%x\n", location, v);
			*(u16 *)location = v;
			break;
		case R_C6000_ABS8:
			pr_debug("RELA ABS8: [%p] = 0x%x\n", location, v);
			*(u8 *)location = v;
			break;
		case R_C6000_ABS_L16:
			opcode = *location;
			opcode &= ~0x7fff80;
			opcode |= ((v & 0xffff) << 7);
			pr_debug("RELA ABS_L16[%p] v[0x%x] opcode[0x%x]\n",
				 location, v, opcode);
			*location = opcode;
			break;
		case R_C6000_ABS_H16:
			opcode = *location;
			opcode &= ~0x7fff80;
			opcode |= ((v >> 9) & 0x7fff80);
			pr_debug("RELA ABS_H16[%p] v[0x%x] opcode[0x%x]\n",
				 location, v, opcode);
			*location = opcode;
			break;
		case R_C6000_PCR_S21:
			if (fixup_pcr(location, v, 21, 7))
				return -ENOEXEC;
			break;
		case R_C6000_PCR_S12:
			if (fixup_pcr(location, v, 12, 16))
				return -ENOEXEC;
			break;
		case R_C6000_PCR_S10:
			if (fixup_pcr(location, v, 10, 13))
				return -ENOEXEC;
			break;
		default:
			pr_err("module %s: Unknown RELA relocation: %u\n",
			       me->name, ELF32_R_TYPE(rel[i].r_info));
			return -ENOEXEC;
		}
	}

	return 0;
}
Commit	Line	Data
64236ac1 AJ	1	/*
	2	* Port on Texas Instruments TMS320C6x architecture
	3	*
	4	* Copyright (C) 2005, 2009, 2010, 2011 Texas Instruments Incorporated
	5	* Author: Thomas Charleux (thomas.charleux@jaluna.com)
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License version 2 as
	9	* published by the Free Software Foundation.
	10	*
	11	*/
	12	#include <linux/moduleloader.h>
	13	#include <linux/elf.h>
	14	#include <linux/vmalloc.h>
	15	#include <linux/kernel.h>
	16
	17	static inline int fixup_pcr(u32 *ip, Elf32_Addr dest, u32 maskbits, int shift)
	18	{
	19	u32 opcode;
	20	long ep = (long)ip & ~31;
	21	long delta = ((long)dest - ep) >> 2;
	22	long mask = (1 << maskbits) - 1;
	23
	24	if ((delta >> (maskbits - 1)) == 0 \|\|
	25	(delta >> (maskbits - 1)) == -1) {
	26	opcode = *ip;
	27	opcode &= ~(mask << shift);
	28	opcode \|= ((delta & mask) << shift);
	29	*ip = opcode;
	30
	31	pr_debug("REL PCR_S%d[%p] dest[%p] opcode[%08x]\n",
	32	maskbits, ip, (void *)dest, opcode);
	33
	34	return 0;
	35	}
	36	pr_err("PCR_S%d reloc %p -> %p out of range!\n",
	37	maskbits, ip, (void *)dest);
	38
	39	return -1;
	40	}
	41
	42	/*
	43	* apply a RELA relocation
	44	*/
	45	int apply_relocate_add(Elf32_Shdr *sechdrs,
	46	const char *strtab,
	47	unsigned int symindex,
	48	unsigned int relsec,
	49	struct module *me)
	50	{
	51	Elf32_Rela rel = (void ) sechdrs[relsec].sh_addr;
	52	Elf_Sym *sym;
	53	u32 *location, opcode;
	54	unsigned int i;
	55	Elf32_Addr v;
	56	Elf_Addr offset = 0;
	57
	58	pr_debug("Applying relocate section %u to %u with offset 0x%x\n",
	59	relsec, sechdrs[relsec].sh_info, offset);
	60
	61	for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rel); i++) {
	62	/* This is where to make the change */
	63	location = (void *)sechdrs[sechdrs[relsec].sh_info].sh_addr
	64	+ rel[i].r_offset - offset;
65
66	/* This is the symbol it is referring to. Note that all
67	undefined symbols have been resolved. */
68	sym = (Elf_Sym *)sechdrs[symindex].sh_addr
69	+ ELF32_R_SYM(rel[i].r_info);
70
71	/* this is the adjustment to be made */
72	v = sym->st_value + rel[i].r_addend;
73
74	switch (ELF32_R_TYPE(rel[i].r_info)) {
75	case R_C6000_ABS32:
76	pr_debug("RELA ABS32: [%p] = 0x%x\n", location, v);
77	*location = v;
78	break;
79	case R_C6000_ABS16:
80	pr_debug("RELA ABS16: [%p] = 0x%x\n", location, v);
81	(u16 )location = v;
82	break;
83	case R_C6000_ABS8:
84	pr_debug("RELA ABS8: [%p] = 0x%x\n", location, v);
85	(u8 )location = v;
86	break;
87	case R_C6000_ABS_L16:
88	opcode = *location;
89	opcode &= ~0x7fff80;
90	opcode \|= ((v & 0xffff) << 7);
91	pr_debug("RELA ABS_L16[%p] v[0x%x] opcode[0x%x]\n",
92	location, v, opcode);
93	*location = opcode;
94	break;
95	case R_C6000_ABS_H16:
96	opcode = *location;
97	opcode &= ~0x7fff80;
98	opcode \|= ((v >> 9) & 0x7fff80);
99	pr_debug("RELA ABS_H16[%p] v[0x%x] opcode[0x%x]\n",
100	location, v, opcode);
101	*location = opcode;
102	break;
103	case R_C6000_PCR_S21:
104	if (fixup_pcr(location, v, 21, 7))
105	return -ENOEXEC;
106	break;
107	case R_C6000_PCR_S12:
108	if (fixup_pcr(location, v, 12, 16))
109	return -ENOEXEC;
110	break;
111	case R_C6000_PCR_S10:
112	if (fixup_pcr(location, v, 10, 13))
113	return -ENOEXEC;
114	break;
115	default:
116	pr_err("module %s: Unknown RELA relocation: %u\n",
117	me->name, ELF32_R_TYPE(rel[i].r_info));
118	return -ENOEXEC;
119	}
120	}
121
122	return 0;
123	}