while others dislike them being extra commits, let's clean them up once and for all for the existing code. If it's ugly, let it only be ugly once :-) Signed-off-by: Stefan Reinauer <stepan@coresystems.de> Acked-by: Stefan Reinauer <stepan@coresystems.de> git-svn-id: svn://svn.coreboot.org/coreboot/trunk@5507 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
		
			
				
	
	
		
			464 lines
		
	
	
		
			13 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			464 lines
		
	
	
		
			13 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
struct syscall_result {
 | 
						|
	long val;
 | 
						|
	int errno;
 | 
						|
};
 | 
						|
 | 
						|
static struct syscall_result syscall_return(long result)
 | 
						|
{
 | 
						|
	struct syscall_result res;
 | 
						|
	if (((unsigned long)result) >= ((unsigned long)-125)) {
 | 
						|
		res.errno = - result;
 | 
						|
		res.val = -1;
 | 
						|
	} else {
 | 
						|
		res.errno = 0;
 | 
						|
		res.val = result;
 | 
						|
	}
 | 
						|
	return res;
 | 
						|
}
 | 
						|
 | 
						|
static struct syscall_result syscall0(unsigned long nr)
 | 
						|
{
 | 
						|
	long res;
 | 
						|
	asm volatile(
 | 
						|
		"int $0x80"
 | 
						|
		: "=a" (res)
 | 
						|
		: "a" (nr));
 | 
						|
	return syscall_return(res);
 | 
						|
}
 | 
						|
 | 
						|
static struct syscall_result syscall1(unsigned long nr, unsigned long arg1)
 | 
						|
{
 | 
						|
	long res;
 | 
						|
	asm volatile(
 | 
						|
		"int $0x80"
 | 
						|
		: "=a" (res)
 | 
						|
		: "a" (nr), "b" (arg1));
 | 
						|
	return syscall_return(res);
 | 
						|
 | 
						|
}
 | 
						|
 | 
						|
static struct syscall_result syscall2(unsigned long nr, unsigned long arg1, unsigned long arg2)
 | 
						|
{
 | 
						|
	long res;
 | 
						|
	asm volatile(
 | 
						|
		"int $0x80"
 | 
						|
		: "=a" (res)
 | 
						|
		: "a" (nr), "b" (arg1), "c" (arg2));
 | 
						|
	return syscall_return(res);
 | 
						|
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
static struct syscall_result syscall3(unsigned long nr, unsigned long arg1, unsigned long arg2,
 | 
						|
	unsigned long arg3)
 | 
						|
{
 | 
						|
	long res;
 | 
						|
	asm volatile(
 | 
						|
		"int $0x80"
 | 
						|
		: "=a" (res)
 | 
						|
		: "a" (nr), "b" (arg1), "c" (arg2), "d" (arg3));
 | 
						|
	return syscall_return(res);
 | 
						|
 | 
						|
}
 | 
						|
 | 
						|
static struct syscall_result syscall4(unsigned long nr, unsigned long arg1, unsigned long arg2,
 | 
						|
	unsigned long arg3, unsigned long arg4)
 | 
						|
{
 | 
						|
	long res;
 | 
						|
	asm volatile(
 | 
						|
		"int $0x80"
 | 
						|
		: "=a" (res)
 | 
						|
		: "a" (nr), "b" (arg1), "c" (arg2), "d" (arg3), "S" (arg4));
 | 
						|
	return syscall_return(res);
 | 
						|
 | 
						|
}
 | 
						|
 | 
						|
static struct syscall_result syscall5(unsigned long nr, unsigned long arg1, unsigned long arg2,
 | 
						|
	unsigned long arg3, unsigned long arg4, unsigned long arg5)
 | 
						|
{
 | 
						|
	long res;
 | 
						|
	asm volatile(
 | 
						|
		"int $0x80"
 | 
						|
		: "=a" (res)
 | 
						|
		: "a" (nr), "b" (arg1), "c" (arg2), "d" (arg3),
 | 
						|
		"S" (arg4), "D" (arg5));
 | 
						|
	return syscall_return(res);
 | 
						|
 | 
						|
}
 | 
						|
 | 
						|
#define NR_exit                 1
 | 
						|
#define NR_fork                 2
 | 
						|
#define NR_read                 3
 | 
						|
#define NR_write                4
 | 
						|
#define NR_open                 5
 | 
						|
#define NR_close                6
 | 
						|
#define NR_waitpid              7
 | 
						|
#define NR_creat                8
 | 
						|
#define NR_link                 9
 | 
						|
#define NR_unlink              10
 | 
						|
#define NR_execve              11
 | 
						|
#define NR_chdir               12
 | 
						|
#define NR_time                13
 | 
						|
#define NR_mknod               14
 | 
						|
#define NR_chmod               15
 | 
						|
#define NR_lchown              16
 | 
						|
#define NR_break               17
 | 
						|
#define NR_oldstat             18
 | 
						|
#define NR_lseek               19
 | 
						|
#define NR_getpid              20
 | 
						|
#define NR_mount               21
 | 
						|
#define NR_umount              22
 | 
						|
#define NR_setuid              23
 | 
						|
#define NR_getuid              24
 | 
						|
#define NR_stime               25
 | 
						|
#define NR_ptrace              26
 | 
						|
#define NR_alarm               27
 | 
						|
#define NR_oldfstat            28
 | 
						|
#define NR_pause               29
 | 
						|
#define NR_utime               30
 | 
						|
#define NR_stty                31
 | 
						|
#define NR_gtty                32
 | 
						|
#define NR_access              33
 | 
						|
#define NR_nice                34
 | 
						|
#define NR_ftime               35
 | 
						|
#define NR_sync                36
 | 
						|
#define NR_kill                37
 | 
						|
#define NR_rename              38
 | 
						|
#define NR_mkdir               39
 | 
						|
#define NR_rmdir               40
 | 
						|
#define NR_dup                 41
 | 
						|
#define NR_pipe                42
 | 
						|
#define NR_times               43
 | 
						|
#define NR_prof                44
 | 
						|
#define NR_brk                 45
 | 
						|
#define NR_setgid              46
 | 
						|
#define NR_getgid              47
 | 
						|
#define NR_signal              48
 | 
						|
#define NR_geteuid             49
 | 
						|
#define NR_getegid             50
 | 
						|
#define NR_acct                51
 | 
						|
#define NR_umount2             52
 | 
						|
#define NR_lock                53
 | 
						|
#define NR_ioctl               54
 | 
						|
#define NR_fcntl               55
 | 
						|
#define NR_mpx                 56
 | 
						|
#define NR_setpgid             57
 | 
						|
#define NR_ulimit              58
 | 
						|
#define NR_oldolduname         59
 | 
						|
#define NR_umask               60
 | 
						|
#define NR_chroot              61
 | 
						|
#define NR_ustat               62
 | 
						|
#define NR_dup2                63
 | 
						|
#define NR_getppid             64
 | 
						|
#define NR_getpgrp             65
 | 
						|
#define NR_setsid              66
 | 
						|
#define NR_sigaction           67
 | 
						|
#define NR_sgetmask            68
 | 
						|
#define NR_ssetmask            69
 | 
						|
#define NR_setreuid            70
 | 
						|
#define NR_setregid            71
 | 
						|
#define NR_sigsuspend          72
 | 
						|
#define NR_sigpending          73
 | 
						|
#define NR_sethostname         74
 | 
						|
#define NR_setrlimit           75
 | 
						|
#define NR_getrlimit           76
 | 
						|
#define NR_getrusage           77
 | 
						|
#define NR_gettimeofday        78
 | 
						|
#define NR_settimeofday        79
 | 
						|
#define NR_getgroups           80
 | 
						|
#define NR_setgroups           81
 | 
						|
#define NR_select              82
 | 
						|
#define NR_symlink             83
 | 
						|
#define NR_oldlstat            84
 | 
						|
#define NR_readlink            85
 | 
						|
#define NR_uselib              86
 | 
						|
#define NR_swapon              87
 | 
						|
#define NR_reboot              88
 | 
						|
#define NR_readdir             89
 | 
						|
#define NR_mmap                90
 | 
						|
#define NR_munmap              91
 | 
						|
#define NR_truncate            92
 | 
						|
#define NR_ftruncate           93
 | 
						|
#define NR_fchmod              94
 | 
						|
#define NR_fchown              95
 | 
						|
#define NR_getpriority         96
 | 
						|
#define NR_setpriority         97
 | 
						|
#define NR_profil              98
 | 
						|
#define NR_statfs              99
 | 
						|
#define NR_fstatfs            100
 | 
						|
#define NR_ioperm             101
 | 
						|
#define NR_socketcall         102
 | 
						|
#define NR_syslog             103
 | 
						|
#define NR_setitimer          104
 | 
						|
#define NR_getitimer          105
 | 
						|
#define NR_stat               106
 | 
						|
#define NR_lstat              107
 | 
						|
#define NR_fstat              108
 | 
						|
#define NR_olduname           109
 | 
						|
#define NR_iopl               110
 | 
						|
#define NR_vhangup            111
 | 
						|
#define NR_idle               112
 | 
						|
#define NR_vm86old            113
 | 
						|
#define NR_wait4              114
 | 
						|
#define NR_swapoff            115
 | 
						|
#define NR_sysinfo            116
 | 
						|
#define NR_ipc                117
 | 
						|
#define NR_fsync              118
 | 
						|
#define NR_sigreturn          119
 | 
						|
#define NR_clone              120
 | 
						|
#define NR_setdomainname      121
 | 
						|
#define NR_uname              122
 | 
						|
#define NR_modify_ldt         123
 | 
						|
#define NR_adjtimex           124
 | 
						|
#define NR_mprotect           125
 | 
						|
#define NR_sigprocmask        126
 | 
						|
#define NR_create_module      127
 | 
						|
#define NR_init_module        128
 | 
						|
#define NR_delete_module      129
 | 
						|
#define NR_get_kernel_syms    130
 | 
						|
#define NR_quotactl           131
 | 
						|
#define NR_getpgid            132
 | 
						|
#define NR_fchdir             133
 | 
						|
#define NR_bdflush            134
 | 
						|
#define NR_sysfs              135
 | 
						|
#define NR_personality        136
 | 
						|
#define NR_afs_syscall        137 /* Syscall for Andrew File System */
 | 
						|
#define NR_setfsuid           138
 | 
						|
#define NR_setfsgid           139
 | 
						|
#define NR__llseek            140
 | 
						|
#define NR_getdents           141
 | 
						|
#define NR__newselect         142
 | 
						|
#define NR_flock              143
 | 
						|
#define NR_msync              144
 | 
						|
#define NR_readv              145
 | 
						|
#define NR_writev             146
 | 
						|
#define NR_getsid             147
 | 
						|
#define NR_fdatasync          148
 | 
						|
#define NR__sysctl            149
 | 
						|
#define NR_mlock              150
 | 
						|
#define NR_munlock            151
 | 
						|
#define NR_mlockall           152
 | 
						|
#define NR_munlockall         153
 | 
						|
#define NR_sched_setparam             154
 | 
						|
#define NR_sched_getparam             155
 | 
						|
#define NR_sched_setscheduler         156
 | 
						|
#define NR_sched_getscheduler         157
 | 
						|
#define NR_sched_yield                158
 | 
						|
#define NR_sched_get_priority_max     159
 | 
						|
#define NR_sched_get_priority_min     160
 | 
						|
#define NR_sched_rr_get_interval      161
 | 
						|
#define NR_nanosleep          162
 | 
						|
#define NR_mremap             163
 | 
						|
#define NR_setresuid          164
 | 
						|
#define NR_getresuid          165
 | 
						|
#define NR_vm86               166
 | 
						|
#define NR_query_module       167
 | 
						|
#define NR_poll               168
 | 
						|
#define NR_nfsservctl         169
 | 
						|
#define NR_setresgid          170
 | 
						|
#define NR_getresgid          171
 | 
						|
#define NR_prctl              172
 | 
						|
#define NR_rt_sigreturn       173
 | 
						|
#define NR_rt_sigaction       174
 | 
						|
#define NR_rt_sigprocmask     175
 | 
						|
#define NR_rt_sigpending      176
 | 
						|
#define NR_rt_sigtimedwait    177
 | 
						|
#define NR_rt_sigqueueinfo    178
 | 
						|
#define NR_rt_sigsuspend      179
 | 
						|
#define NR_pread              180
 | 
						|
#define NR_pwrite             181
 | 
						|
#define NR_chown              182
 | 
						|
#define NR_getcwd             183
 | 
						|
#define NR_capget             184
 | 
						|
#define NR_capset             185
 | 
						|
#define NR_sigaltstack        186
 | 
						|
#define NR_sendfile           187
 | 
						|
#define NR_getpmsg            188     /* some people actually want streams */
 | 
						|
#define NR_putpmsg            189     /* some people actually want streams */
 | 
						|
#define NR_vfork              190
 | 
						|
 | 
						|
typedef long ssize_t;
 | 
						|
typedef unsigned long size_t;
 | 
						|
 | 
						|
/* Standard file descriptors */
 | 
						|
#define STDIN_FILENO    0  /* Standard input */
 | 
						|
#define STDOUT_FILENO   1  /* Standard output */
 | 
						|
#define STDERR_FILENO   2  /* Standard error output */
 | 
						|
 | 
						|
static ssize_t write(int fd, const void *buf, size_t count)
 | 
						|
{
 | 
						|
	struct syscall_result res;
 | 
						|
	res = syscall3(NR_write, fd, (unsigned long)buf, count);
 | 
						|
	return res.val;
 | 
						|
}
 | 
						|
 | 
						|
static void _exit(int status)
 | 
						|
{
 | 
						|
	struct syscall_result res;
 | 
						|
	res = syscall1(NR_exit, status);
 | 
						|
}
 | 
						|
 | 
						|
static const char *addr_of_char(unsigned char ch)
 | 
						|
{
 | 
						|
	static const char byte[] = {
 | 
						|
		0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
 | 
						|
		0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f,
 | 
						|
		0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17,
 | 
						|
		0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f,
 | 
						|
		0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27,
 | 
						|
		0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f,
 | 
						|
		0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37,
 | 
						|
		0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f,
 | 
						|
		0x40, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47,
 | 
						|
		0x48, 0x49, 0x4a, 0x4b, 0x4c, 0x4d, 0x4e, 0x4f,
 | 
						|
		0x50, 0x51, 0x52, 0x53, 0x54, 0x55, 0x56, 0x57,
 | 
						|
		0x58, 0x59, 0x5a, 0x5b, 0x5c, 0x5d, 0x5e, 0x5f,
 | 
						|
		0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
 | 
						|
		0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
 | 
						|
		0x70, 0x71, 0x72, 0x73, 0x74, 0x75, 0x76, 0x77,
 | 
						|
		0x78, 0x79, 0x7a, 0x7b, 0x7c, 0x7d, 0x7e, 0x7f,
 | 
						|
		0x80, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87,
 | 
						|
		0x88, 0x89, 0x8a, 0x8b, 0x8c, 0x8d, 0x8e, 0x8f,
 | 
						|
		0x90, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97,
 | 
						|
		0x98, 0x99, 0x9a, 0x9b, 0x9c, 0x9d, 0x9e, 0x9f,
 | 
						|
		0xa0, 0xa1, 0xa2, 0xa3, 0xa4, 0xa5, 0xa6, 0xa7,
 | 
						|
		0xa8, 0xa9, 0xaa, 0xab, 0xac, 0xad, 0xae, 0xaf,
 | 
						|
		0xb0, 0xb1, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6, 0xb7,
 | 
						|
		0xb8, 0xb9, 0xba, 0xbb, 0xbc, 0xbd, 0xbe, 0xbf,
 | 
						|
		0xc0, 0xc1, 0xc2, 0xc3, 0xc4, 0xc5, 0xc6, 0xc7,
 | 
						|
		0xc8, 0xc9, 0xca, 0xcb, 0xcc, 0xcd, 0xce, 0xcf,
 | 
						|
		0xd0, 0xd1, 0xd2, 0xd3, 0xd4, 0xd5, 0xd6, 0xd7,
 | 
						|
		0xd8, 0xd9, 0xda, 0xdb, 0xdc, 0xdd, 0xde, 0xdf,
 | 
						|
		0xe0, 0xe1, 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7,
 | 
						|
		0xe8, 0xe9, 0xea, 0xeb, 0xec, 0xed, 0xee, 0xef,
 | 
						|
		0xf0, 0xf1, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7,
 | 
						|
		0xf8, 0xf9, 0xfa, 0xfb, 0xfc, 0xfd, 0xfe, 0xff,
 | 
						|
	};
 | 
						|
	return byte + ch;
 | 
						|
}
 | 
						|
 | 
						|
static void console_tx_byte(unsigned char ch)
 | 
						|
{
 | 
						|
	write(STDOUT_FILENO, addr_of_char(ch), 1);
 | 
						|
}
 | 
						|
 | 
						|
static void console_tx_nibble(unsigned nibble)
 | 
						|
{
 | 
						|
	unsigned char digit;
 | 
						|
	digit = nibble + '0';
 | 
						|
	if (digit > '9') {
 | 
						|
		digit += 39;
 | 
						|
	}
 | 
						|
	console_tx_byte(digit);
 | 
						|
}
 | 
						|
 | 
						|
static void console_tx_char(unsigned char byte)
 | 
						|
{
 | 
						|
	console_tx_byte(byte);
 | 
						|
}
 | 
						|
 | 
						|
static void console_tx_hex8(unsigned char value)
 | 
						|
{
 | 
						|
	console_tx_nibble((value >> 4U) & 0x0fU);
 | 
						|
	console_tx_nibble(value & 0x0fU);
 | 
						|
}
 | 
						|
 | 
						|
static void console_tx_hex16(unsigned short value)
 | 
						|
{
 | 
						|
	console_tx_nibble((value >> 12U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >>  8U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >>  4U) & 0x0FU);
 | 
						|
	console_tx_nibble(value & 0x0FU);
 | 
						|
}
 | 
						|
 | 
						|
static void console_tx_hex32(unsigned short value)
 | 
						|
{
 | 
						|
	console_tx_nibble((value >> 28U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >> 24U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >> 20U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >> 16U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >> 12U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >>  8U) & 0x0FU);
 | 
						|
	console_tx_nibble((value >>  4U) & 0x0FU);
 | 
						|
	console_tx_nibble(value & 0x0FU);
 | 
						|
}
 | 
						|
 | 
						|
static void console_tx_string(const char *str)
 | 
						|
{
 | 
						|
	unsigned char ch;
 | 
						|
	while((ch = *str++) != '\0') {
 | 
						|
		console_tx_byte(ch);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void print_debug_char(unsigned char byte) { console_tx_char(byte); }
 | 
						|
static void print_debug_hex8(unsigned char value) { console_tx_hex8(value); }
 | 
						|
static void print_debug_hex16(unsigned short value){ console_tx_hex16(value); }
 | 
						|
static void print_debug_hex32(unsigned int value) { console_tx_hex32(value); }
 | 
						|
static void print_debug(const char *str) { console_tx_string(str); }
 | 
						|
 | 
						|
static void goto_test(void)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	print_debug("goto_test\n");
 | 
						|
 | 
						|
	i = 0;
 | 
						|
	goto bottom;
 | 
						|
	{
 | 
						|
	top:
 | 
						|
		print_debug("i = ");
 | 
						|
		print_debug_hex8(i);
 | 
						|
		print_debug("\n");
 | 
						|
 | 
						|
		i = i + 1;
 | 
						|
	}
 | 
						|
 bottom:
 | 
						|
	if (i < 10) {
 | 
						|
		goto top;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
struct socket_desc {
 | 
						|
	short up;
 | 
						|
	short down;
 | 
						|
	short across;
 | 
						|
};
 | 
						|
 | 
						|
static void main(void)
 | 
						|
{
 | 
						|
	static const struct socket_desc cpu_socketsA[] = {
 | 
						|
		{  .up = 2,  .down = -1, .across = 1 }, /* Node 0 */
 | 
						|
		{  .up = 3,  .down = -1, .across = 0 }, /* Node 1 */
 | 
						|
		{  .up = -1, .down =  0, .across = 3 }, /* Node 2 */
 | 
						|
		{  .up = -1, .down =  1, .across = 2 }  /* Node 3 */
 | 
						|
	};
 | 
						|
	static const struct socket_desc cpu_socketsB[4] = {
 | 
						|
		{  2,  -1, 1 }, /* Node 0 */
 | 
						|
		{  3,  -1, 0 }, /* Node 1 */
 | 
						|
		{  -1,  0, 3 }, /* Node 2 */
 | 
						|
		{  -1,  1, 2 }  /* Node 3 */
 | 
						|
	};
 | 
						|
	int i;
 | 
						|
	print_debug("cpu_socketA\n");
 | 
						|
	for(i = 0; i < sizeof(cpu_socketsA)/sizeof(cpu_socketsA[0]); i++) {
 | 
						|
		print_debug(".up=");
 | 
						|
		print_debug_hex16(cpu_socketsA[i].up);
 | 
						|
		print_debug(" .down=");
 | 
						|
		print_debug_hex16(cpu_socketsA[i].down);
 | 
						|
		print_debug(" .across=");
 | 
						|
		print_debug_hex16(cpu_socketsA[i].across);
 | 
						|
		print_debug("\n");
 | 
						|
	}
 | 
						|
	print_debug("\ncpu_socketB\n");
 | 
						|
	for(i = 0; i < sizeof(cpu_socketsB)/sizeof(cpu_socketsB[0]); i++) {
 | 
						|
		print_debug(".up=");
 | 
						|
		print_debug_hex16(cpu_socketsB[i].up);
 | 
						|
		print_debug(" .down=");
 | 
						|
		print_debug_hex16(cpu_socketsB[i].down);
 | 
						|
		print_debug(" .across=");
 | 
						|
		print_debug_hex16(cpu_socketsB[i].across);
 | 
						|
		print_debug("\n");
 | 
						|
	}
 | 
						|
	_exit(0);
 | 
						|
}
 |