fw-emu.c

这个linux源代码是很全面的~基本完整了~使用c编译的~由于时间问题我没有亲自测试~但就算用来做参考资料也是非常好的

/*
 * PAL & SAL emulation.
 *
 * Copyright (C) 1998-2001 Hewlett-Packard Co
 *	David Mosberger-Tang <[e-mail]>
 *
 * For the HP simulator, this file gets include in boot/bootloader.c.
 * For SoftSDV, this file gets included in sys_softsdv.c.
 */
#include <linux/config.h>

#ifdef CONFIG_PCI
# include <linux/pci.h>
#endif

#include <linux/efi.h>
#include <asm/io.h>
#include <asm/pal.h>
#include <asm/sal.h>

#define MB	(1024*1024UL)

#define SIMPLE_MEMMAP	1

#if SIMPLE_MEMMAP
# define NUM_MEM_DESCS	4
#else
# define NUM_MEM_DESCS	16
#endif

static char fw_mem[(  sizeof(struct ia64_boot_param)
		    + sizeof(efi_system_table_t)
		    + sizeof(efi_runtime_services_t)
		    + 1*sizeof(efi_config_table_t)
		    + sizeof(struct ia64_sal_systab)
		    + sizeof(struct ia64_sal_desc_entry_point)
		    + NUM_MEM_DESCS*(sizeof(efi_memory_desc_t))
		    + 1024)] __attribute__ ((aligned (8)));

#ifdef CONFIG_IA64_HP_SIM

/* Simulator system calls: */

#define SSC_EXIT	66

/*
 * Simulator system call.
 */
static long
ssc (long arg0, long arg1, long arg2, long arg3, int nr)
{
	register long r8 asm ("r8");

	asm volatile ("mov r15=%1\n\t"
		      "break 0x80001"
		      : "=r"(r8)
		      : "r"(nr), "r"(arg0), "r"(arg1), "r"(arg2), "r"(arg3));
	return r8;
}

#define SECS_PER_HOUR   (60 * 60)
#define SECS_PER_DAY    (SECS_PER_HOUR * 24)

/* Compute the `struct tm' representation of *T,
   offset OFFSET seconds east of UTC,
   and store year, yday, mon, mday, wday, hour, min, sec into *TP.
   Return nonzero if successful.  */
int
offtime (unsigned long t, efi_time_t *tp)
{
	const unsigned short int __mon_yday[2][13] =
	{
		/* Normal years.  */
		{ 0, 31, 59, 90, 120, 151, 181, 212, 243, 273, 304, 334, 365 },
		/* Leap years.  */
		{ 0, 31, 60, 91, 121, 152, 182, 213, 244, 274, 305, 335, 366 }
	};
	long int days, rem, y;
	const unsigned short int *ip;

	days = t / SECS_PER_DAY;
	rem = t % SECS_PER_DAY;
	while (rem < 0) {
		rem += SECS_PER_DAY;
		--days;
	}
	while (rem >= SECS_PER_DAY) {
		rem -= SECS_PER_DAY;
		++days;
	}
	tp->hour = rem / SECS_PER_HOUR;
	rem %= SECS_PER_HOUR;
	tp->minute = rem / 60;
	tp->second = rem % 60;
	/* January 1, 1970 was a Thursday.  */
	y = 1970;

#	define DIV(a, b) ((a) / (b) - ((a) % (b) < 0))
#	define LEAPS_THRU_END_OF(y) (DIV (y, 4) - DIV (y, 100) + DIV (y, 400))
#	define __isleap(year) \
	  ((year) % 4 == 0 && ((year) % 100 != 0 || (year) % 400 == 0))

	while (days < 0 || days >= (__isleap (y) ? 366 : 365)) {
		/* Guess a corrected year, assuming 365 days per year.  */
		long int yg = y + days / 365 - (days % 365 < 0);

		/* Adjust DAYS and Y to match the guessed year.  */
		days -= ((yg - y) * 365 + LEAPS_THRU_END_OF (yg - 1)
			 - LEAPS_THRU_END_OF (y - 1));
		y = yg;
	}
	tp->year = y;
	ip = __mon_yday[__isleap(y)];
	for (y = 11; days < (long int) ip[y]; --y)
		continue;
	days -= ip[y];
	tp->month = y + 1;
	tp->day = days + 1;
	return 1;
}

#endif /* CONFIG_IA64_HP_SIM */

/*
 * Very ugly, but we need this in the simulator only.  Once we run on
 * real hw, this can all go away.
 */
extern void pal_emulator_static (void);

asm (
"	.proc pal_emulator_static\n"
"pal_emulator_static:"
"	mov r8=-1\n"
"	mov r9=256\n"
"	;;\n"
"	cmp.gtu p6,p7=r9,r28		/* r28 <= 255? */\n"
"(p6)	br.cond.sptk.few static\n"
"	;;\n"
"	mov r9=512\n"
"	;;\n"
"	cmp.gtu p6,p7=r9,r28\n"
"(p6)	br.cond.sptk.few stacked\n"
"	;;\n"
"static:	cmp.eq p6,p7=6,r28		/* PAL_PTCE_INFO */\n"
"(p7)	br.cond.sptk.few 1f\n"
"	;;\n"
"	mov r8=0			/* status = 0 */\n"
"	movl r9=0x100000000		/* tc.base */\n"
"	movl r10=0x0000000200000003	/* count[0], count[1] */\n"
"	movl r11=0x1000000000002000	/* stride[0], stride[1] */\n"
"	br.cond.sptk.few rp\n"
"1:	cmp.eq p6,p7=14,r28		/* PAL_FREQ_RATIOS */\n"
"(p7)	br.cond.sptk.few 1f\n"
"	mov r8=0			/* status = 0 */\n"
"	movl r9 =0x100000064		/* proc_ratio (1/100) */\n"
"	movl r10=0x100000100		/* bus_ratio<<32 (1/256) */\n"
"	movl r11=0x100000064		/* itc_ratio<<32 (1/100) */\n"
"	;;\n"
"1:	cmp.eq p6,p7=19,r28		/* PAL_RSE_INFO */\n"
"(p7)	br.cond.sptk.few 1f\n"
"	mov r8=0			/* status = 0 */\n"
"	mov r9=96			/* num phys stacked */\n"
"	mov r10=0			/* hints */\n"
"	mov r11=0\n"
"	br.cond.sptk.few rp\n"
"1:	cmp.eq p6,p7=1,r28		/* PAL_CACHE_FLUSH */\n"
"(p7)	br.cond.sptk.few 1f\n"
"	mov r9=ar.lc\n"
"	movl r8=524288			/* flush 512k million cache lines (16MB) */\n"
"	;;\n"
"	mov ar.lc=r8\n"
"	movl r8=0xe000000000000000\n"
"	;;\n"
".loop:	fc r8\n"
"	add r8=32,r8\n"
"	br.cloop.sptk.few .loop\n"
"	sync.i\n"
"	;;\n"
"	srlz.i\n"
"	;;\n"
"	mov ar.lc=r9\n"
"	mov r8=r0\n"
"	;;\n"
"1:	cmp.eq p6,p7=15,r28		/* PAL_PERF_MON_INFO */\n"
"(p7)	br.cond.sptk.few 1f\n"
"	mov r8=0			/* status = 0 */\n"
"	movl r9 =0x12082004		/* generic=4 width=32 retired=8 cycles=18 */\n"
"	mov r10=0			/* reserved */\n"
"	mov r11=0			/* reserved */\n"
"	mov r16=0xffff			/* implemented PMC */\n"
"	mov r17=0xffff			/* implemented PMD */\n"
"	add r18=8,r29			/* second index */\n"
"	;;\n"
"	st8 [r29]=r16,16		/* store implemented PMC */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	;;\n"
"	st8 [r29]=r0,16			/* store implemented PMC */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	;;\n"
"	st8 [r29]=r17,16		/* store implemented PMD */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	mov r16=0xf0			/* cycles count capable PMC */\n"
"	;;\n"
"	st8 [r29]=r0,16			/* store implemented PMC */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	mov r17=0x10			/* retired bundles capable PMC */\n"
"	;;\n"
"	st8 [r29]=r16,16		/* store cycles capable */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	;;\n"
"	st8 [r29]=r0,16			/* store implemented PMC */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	;;\n"
"	st8 [r29]=r17,16		/* store retired bundle capable */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	;;\n"
"	st8 [r29]=r0,16			/* store implemented PMC */\n"
"	st8 [r18]=r0,16			/* clear remaining bits  */\n"
"	;;\n"
"1:	br.cond.sptk.few rp\n"
"stacked:\n"
"	br.ret.sptk.few rp\n"
"	.endp pal_emulator_static\n");

/* Macro to emulate SAL call using legacy IN and OUT calls to CF8, CFC etc.. */

#define BUILD_CMD(addr)		((0x80000000 | (addr)) & ~3)

#define REG_OFFSET(addr)	(0x00000000000000FF & (addr))
#define DEVICE_FUNCTION(addr)	(0x000000000000FF00 & (addr))
#define BUS_NUMBER(addr)	(0x0000000000FF0000 & (addr))

static efi_status_t
efi_get_time (efi_time_t *tm, efi_time_cap_t *tc)
{
#ifdef CONFIG_IA64_HP_SIM
	struct {
		int tv_sec;	/* must be 32bits to work */
		int tv_usec;
	} tv32bits;

	ssc((unsigned long) &tv32bits, 0, 0, 0, SSC_GET_TOD);

	memset(tm, 0, sizeof(*tm));
	offtime(tv32bits.tv_sec, tm);

	if (tc)
		memset(tc, 0, sizeof(*tc));
#else
#	error Not implemented yet...
#endif
	return EFI_SUCCESS;
}

static void
efi_reset_system (int reset_type, efi_status_t status, unsigned long data_size, efi_char16_t *data)
{
#ifdef CONFIG_IA64_HP_SIM
	ssc(status, 0, 0, 0, SSC_EXIT);
#else
#	error Not implemented yet...
#endif