383 lines
		
	
	
	
		
			9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			383 lines
		
	
	
	
		
			9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * (c) copyright 1987 by the Vrije Universiteit, Amsterdam, The Netherlands.
 | 
						|
 * See the copyright notice in the ACK home directory, in the file "Copyright".
 | 
						|
 */
 | 
						|
#ifndef lint
 | 
						|
static char rcsid[] = "$Id$";
 | 
						|
#endif
 | 
						|
 | 
						|
#include <stdlib.h>
 | 
						|
#include <stdio.h>
 | 
						|
#include <stdint.h>
 | 
						|
#include <assert.h>
 | 
						|
#include "out.h"
 | 
						|
#include "const.h"
 | 
						|
#include "debug.h"
 | 
						|
#include "defs.h"
 | 
						|
#include "orig.h"
 | 
						|
 | 
						|
#define UBYTE(x)	((x) & BYTEMASK)
 | 
						|
 | 
						|
static long read2(char* addr, int type)
 | 
						|
{
 | 
						|
	unsigned short word0, word1;
 | 
						|
 | 
						|
	if (type & RELBR)
 | 
						|
		return (UBYTE(addr[0]) << WIDTH) + UBYTE(addr[1]);
 | 
						|
	else
 | 
						|
		return (UBYTE(addr[1]) << WIDTH) + UBYTE(addr[0]);
 | 
						|
}
 | 
						|
 | 
						|
static long read4(char* addr, int type)
 | 
						|
{
 | 
						|
	unsigned short word0, word1;
 | 
						|
 | 
						|
	if (type & RELBR) {
 | 
						|
		word0 = (UBYTE(addr[0]) << WIDTH) + UBYTE(addr[1]);
 | 
						|
		word1 = (UBYTE(addr[2]) << WIDTH) + UBYTE(addr[3]);
 | 
						|
	} else {
 | 
						|
		word0 = (UBYTE(addr[1]) << WIDTH) + UBYTE(addr[0]);
 | 
						|
		word1 = (UBYTE(addr[3]) << WIDTH) + UBYTE(addr[2]);
 | 
						|
	}
 | 
						|
	if (type & RELWR)
 | 
						|
		return ((long)word0 << (2 * WIDTH)) + word1;
 | 
						|
	else
 | 
						|
		return ((long)word1 << (2 * WIDTH)) + word0;
 | 
						|
}
 | 
						|
 | 
						|
/* VideoCore 4 fixups are complex as we need to patch the instruction in
 | 
						|
 * one of several different ways (depending on what the instruction is).
 | 
						|
 */
 | 
						|
 | 
						|
static long get_vc4_valu(char* addr)
 | 
						|
{
 | 
						|
	uint16_t opcode = read2(addr, 0);
 | 
						|
 | 
						|
	if ((opcode & 0xff00) == 0xe700)
 | 
						|
	{
 | 
						|
		/* ld<w> rd, $+o:  [1110 0111 ww 0 d:5] [11111 o:27]
 | 
						|
		 * st<w> rd, $+o:  [1110 0111 ww 1 d:5] [11111 o:27]
 | 
						|
		 */
 | 
						|
 | 
						|
		int32_t value = read4(addr+2, 0);
 | 
						|
		value &= 0x07ffffff;
 | 
						|
		value = value<<5>>5;
 | 
						|
		return value;
 | 
						|
	}
 | 
						|
 | 
						|
	if ((opcode & 0xf080) == 0x9000)
 | 
						|
	{
 | 
						|
		/* b<cc> $+o*2:  [1001 cccc 0ooo oooo] [oooo oooo oooo oooo]
 | 
						|
		 * Yes, big-endian (the first 16 bits is the MSB).
 | 
						|
		 */
 | 
						|
 | 
						|
		uint32_t value = read4(addr, RELWR);
 | 
						|
		value &= 0x007fffff;
 | 
						|
		value = value<<9>>9;
 | 
						|
		value *= 2;
 | 
						|
		return value;
 | 
						|
	}
 | 
						|
 | 
						|
	if ((opcode & 0xf080) == 0x9080)
 | 
						|
	{
 | 
						|
		/* bl $+o*2:  [1001 oooo 1ooo oooo] [oooo oooo oooo oooo]
 | 
						|
		 * Yes, big-endian (the first 16 bits is the MSB).
 | 
						|
		 * (Note that o is split.)
 | 
						|
		 */
 | 
						|
 | 
						|
		int32_t value = read4(addr, RELWR);
 | 
						|
		int32_t lov = value & 0x007fffff;
 | 
						|
		int32_t hiv = value & 0x0f000000;
 | 
						|
		value = lov | (hiv>>1);
 | 
						|
		value = value<<5>>5;
 | 
						|
		value *= 2;
 | 
						|
		return value;
 | 
						|
	}
 | 
						|
 | 
						|
	if ((opcode & 0xffe0) == 0xe500)
 | 
						|
	{
 | 
						|
        /* lea: [1110 0101 000 d:5] [o:32] */
 | 
						|
 | 
						|
        return read4(addr+2, 0);
 | 
						|
    }
 | 
						|
 | 
						|
	assert(0 && "unrecognised VC4 instruction");
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * The bits in type indicate how many bytes the value occupies and what
 | 
						|
 * significance should be attributed to each byte.
 | 
						|
 */
 | 
						|
static long
 | 
						|
getvalu(addr, type)
 | 
						|
	char	addr[];
 | 
						|
	char	type;
 | 
						|
{
 | 
						|
	switch (type & RELSZ) {
 | 
						|
	case RELO1:
 | 
						|
		return UBYTE(addr[0]);
 | 
						|
	case RELO2:
 | 
						|
		return read2(addr, type);
 | 
						|
	case RELO4:
 | 
						|
		return read4(addr, type);
 | 
						|
	case RELOPPC:
 | 
						|
		return read4(addr, type) & 0x03FFFFFD;
 | 
						|
	case RELOH2:
 | 
						|
		return read2(addr, type) << 16;
 | 
						|
	case RELOVC4:
 | 
						|
		return get_vc4_valu(addr);
 | 
						|
	default:
 | 
						|
		fatal("bad relocation size");
 | 
						|
	}
 | 
						|
	/* NOTREACHED */
 | 
						|
}
 | 
						|
 | 
						|
static void write2(long valu, char* addr, int type)
 | 
						|
{
 | 
						|
	unsigned short	word0, word1;
 | 
						|
 | 
						|
	if (type & RELBR) {
 | 
						|
		addr[0] = valu >> WIDTH;
 | 
						|
		addr[1] = valu;
 | 
						|
	} else {
 | 
						|
		addr[0] = valu;
 | 
						|
		addr[1] = valu >> WIDTH;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void write4(long valu, char* addr, int type)
 | 
						|
{
 | 
						|
	unsigned short	word0, word1;
 | 
						|
 | 
						|
	if (type & RELWR) {
 | 
						|
		word0 = valu >> (2 * WIDTH);
 | 
						|
		word1 = valu;
 | 
						|
	} else {
 | 
						|
		word0 = valu;
 | 
						|
		word1 = valu >> (2 * WIDTH);
 | 
						|
	}
 | 
						|
	if (type & RELBR) {
 | 
						|
		addr[0] = word0 >> WIDTH;
 | 
						|
		addr[1] = word0;
 | 
						|
		addr[2] = word1 >> WIDTH;
 | 
						|
		addr[3] = word1;
 | 
						|
	} else {
 | 
						|
		addr[0] = word0;
 | 
						|
		addr[1] = word0 >> WIDTH;
 | 
						|
		addr[2] = word1;
 | 
						|
		addr[3] = word1 >> WIDTH;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/* VideoCore 4 fixups are complex as we need to patch the instruction in
 | 
						|
 * one of several different ways (depending on what the instruction is).
 | 
						|
 */
 | 
						|
 | 
						|
static void put_vc4_valu(char* addr, long value)
 | 
						|
{
 | 
						|
	uint16_t opcode = read2(addr, 0);
 | 
						|
 | 
						|
	if ((opcode & 0xff00) == 0xe700)
 | 
						|
	{
 | 
						|
		/* ld<w> rd, o, (pc):  [1110 0111 ww 0 d:5] [11111 o:27]
 | 
						|
		 * st<w> rd, o, (pc):  [1110 0111 ww 1 d:5] [11111 o:27]
 | 
						|
		 */
 | 
						|
 | 
						|
		uint32_t v = read4(addr+2, 0);
 | 
						|
		v &= 0xf8000000;
 | 
						|
		v |= value & 0x07ffffff;
 | 
						|
		write4(v, addr+2, 0);
 | 
						|
	}
 | 
						|
	else if ((opcode & 0xf080) == 0x9000)
 | 
						|
	{
 | 
						|
		/* b<cc> dest:  [1001 cccc 0ooo oooo] [oooo oooo oooo oooo]
 | 
						|
		 * Yes, big-endian (the first 16 bits is the MSB).
 | 
						|
		 */
 | 
						|
 | 
						|
		uint32_t v = read4(addr, RELWR);
 | 
						|
		v &= 0xff800000;
 | 
						|
		v |= (value/2) & 0x007fffff;
 | 
						|
		write4(v, addr, RELWR);
 | 
						|
	}
 | 
						|
	else if ((opcode & 0xf080) == 0x9080)
 | 
						|
	{
 | 
						|
		/* bl dest:  [1001 oooo 1ooo oooo] [oooo oooo oooo oooo]
 | 
						|
		 * Yes, big-endian (the first 16 bits is the MSB).
 | 
						|
		 * (Note that o is split.)
 | 
						|
		 */
 | 
						|
 | 
						|
		uint32_t v = read4(addr, RELWR);
 | 
						|
		uint32_t lovalue = (value/2) & 0x007fffff;
 | 
						|
		uint32_t hivalue = (value/2) & 0x07800000;
 | 
						|
		v &= 0xf0800000;
 | 
						|
		v |= lovalue | (hivalue<<1);
 | 
						|
		write4(v, addr, RELWR);
 | 
						|
	}
 | 
						|
	else if ((opcode & 0xffe0) == 0xe500)
 | 
						|
	{
 | 
						|
        /* lea: [1110 0101 000 d:5] [o:32] */
 | 
						|
 | 
						|
		write4(value, addr+2, 0);
 | 
						|
    }
 | 
						|
    else
 | 
						|
		assert(0 && "unrecognised VC4 instruction");
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * The bits in type indicate how many bytes the value occupies and what
 | 
						|
 * significance should be attributed to each byte.
 | 
						|
 * We do not check for overflow.
 | 
						|
 */
 | 
						|
static
 | 
						|
putvalu(valu, addr, type)
 | 
						|
	long	valu;
 | 
						|
	char	addr[];
 | 
						|
	char	type;
 | 
						|
{
 | 
						|
 | 
						|
	switch (type & RELSZ) {
 | 
						|
	case RELO1:
 | 
						|
		addr[0] = valu;
 | 
						|
		break;
 | 
						|
	case RELO2:
 | 
						|
		write2(valu, addr, type);
 | 
						|
		break;
 | 
						|
	case RELO4:
 | 
						|
		write4(valu, addr, type);
 | 
						|
		break;
 | 
						|
	case RELOPPC:
 | 
						|
	{
 | 
						|
		long i = read4(addr, type) & ~0x03FFFFFD;
 | 
						|
		i |= valu & 0x03FFFFFD;
 | 
						|
		write4(i, addr, type);
 | 
						|
		break;
 | 
						|
	}
 | 
						|
	case RELOH2:
 | 
						|
		write2(valu>>16, addr, type);
 | 
						|
		break;
 | 
						|
	case RELOVC4:
 | 
						|
		put_vc4_valu(addr, valu);
 | 
						|
		break;
 | 
						|
	default:
 | 
						|
		fatal("bad relocation size");
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
extern unsigned short	NLocals, NGlobals;
 | 
						|
extern struct outsect	outsect[];
 | 
						|
extern struct orig	relorig[];
 | 
						|
 | 
						|
/*
 | 
						|
 * There are two cases: `local' is an undefined external or common name,
 | 
						|
 * or `local' is a section name.
 | 
						|
 * First case: if the name has been defined in another module,
 | 
						|
 * its value is known and can be added. Or_nami will be the
 | 
						|
 * index of the name of the section in which this name was
 | 
						|
 * defined. Otherwise we must change or_nami to the index of
 | 
						|
 * this name in the name table of the output file and leave
 | 
						|
 * its value unchanged.
 | 
						|
 * Second case: we must update the value by the change
 | 
						|
 * in position of the section of local.
 | 
						|
 */
 | 
						|
static unsigned
 | 
						|
addrelo(relo, names, valu_out)
 | 
						|
	struct outrelo		*relo;
 | 
						|
	struct outname		*names;
 | 
						|
	long			*valu_out;	/* Out variable. */
 | 
						|
{
 | 
						|
	register struct outname	*local = &names[relo->or_nami];
 | 
						|
	register unsigned short		index = NLocals;
 | 
						|
	register long		valu = *valu_out;
 | 
						|
 | 
						|
	if ((local->on_type & S_SCT)) {
 | 
						|
		register int	sectindex = (local->on_type & S_TYP) - S_MIN;
 | 
						|
 | 
						|
		valu += relorig[sectindex].org_size;
 | 
						|
		valu += outsect[sectindex].os_base;
 | 
						|
		index += NGlobals + sectindex;
 | 
						|
	} else {
 | 
						|
		register struct outname	*name;
 | 
						|
		extern int		hash();
 | 
						|
		extern struct outname	*searchname();
 | 
						|
		extern unsigned 	indexof();
 | 
						|
		extern struct outhead	outhead; 
 | 
						|
 | 
						|
		name = searchname(local->on_mptr, hash(local->on_mptr));
 | 
						|
		if (name == (struct outname *)0)
 | 
						|
			fatal("name %s not found in pass 2", local->on_mptr);
 | 
						|
		if (ISCOMMON(name) || ISUNDEFINED(name)) {
 | 
						|
			debug("can't relocate from %s\n",local->on_mptr,0,0,0);
 | 
						|
			index += indexof(name);
 | 
						|
		} else {
 | 
						|
			valu += name->on_valu;
 | 
						|
			if ((name->on_type & S_TYP) == S_ABS) {
 | 
						|
				index += NGlobals + outhead.oh_nsect;
 | 
						|
			}
 | 
						|
			else	index += NGlobals +
 | 
						|
					(name->on_type & S_TYP) - S_MIN;
 | 
						|
		}
 | 
						|
	}
 | 
						|
	*valu_out = valu;
 | 
						|
	return index;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * This routine relocates a value in a section pointed to by `emit', of
 | 
						|
 * which the header is pointed to by `head'. Relocation is relative to the
 | 
						|
 * names in `names'; `relo' tells how to relocate.
 | 
						|
 */
 | 
						|
relocate(head, emit, names, relo, off)
 | 
						|
	struct outhead	*head;
 | 
						|
	char		*emit;
 | 
						|
	struct outname	names[];
 | 
						|
	struct outrelo	*relo;
 | 
						|
	long		off;
 | 
						|
{
 | 
						|
	long		valu;
 | 
						|
	int		sectindex = relo->or_sect - S_MIN;
 | 
						|
	extern struct outhead	outhead;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Pick up previous value at location to be relocated.
 | 
						|
	 */
 | 
						|
	valu = getvalu(emit + (relo->or_addr - off), relo->or_type);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Or_nami is an index in the name table of the considered module.
 | 
						|
	 * The name of which it is an index can be:
 | 
						|
	 *	- an undefined external or a common name
 | 
						|
	 *	- a section name
 | 
						|
	 *	- the first name outside! the name table (argh)
 | 
						|
	 */
 | 
						|
	if (relo->or_nami < head->oh_nname) {
 | 
						|
		/* First two cases. */
 | 
						|
		relo->or_nami = addrelo(relo, names, &valu);
 | 
						|
	} else {
 | 
						|
		/*
 | 
						|
		 * Third case: it is absolute. The relocation of absolute
 | 
						|
		 * names is always 0. We only need to change the index.
 | 
						|
		 */
 | 
						|
		relo->or_nami = NLocals + NGlobals + outhead.oh_nsect;
 | 
						|
	}
 | 
						|
 | 
						|
	/*
 | 
						|
	 * If relocation is pc-relative, we had to update the value by
 | 
						|
	 * the change in distance between the referencING and referencED
 | 
						|
	 * section. We already added the origin of the referencED section;
 | 
						|
	 * now we subtract the origin of the referencING section.
 | 
						|
	 */
 | 
						|
	if (relo->or_type & RELPC)
 | 
						|
		valu -=	relorig[sectindex].org_size+outsect[sectindex].os_base;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Now put the value back.
 | 
						|
	 */
 | 
						|
	putvalu(valu, emit + (relo->or_addr - off), relo->or_type);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * We must change the offset within the section of the value to be
 | 
						|
	 * relocated to its offset in the new section. `Or_addr' must again be
 | 
						|
	 * in the normal part, of course.
 | 
						|
	 */
 | 
						|
	relo->or_addr += relorig[sectindex].org_size;
 | 
						|
}
 |