[linux-2.6-block.git] / arch / blackfin / kernel / module.c

/*
 * Copyright 2004-2009 Analog Devices Inc.
 *
 * Licensed under the GPL-2 or later
 */

#define pr_fmt(fmt) "module %s: " fmt, mod->name

#include <linux/moduleloader.h>
#include <linux/elf.h>
#include <linux/vmalloc.h>
#include <linux/fs.h>
#include <linux/string.h>
#include <linux/kernel.h>
#include <asm/dma.h>
#include <asm/cacheflush.h>
#include <asm/uaccess.h>

/* Transfer the section to the L1 memory */
int
module_frob_arch_sections(Elf_Ehdr *hdr, Elf_Shdr *sechdrs,
			  char *secstrings, struct module *mod)
{
	/*
	 * XXX: sechdrs are vmalloced in kernel/module.c
	 * and would be vfreed just after module is loaded,
	 * so we hack to keep the only information we needed
	 * in mod->arch to correctly free L1 I/D sram later.
	 * NOTE: this breaks the semantic of mod->arch structure.
	 */
	Elf_Shdr *s, *sechdrs_end = sechdrs + hdr->e_shnum;
	void *dest;

	for (s = sechdrs; s < sechdrs_end; ++s) {
		const char *shname = secstrings + s->sh_name;

		if (s->sh_size == 0)
			continue;

		if (!strcmp(".l1.text", shname) ||
		    (!strcmp(".text", shname) &&
		     (hdr->e_flags & EF_BFIN_CODE_IN_L1))) {

			dest = l1_inst_sram_alloc(s->sh_size);
			mod->arch.text_l1 = dest;
			if (dest == NULL) {
				pr_err("L1 inst memory allocation failed\n");
				return -1;
			}
			dma_memcpy(dest, (void *)s->sh_addr, s->sh_size);

		} else if (!strcmp(".l1.data", shname) ||
		           (!strcmp(".data", shname) &&
		            (hdr->e_flags & EF_BFIN_DATA_IN_L1))) {

			dest = l1_data_sram_alloc(s->sh_size);
			mod->arch.data_a_l1 = dest;
			if (dest == NULL) {
				pr_err("L1 data memory allocation failed\n");
				return -1;
			}
			memcpy(dest, (void *)s->sh_addr, s->sh_size);

		} else if (!strcmp(".l1.bss", shname) ||
		           (!strcmp(".bss", shname) &&
		            (hdr->e_flags & EF_BFIN_DATA_IN_L1))) {

			dest = l1_data_sram_zalloc(s->sh_size);
			mod->arch.bss_a_l1 = dest;
			if (dest == NULL) {
				pr_err("L1 data memory allocation failed\n");
				return -1;
			}

		} else if (!strcmp(".l1.data.B", shname)) {

			dest = l1_data_B_sram_alloc(s->sh_size);
			mod->arch.data_b_l1 = dest;
			if (dest == NULL) {
				pr_err("L1 data memory allocation failed\n");
				return -1;
			}
			memcpy(dest, (void *)s->sh_addr, s->sh_size);

		} else if (!strcmp(".l1.bss.B", shname)) {

			dest = l1_data_B_sram_alloc(s->sh_size);
			mod->arch.bss_b_l1 = dest;
			if (dest == NULL) {
				pr_err("L1 data memory allocation failed\n");
				return -1;
			}
			memset(dest, 0, s->sh_size);

		} else if (!strcmp(".l2.text", shname) ||
		           (!strcmp(".text", shname) &&
		            (hdr->e_flags & EF_BFIN_CODE_IN_L2))) {

			dest = l2_sram_alloc(s->sh_size);
			mod->arch.text_l2 = dest;
			if (dest == NULL) {
				pr_err("L2 SRAM allocation failed\n");
				return -1;
			}
			memcpy(dest, (void *)s->sh_addr, s->sh_size);

		} else if (!strcmp(".l2.data", shname) ||
		           (!strcmp(".data", shname) &&
		            (hdr->e_flags & EF_BFIN_DATA_IN_L2))) {

			dest = l2_sram_alloc(s->sh_size);
			mod->arch.data_l2 = dest;
			if (dest == NULL) {
				pr_err("L2 SRAM allocation failed\n");
				return -1;
			}
			memcpy(dest, (void *)s->sh_addr, s->sh_size);

		} else if (!strcmp(".l2.bss", shname) ||
		           (!strcmp(".bss", shname) &&
		            (hdr->e_flags & EF_BFIN_DATA_IN_L2))) {

			dest = l2_sram_zalloc(s->sh_size);
			mod->arch.bss_l2 = dest;
			if (dest == NULL) {
				pr_err("L2 SRAM allocation failed\n");
				return -1;
			}

		} else
			continue;

		s->sh_flags &= ~SHF_ALLOC;
		s->sh_addr = (unsigned long)dest;
	}

	return 0;
}

/*************************************************************************/
/* FUNCTION : apply_relocate_add                                         */
/* ABSTRACT : Blackfin specific relocation handling for the loadable     */
/*            modules. Modules are expected to be .o files.              */
/*            Arithmetic relocations are handled.                        */
/*            We do not expect LSETUP to be split and hence is not       */
/*            handled.                                                   */
/*            R_BFIN_BYTE and R_BFIN_BYTE2 are also not handled as the   */
/*            gas does not generate it.                                  */
/*************************************************************************/
int
apply_relocate_add(Elf_Shdr *sechdrs, const char *strtab,
		   unsigned int symindex, unsigned int relsec,
		   struct module *mod)
{
	unsigned int i;
	Elf32_Rela *rel = (void *)sechdrs[relsec].sh_addr;
	Elf32_Sym *sym;
	unsigned long location, value, size;

	pr_debug("applying relocate section %u to %u\n",
		relsec, sechdrs[relsec].sh_info);

	for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rel); i++) {
		/* This is where to make the change */
		location = sechdrs[sechdrs[relsec].sh_info].sh_addr +
		           rel[i].r_offset;

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

#ifdef CONFIG_SMP
		if (location >= COREB_L1_DATA_A_START) {
			pr_err("cannot relocate in L1: %u (SMP kernel)\n",
				ELF32_R_TYPE(rel[i].r_info));
			return -ENOEXEC;
		}
#endif

		pr_debug("location is %lx, value is %lx type is %d\n",
			location, value, ELF32_R_TYPE(rel[i].r_info));

		switch (ELF32_R_TYPE(rel[i].r_info)) {

		case R_BFIN_HUIMM16:
			value >>= 16;
		case R_BFIN_LUIMM16:
		case R_BFIN_RIMM16:
			size = 2;
			break;
		case R_BFIN_BYTE4_DATA:
			size = 4;
			break;

		case R_BFIN_PCREL24:
		case R_BFIN_PCREL24_JUMP_L:
		case R_BFIN_PCREL12_JUMP:
		case R_BFIN_PCREL12_JUMP_S:
		case R_BFIN_PCREL10:
			pr_err("unsupported relocation: %u (no -mlong-calls?)\n",
				ELF32_R_TYPE(rel[i].r_info));
			return -ENOEXEC;

		default:
			pr_err("unknown relocation: %u\n",
				ELF32_R_TYPE(rel[i].r_info));
			return -ENOEXEC;
		}

		switch (bfin_mem_access_type(location, size)) {
		case BFIN_MEM_ACCESS_CORE:
		case BFIN_MEM_ACCESS_CORE_ONLY:
			memcpy((void *)location, &value, size);
			break;
		case BFIN_MEM_ACCESS_DMA:
			dma_memcpy((void *)location, &value, size);
			break;
		case BFIN_MEM_ACCESS_ITEST:
			isram_memcpy((void *)location, &value, size);
			break;
		default:
			pr_err("invalid relocation for %#lx\n", location);
			return -ENOEXEC;
		}
	}

	return 0;
}

int
module_finalize(const Elf_Ehdr * hdr,
		const Elf_Shdr * sechdrs, struct module *mod)
{
	unsigned int i, strindex = 0, symindex = 0;
	char *secstrings;
	long err = 0;

	secstrings = (void *)hdr + sechdrs[hdr->e_shstrndx].sh_offset;

	for (i = 1; i < hdr->e_shnum; i++) {
		/* Internal symbols and strings. */
		if (sechdrs[i].sh_type == SHT_SYMTAB) {
			symindex = i;
			strindex = sechdrs[i].sh_link;
		}
	}

	for (i = 1; i < hdr->e_shnum; i++) {
		const char *strtab = (char *)sechdrs[strindex].sh_addr;
		unsigned int info = sechdrs[i].sh_info;
		const char *shname = secstrings + sechdrs[i].sh_name;

		/* Not a valid relocation section? */
		if (info >= hdr->e_shnum)
			continue;

		/* Only support RELA relocation types */
		if (sechdrs[i].sh_type != SHT_RELA)
			continue;

		if (!strcmp(".rela.l2.text", shname) ||
		    !strcmp(".rela.l1.text", shname) ||
		    (!strcmp(".rela.text", shname) &&
			 (hdr->e_flags & (EF_BFIN_CODE_IN_L1 | EF_BFIN_CODE_IN_L2)))) {

			err = apply_relocate_add((Elf_Shdr *) sechdrs, strtab,
					   symindex, i, mod);
			if (err < 0)
				return -ENOEXEC;
		}
	}

	return 0;
}

void module_arch_cleanup(struct module *mod)
{
	l1_inst_sram_free(mod->arch.text_l1);
	l1_data_A_sram_free(mod->arch.data_a_l1);
	l1_data_A_sram_free(mod->arch.bss_a_l1);
	l1_data_B_sram_free(mod->arch.data_b_l1);
	l1_data_B_sram_free(mod->arch.bss_b_l1);
	l2_sram_free(mod->arch.text_l2);
	l2_sram_free(mod->arch.data_l2);
	l2_sram_free(mod->arch.bss_l2);
}
Commit	Line	Data
1394f032	1	/*
96f1050d	2	* Copyright 2004-2009 Analog Devices Inc.
1394f032	3	*
96f1050d	4	* Licensed under the GPL-2 or later
1394f032 BW	5	*/
1394f032 BW	6
b75a9e6b	7	#define pr_fmt(fmt) "module %s: " fmt, mod->name
1394f032 BW	8
	9	#include <linux/moduleloader.h>
	10	#include <linux/elf.h>
	11	#include <linux/vmalloc.h>
	12	#include <linux/fs.h>
	13	#include <linux/string.h>
	14	#include <linux/kernel.h>
	15	#include <asm/dma.h>
	16	#include <asm/cacheflush.h>
a7690940	17	#include <asm/uaccess.h>
1394f032	18
1394f032 BW	19	/* Transfer the section to the L1 memory */
1394f032 BW	20	int
459fec90	21	module_frob_arch_sections(Elf_Ehdr hdr, Elf_Shdr sechdrs,
1394f032 BW	22	char secstrings, struct module mod)
1394f032 BW	23	{
96a87e2f MF	24	/*
	25	* XXX: sechdrs are vmalloced in kernel/module.c
	26	* and would be vfreed just after module is loaded,
	27	* so we hack to keep the only information we needed
	28	* in mod->arch to correctly free L1 I/D sram later.
	29	* NOTE: this breaks the semantic of mod->arch structure.
	30	*/
1394f032	31	Elf_Shdr s, sechdrs_end = sechdrs + hdr->e_shnum;
459fec90	32	void *dest;
1394f032 BW	33
1394f032 BW	34	for (s = sechdrs; s < sechdrs_end; ++s) {
459fec90 MF	35	const char *shname = secstrings + s->sh_name;
	36
	37	if (s->sh_size == 0)
	38	continue;
	39
	40	if (!strcmp(".l1.text", shname) \|\|
	41	(!strcmp(".text", shname) &&
	42	(hdr->e_flags & EF_BFIN_CODE_IN_L1))) {
	43
1394f032	44	dest = l1_inst_sram_alloc(s->sh_size);
96a87e2f	45	mod->arch.text_l1 = dest;
1394f032	46	if (dest == NULL) {
b75a9e6b	47	pr_err("L1 inst memory allocation failed\n");
1394f032 BW	48	return -1;
	49	}
	50	dma_memcpy(dest, (void *)s->sh_addr, s->sh_size);
459fec90 MF	51
	52	} else if (!strcmp(".l1.data", shname) \|\|
	53	(!strcmp(".data", shname) &&
	54	(hdr->e_flags & EF_BFIN_DATA_IN_L1))) {
	55
1394f032	56	dest = l1_data_sram_alloc(s->sh_size);
96a87e2f	57	mod->arch.data_a_l1 = dest;
1394f032	58	if (dest == NULL) {
b75a9e6b	59	pr_err("L1 data memory allocation failed\n");
1394f032 BW	60	return -1;
	61	}
	62	memcpy(dest, (void *)s->sh_addr, s->sh_size);
459fec90 MF	63
	64	} else if (!strcmp(".l1.bss", shname) \|\|
	65	(!strcmp(".bss", shname) &&
	66	(hdr->e_flags & EF_BFIN_DATA_IN_L1))) {
	67
70deca9f	68	dest = l1_data_sram_zalloc(s->sh_size);
96a87e2f	69	mod->arch.bss_a_l1 = dest;
1394f032	70	if (dest == NULL) {
b75a9e6b	71	pr_err("L1 data memory allocation failed\n");
1394f032 BW	72	return -1;
1394f032 BW	73	}
459fec90 MF	74
	75	} else if (!strcmp(".l1.data.B", shname)) {
	76
1394f032	77	dest = l1_data_B_sram_alloc(s->sh_size);
96a87e2f	78	mod->arch.data_b_l1 = dest;
1394f032	79	if (dest == NULL) {
b75a9e6b	80	pr_err("L1 data memory allocation failed\n");
1394f032 BW	81	return -1;
	82	}
	83	memcpy(dest, (void *)s->sh_addr, s->sh_size);
459fec90 MF	84
	85	} else if (!strcmp(".l1.bss.B", shname)) {
	86
1394f032	87	dest = l1_data_B_sram_alloc(s->sh_size);
96a87e2f	88	mod->arch.bss_b_l1 = dest;
1394f032	89	if (dest == NULL) {
b75a9e6b	90	pr_err("L1 data memory allocation failed\n");
1394f032 BW	91	return -1;
	92	}
	93	memset(dest, 0, s->sh_size);
459fec90 MF	94
	95	} else if (!strcmp(".l2.text", shname) \|\|
	96	(!strcmp(".text", shname) &&
	97	(hdr->e_flags & EF_BFIN_CODE_IN_L2))) {
	98
262c3825 SZ	99	dest = l2_sram_alloc(s->sh_size);
	100	mod->arch.text_l2 = dest;
	101	if (dest == NULL) {
b75a9e6b	102	pr_err("L2 SRAM allocation failed\n");
262c3825 SZ	103	return -1;
	104	}
	105	memcpy(dest, (void *)s->sh_addr, s->sh_size);
459fec90 MF	106
	107	} else if (!strcmp(".l2.data", shname) \|\|
	108	(!strcmp(".data", shname) &&
	109	(hdr->e_flags & EF_BFIN_DATA_IN_L2))) {
	110
262c3825 SZ	111	dest = l2_sram_alloc(s->sh_size);
	112	mod->arch.data_l2 = dest;
	113	if (dest == NULL) {
b75a9e6b	114	pr_err("L2 SRAM allocation failed\n");
262c3825 SZ	115	return -1;
	116	}
	117	memcpy(dest, (void *)s->sh_addr, s->sh_size);
459fec90 MF	118
	119	} else if (!strcmp(".l2.bss", shname) \|\|
	120	(!strcmp(".bss", shname) &&
	121	(hdr->e_flags & EF_BFIN_DATA_IN_L2))) {
	122
70deca9f	123	dest = l2_sram_zalloc(s->sh_size);
262c3825 SZ	124	mod->arch.bss_l2 = dest;
262c3825 SZ	125	if (dest == NULL) {
b75a9e6b	126	pr_err("L2 SRAM allocation failed\n");
262c3825 SZ	127	return -1;
262c3825 SZ	128	}
459fec90 MF	129
	130	} else
	131	continue;
	132
	133	s->sh_flags &= ~SHF_ALLOC;
	134	s->sh_addr = (unsigned long)dest;
1394f032	135	}
459fec90	136
1394f032 BW	137	return 0;
	138	}
	139
1394f032 BW	140	/*************************************************************************/
	141	/* FUNCTION : apply_relocate_add */
	142	/* ABSTRACT : Blackfin specific relocation handling for the loadable */
	143	/* modules. Modules are expected to be .o files. */
	144	/* Arithmetic relocations are handled. */
	145	/* We do not expect LSETUP to be split and hence is not */
	146	/* handled. */
595d681f MF	147	/* R_BFIN_BYTE and R_BFIN_BYTE2 are also not handled as the */
595d681f MF	148	/* gas does not generate it. */
1394f032 BW	149	/*************************************************************************/
1394f032 BW	150	int
a7690940	151	apply_relocate_add(Elf_Shdr sechdrs, const char strtab,
1394f032 BW	152	unsigned int symindex, unsigned int relsec,
	153	struct module *mod)
	154	{
	155	unsigned int i;
1394f032 BW	156	Elf32_Rela rel = (void )sechdrs[relsec].sh_addr;
1394f032 BW	157	Elf32_Sym *sym;
a7690940	158	unsigned long location, value, size;
1394f032	159
b75a9e6b	160	pr_debug("applying relocate section %u to %u\n",
dc6b1ac9	161	relsec, sechdrs[relsec].sh_info);
a7690940	162
1394f032 BW	163	for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rel); i++) {
1394f032 BW	164	/* This is where to make the change */
a7690940 MF	165	location = sechdrs[sechdrs[relsec].sh_info].sh_addr +
	166	rel[i].r_offset;
	167
1394f032 BW	168	/* This is the symbol it is referring to. Note that all
	169	undefined symbols have been resolved. */
	170	sym = (Elf32_Sym *) sechdrs[symindex].sh_addr
	171	+ ELF32_R_SYM(rel[i].r_info);
d1a85305	172	value = sym->st_value;
1394f032	173	value += rel[i].r_addend;
dc6b1ac9	174
8f65873e	175	#ifdef CONFIG_SMP
a7690940	176	if (location >= COREB_L1_DATA_A_START) {
b75a9e6b JP	177	pr_err("cannot relocate in L1: %u (SMP kernel)\n",
b75a9e6b JP	178	ELF32_R_TYPE(rel[i].r_info));
8f65873e GY	179	return -ENOEXEC;
	180	}
	181	#endif
dc6b1ac9	182
a7690940	183	pr_debug("location is %lx, value is %lx type is %d\n",
b75a9e6b	184	location, value, ELF32_R_TYPE(rel[i].r_info));
dc6b1ac9	185
1394f032 BW	186	switch (ELF32_R_TYPE(rel[i].r_info)) {
1394f032 BW	187
595d681f	188	case R_BFIN_HUIMM16:
a7690940 MF	189	value >>= 16;
a7690940 MF	190	case R_BFIN_LUIMM16:
595d681f	191	case R_BFIN_RIMM16:
a7690940	192	size = 2;
1394f032	193	break;
595d681f	194	case R_BFIN_BYTE4_DATA:
a7690940	195	size = 4;
1394f032	196	break;
a7690940	197
22532578 RG	198	case R_BFIN_PCREL24:
	199	case R_BFIN_PCREL24_JUMP_L:
	200	case R_BFIN_PCREL12_JUMP:
	201	case R_BFIN_PCREL12_JUMP_S:
	202	case R_BFIN_PCREL10:
dc6b1ac9	203	pr_err("unsupported relocation: %u (no -mlong-calls?)\n",
b75a9e6b	204	ELF32_R_TYPE(rel[i].r_info));
22532578	205	return -ENOEXEC;
a7690940	206
1394f032	207	default:
b75a9e6b	208	pr_err("unknown relocation: %u\n",
dc6b1ac9	209	ELF32_R_TYPE(rel[i].r_info));
1394f032 BW	210	return -ENOEXEC;
1394f032 BW	211	}
a7690940 MF	212
	213	switch (bfin_mem_access_type(location, size)) {
	214	case BFIN_MEM_ACCESS_CORE:
	215	case BFIN_MEM_ACCESS_CORE_ONLY:
	216	memcpy((void *)location, &value, size);
	217	break;
	218	case BFIN_MEM_ACCESS_DMA:
	219	dma_memcpy((void *)location, &value, size);
	220	break;
	221	case BFIN_MEM_ACCESS_ITEST:
	222	isram_memcpy((void *)location, &value, size);
	223	break;
	224	default:
b75a9e6b	225	pr_err("invalid relocation for %#lx\n", location);
a7690940 MF	226	return -ENOEXEC;
a7690940 MF	227	}
1394f032	228	}
a7690940	229
1394f032 BW	230	return 0;
	231	}
	232
	233	int
	234	module_finalize(const Elf_Ehdr * hdr,
	235	const Elf_Shdr * sechdrs, struct module *mod)
	236	{
	237	unsigned int i, strindex = 0, symindex = 0;
	238	char *secstrings;
8f65873e	239	long err = 0;
1394f032 BW	240
	241	secstrings = (void *)hdr + sechdrs[hdr->e_shstrndx].sh_offset;
	242
	243	for (i = 1; i < hdr->e_shnum; i++) {
	244	/* Internal symbols and strings. */
	245	if (sechdrs[i].sh_type == SHT_SYMTAB) {
	246	symindex = i;
	247	strindex = sechdrs[i].sh_link;
	248	}
	249	}
	250
	251	for (i = 1; i < hdr->e_shnum; i++) {
	252	const char strtab = (char )sechdrs[strindex].sh_addr;
	253	unsigned int info = sechdrs[i].sh_info;
459fec90	254	const char *shname = secstrings + sechdrs[i].sh_name;
1394f032 BW	255
	256	/* Not a valid relocation section? */
	257	if (info >= hdr->e_shnum)
	258	continue;
	259
459fec90 MF	260	/* Only support RELA relocation types */
	261	if (sechdrs[i].sh_type != SHT_RELA)
	262	continue;
	263
	264	if (!strcmp(".rela.l2.text", shname) \|\|
	265	!strcmp(".rela.l1.text", shname) \|\|
	266	(!strcmp(".rela.text", shname) &&
	267	(hdr->e_flags & (EF_BFIN_CODE_IN_L1 \| EF_BFIN_CODE_IN_L2)))) {
	268
8f65873e	269	err = apply_relocate_add((Elf_Shdr *) sechdrs, strtab,
1394f032	270	symindex, i, mod);
8f65873e GY	271	if (err < 0)
8f65873e GY	272	return -ENOEXEC;
1394f032 BW	273	}
1394f032 BW	274	}
459fec90	275
1394f032 BW	276	return 0;
	277	}
	278
	279	void module_arch_cleanup(struct module *mod)
	280	{
262c3825 SZ	281	l1_inst_sram_free(mod->arch.text_l1);
	282	l1_data_A_sram_free(mod->arch.data_a_l1);
	283	l1_data_A_sram_free(mod->arch.bss_a_l1);
	284	l1_data_B_sram_free(mod->arch.data_b_l1);
	285	l1_data_B_sram_free(mod->arch.bss_b_l1);
	286	l2_sram_free(mod->arch.text_l2);
	287	l2_sram_free(mod->arch.data_l2);
	288	l2_sram_free(mod->arch.bss_l2);
1394f032	289	}