| 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; |
| } |
| } |
| |
| static void main(void) |
| { |
| goto_test(); |
| _exit(0); |
| } |
