sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1 | |
| 2 | /*--------------------------------------------------------------------*/ |
| 3 | /*--- Reimplementation of some C library stuff, to avoid depending ---*/ |
| 4 | /*--- on libc.so. ---*/ |
| 5 | /*--- vg_mylibc.c ---*/ |
| 6 | /*--------------------------------------------------------------------*/ |
| 7 | |
| 8 | /* |
njn | c953984 | 2002-10-02 13:26:35 +0000 | [diff] [blame] | 9 | This file is part of Valgrind, an extensible x86 protected-mode |
| 10 | emulator for monitoring program execution on x86-Unixes. |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 11 | |
njn | 0e1b514 | 2003-04-15 14:58:06 +0000 | [diff] [blame] | 12 | Copyright (C) 2000-2003 Julian Seward |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 13 | jseward@acm.org |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 14 | |
| 15 | This program is free software; you can redistribute it and/or |
| 16 | modify it under the terms of the GNU General Public License as |
| 17 | published by the Free Software Foundation; either version 2 of the |
| 18 | License, or (at your option) any later version. |
| 19 | |
| 20 | This program is distributed in the hope that it will be useful, but |
| 21 | WITHOUT ANY WARRANTY; without even the implied warranty of |
| 22 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 23 | General Public License for more details. |
| 24 | |
| 25 | You should have received a copy of the GNU General Public License |
| 26 | along with this program; if not, write to the Free Software |
| 27 | Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA |
| 28 | 02111-1307, USA. |
| 29 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 30 | The GNU General Public License is contained in the file COPYING. |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 31 | */ |
| 32 | |
| 33 | #include "vg_include.h" |
| 34 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 35 | /* --------------------------------------------------------------------- |
| 36 | Wrappers around system calls, and other stuff, to do with signals. |
| 37 | ------------------------------------------------------------------ */ |
| 38 | |
| 39 | /* sigemptyset, sigfullset, sigaddset and sigdelset return 0 on |
| 40 | success and -1 on error. |
| 41 | */ |
| 42 | Int VG_(ksigfillset)( vki_ksigset_t* set ) |
| 43 | { |
| 44 | Int i; |
| 45 | if (set == NULL) |
| 46 | return -1; |
| 47 | for (i = 0; i < VKI_KNSIG_WORDS; i++) |
| 48 | set->ws[i] = 0xFFFFFFFF; |
| 49 | return 0; |
| 50 | } |
| 51 | |
| 52 | Int VG_(ksigemptyset)( vki_ksigset_t* set ) |
| 53 | { |
| 54 | Int i; |
| 55 | if (set == NULL) |
| 56 | return -1; |
| 57 | for (i = 0; i < VKI_KNSIG_WORDS; i++) |
| 58 | set->ws[i] = 0x0; |
| 59 | return 0; |
| 60 | } |
| 61 | |
sewardj | b48e500 | 2002-05-13 00:16:03 +0000 | [diff] [blame] | 62 | Bool VG_(kisemptysigset)( vki_ksigset_t* set ) |
| 63 | { |
| 64 | Int i; |
| 65 | vg_assert(set != NULL); |
| 66 | for (i = 0; i < VKI_KNSIG_WORDS; i++) |
| 67 | if (set->ws[i] != 0x0) return False; |
| 68 | return True; |
| 69 | } |
| 70 | |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 71 | Bool VG_(kisfullsigset)( vki_ksigset_t* set ) |
| 72 | { |
| 73 | Int i; |
| 74 | vg_assert(set != NULL); |
| 75 | for (i = 0; i < VKI_KNSIG_WORDS; i++) |
sewardj | 05bcdcb | 2003-05-18 10:05:38 +0000 | [diff] [blame] | 76 | if (set->ws[i] != (UInt)(~0x0)) return False; |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 77 | return True; |
| 78 | } |
| 79 | |
| 80 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 81 | Int VG_(ksigaddset)( vki_ksigset_t* set, Int signum ) |
| 82 | { |
| 83 | if (set == NULL) |
| 84 | return -1; |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 85 | if (signum < 1 || signum > VKI_KNSIG) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 86 | return -1; |
| 87 | signum--; |
| 88 | set->ws[signum / VKI_KNSIG_BPW] |= (1 << (signum % VKI_KNSIG_BPW)); |
| 89 | return 0; |
| 90 | } |
| 91 | |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 92 | Int VG_(ksigdelset)( vki_ksigset_t* set, Int signum ) |
| 93 | { |
| 94 | if (set == NULL) |
| 95 | return -1; |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 96 | if (signum < 1 || signum > VKI_KNSIG) |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 97 | return -1; |
| 98 | signum--; |
| 99 | set->ws[signum / VKI_KNSIG_BPW] &= ~(1 << (signum % VKI_KNSIG_BPW)); |
| 100 | return 0; |
| 101 | } |
| 102 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 103 | Int VG_(ksigismember) ( vki_ksigset_t* set, Int signum ) |
| 104 | { |
| 105 | if (set == NULL) |
sewardj | b48e500 | 2002-05-13 00:16:03 +0000 | [diff] [blame] | 106 | return 0; |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 107 | if (signum < 1 || signum > VKI_KNSIG) |
sewardj | b48e500 | 2002-05-13 00:16:03 +0000 | [diff] [blame] | 108 | return 0; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 109 | signum--; |
| 110 | if (1 & ((set->ws[signum / VKI_KNSIG_BPW]) >> (signum % VKI_KNSIG_BPW))) |
| 111 | return 1; |
| 112 | else |
| 113 | return 0; |
| 114 | } |
| 115 | |
| 116 | |
sewardj | b48e500 | 2002-05-13 00:16:03 +0000 | [diff] [blame] | 117 | /* Add all signals in src to dst. */ |
| 118 | void VG_(ksigaddset_from_set)( vki_ksigset_t* dst, vki_ksigset_t* src ) |
| 119 | { |
| 120 | Int i; |
| 121 | vg_assert(dst != NULL && src != NULL); |
| 122 | for (i = 0; i < VKI_KNSIG_WORDS; i++) |
| 123 | dst->ws[i] |= src->ws[i]; |
| 124 | } |
| 125 | |
| 126 | /* Remove all signals in src from dst. */ |
| 127 | void VG_(ksigdelset_from_set)( vki_ksigset_t* dst, vki_ksigset_t* src ) |
| 128 | { |
| 129 | Int i; |
| 130 | vg_assert(dst != NULL && src != NULL); |
| 131 | for (i = 0; i < VKI_KNSIG_WORDS; i++) |
| 132 | dst->ws[i] &= ~(src->ws[i]); |
| 133 | } |
| 134 | |
| 135 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 136 | /* The functions sigaction, sigprocmask, sigpending and sigsuspend |
| 137 | return 0 on success and -1 on error. |
| 138 | */ |
| 139 | Int VG_(ksigprocmask)( Int how, |
| 140 | const vki_ksigset_t* set, |
| 141 | vki_ksigset_t* oldset) |
| 142 | { |
| 143 | Int res |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 144 | = VG_(do_syscall)(__NR_rt_sigprocmask, |
| 145 | how, (UInt)set, (UInt)oldset, |
| 146 | VKI_KNSIG_WORDS * VKI_BYTES_PER_WORD); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 147 | return VG_(is_kerror)(res) ? -1 : 0; |
| 148 | } |
| 149 | |
| 150 | |
| 151 | Int VG_(ksigaction) ( Int signum, |
| 152 | const vki_ksigaction* act, |
| 153 | vki_ksigaction* oldact) |
| 154 | { |
| 155 | Int res |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 156 | = VG_(do_syscall)(__NR_rt_sigaction, |
| 157 | signum, (UInt)act, (UInt)oldact, |
| 158 | VKI_KNSIG_WORDS * VKI_BYTES_PER_WORD); |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 159 | /* VG_(printf)("res = %d\n",res); */ |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 160 | return VG_(is_kerror)(res) ? -1 : 0; |
| 161 | } |
| 162 | |
| 163 | |
| 164 | Int VG_(ksigaltstack)( const vki_kstack_t* ss, vki_kstack_t* oss ) |
| 165 | { |
| 166 | Int res |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 167 | = VG_(do_syscall)(__NR_sigaltstack, (UInt)ss, (UInt)oss); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 168 | return VG_(is_kerror)(res) ? -1 : 0; |
| 169 | } |
| 170 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 171 | Int VG_(ksigtimedwait)( const vki_ksigset_t *set, vki_ksiginfo_t *info, |
| 172 | const struct vki_timespec *timeout ) |
| 173 | { |
| 174 | Int res = VG_(do_syscall)(__NR_rt_sigtimedwait, set, info, timeout, sizeof(*set)); |
| 175 | |
| 176 | return VG_(is_kerror)(res) ? -1 : res; |
| 177 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 178 | |
| 179 | Int VG_(ksignal)(Int signum, void (*sighandler)(Int)) |
| 180 | { |
| 181 | Int res; |
| 182 | vki_ksigaction sa; |
| 183 | sa.ksa_handler = sighandler; |
| 184 | sa.ksa_flags = VKI_SA_ONSTACK | VKI_SA_RESTART; |
| 185 | sa.ksa_restorer = NULL; |
| 186 | res = VG_(ksigemptyset)( &sa.ksa_mask ); |
| 187 | vg_assert(res == 0); |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 188 | res = VG_(do_syscall)(__NR_rt_sigaction, |
| 189 | signum, (UInt)(&sa), (UInt)NULL, |
| 190 | VKI_KNSIG_WORDS * VKI_BYTES_PER_WORD); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 191 | return VG_(is_kerror)(res) ? -1 : 0; |
| 192 | } |
| 193 | |
| 194 | |
sewardj | dcaf312 | 2002-09-30 23:12:33 +0000 | [diff] [blame] | 195 | Int VG_(kkill)( Int pid, Int signo ) |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 196 | { |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 197 | Int res = VG_(do_syscall)(__NR_kill, pid, signo); |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 198 | return VG_(is_kerror)(res) ? -1 : 0; |
| 199 | } |
| 200 | |
| 201 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 202 | Int VG_(ktkill)( Int tid, Int signo ) |
| 203 | { |
| 204 | Int ret = -VKI_ENOSYS; |
| 205 | |
| 206 | #ifdef __NR_tkill |
| 207 | ret = VG_(do_syscall)(__NR_tkill, tid, signo); |
| 208 | #endif /* __NR_tkill */ |
| 209 | |
| 210 | if (ret == -VKI_ENOSYS) |
| 211 | ret = VG_(do_syscall)(__NR_kill, tid, signo); |
| 212 | |
| 213 | return VG_(is_kerror)(ret) ? -1 : 0; |
| 214 | } |
| 215 | |
sewardj | dcaf312 | 2002-09-30 23:12:33 +0000 | [diff] [blame] | 216 | Int VG_(ksigpending) ( vki_ksigset_t* set ) |
sewardj | efbfcdf | 2002-06-19 17:35:45 +0000 | [diff] [blame] | 217 | { |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 218 | Int res = VG_(do_syscall)(__NR_sigpending, (UInt)set); |
sewardj | efbfcdf | 2002-06-19 17:35:45 +0000 | [diff] [blame] | 219 | return VG_(is_kerror)(res) ? -1 : 0; |
| 220 | } |
| 221 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 222 | Int VG_(waitpid)(Int pid, Int *status, Int options) |
| 223 | { |
| 224 | Int ret = VG_(do_syscall)(__NR_wait4, pid, status, options, NULL); |
| 225 | |
| 226 | return VG_(is_kerror)(ret) ? -1 : ret; |
| 227 | } |
| 228 | |
| 229 | Int VG_(gettid)(void) |
| 230 | { |
| 231 | Int ret; |
| 232 | |
| 233 | ret = VG_(do_syscall)(__NR_gettid); |
| 234 | |
| 235 | if (ret == -VKI_ENOSYS) |
| 236 | ret = VG_(do_syscall)(__NR_getpid); |
| 237 | |
| 238 | return ret; |
| 239 | } |
| 240 | |
| 241 | |
sewardj | efbfcdf | 2002-06-19 17:35:45 +0000 | [diff] [blame] | 242 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 243 | /* --------------------------------------------------------------------- |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 244 | mmap/munmap, exit, fcntl |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 245 | ------------------------------------------------------------------ */ |
| 246 | |
| 247 | /* Returns -1 on failure. */ |
| 248 | void* VG_(mmap)( void* start, UInt length, |
| 249 | UInt prot, UInt flags, UInt fd, UInt offset) |
| 250 | { |
| 251 | Int res; |
| 252 | UInt args[6]; |
| 253 | args[0] = (UInt)start; |
| 254 | args[1] = length; |
| 255 | args[2] = prot; |
| 256 | args[3] = flags; |
| 257 | args[4] = fd; |
| 258 | args[5] = offset; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 259 | res = VG_(do_syscall)(__NR_mmap, (UInt)(&(args[0])) ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 260 | return VG_(is_kerror)(res) ? ((void*)(-1)) : (void*)res; |
| 261 | } |
| 262 | |
| 263 | /* Returns -1 on failure. */ |
| 264 | Int VG_(munmap)( void* start, Int length ) |
| 265 | { |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 266 | Int res = VG_(do_syscall)(__NR_munmap, (UInt)start, (UInt)length ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 267 | return VG_(is_kerror)(res) ? -1 : 0; |
| 268 | } |
| 269 | |
| 270 | void VG_(exit)( Int status ) |
| 271 | { |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 272 | (void)VG_(do_syscall)(__NR_exit_group, (UInt)status ); |
| 273 | (void)VG_(do_syscall)(__NR_exit, (UInt)status ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 274 | /* Why are we still alive here? */ |
| 275 | /*NOTREACHED*/ |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 276 | *(volatile Int *)0 = 'x'; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 277 | vg_assert(2+2 == 5); |
| 278 | } |
| 279 | |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 280 | /* Returns -1 on error. */ |
| 281 | Int VG_(fcntl) ( Int fd, Int cmd, Int arg ) |
| 282 | { |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 283 | Int res = VG_(do_syscall)(__NR_fcntl, fd, cmd, arg); |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 284 | return VG_(is_kerror)(res) ? -1 : res; |
| 285 | } |
| 286 | |
| 287 | /* Returns -1 on error. */ |
| 288 | Int VG_(select)( Int n, |
| 289 | vki_fd_set* readfds, |
| 290 | vki_fd_set* writefds, |
| 291 | vki_fd_set* exceptfds, |
| 292 | struct vki_timeval * timeout ) |
| 293 | { |
| 294 | Int res; |
| 295 | UInt args[5]; |
| 296 | args[0] = n; |
| 297 | args[1] = (UInt)readfds; |
| 298 | args[2] = (UInt)writefds; |
| 299 | args[3] = (UInt)exceptfds; |
| 300 | args[4] = (UInt)timeout; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 301 | res = VG_(do_syscall)(__NR_select, (UInt)(&(args[0])) ); |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 302 | return VG_(is_kerror)(res) ? -1 : res; |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 303 | } |
| 304 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 305 | Int VG_(poll)( struct vki_pollfd *ufds, UInt nfds, Int timeout) |
| 306 | { |
| 307 | Int res = VG_(do_syscall)(__NR_poll, ufds, nfds, timeout); |
| 308 | |
| 309 | return res; |
| 310 | } |
| 311 | |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 312 | /* Returns -1 on error, 0 if ok, 1 if interrupted. */ |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 313 | Int VG_(nanosleep)( const struct vki_timespec *req, |
| 314 | struct vki_timespec *rem ) |
| 315 | { |
| 316 | Int res; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 317 | res = VG_(do_syscall)(__NR_nanosleep, (UInt)req, (UInt)rem); |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 318 | if (res == -VKI_EINVAL) return -1; |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 319 | if (res == -VKI_EINTR) return 1; |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 320 | return 0; |
| 321 | } |
| 322 | |
sewardj | b358620 | 2002-05-09 17:38:13 +0000 | [diff] [blame] | 323 | void* VG_(brk) ( void* end_data_segment ) |
| 324 | { |
| 325 | Int res; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 326 | res = VG_(do_syscall)(__NR_brk, (UInt)end_data_segment); |
sewardj | b358620 | 2002-05-09 17:38:13 +0000 | [diff] [blame] | 327 | return (void*)( VG_(is_kerror)(res) ? -1 : res ); |
| 328 | } |
| 329 | |
sewardj | 2e93c50 | 2002-04-12 11:12:52 +0000 | [diff] [blame] | 330 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 331 | /* --------------------------------------------------------------------- |
| 332 | printf implementation. The key function, vg_vprintf(), emits chars |
| 333 | into a caller-supplied function. Distantly derived from: |
| 334 | |
| 335 | vprintf replacement for Checker. |
| 336 | Copyright 1993, 1994, 1995 Tristan Gingold |
| 337 | Written September 1993 Tristan Gingold |
| 338 | Tristan Gingold, 8 rue Parmentier, F-91120 PALAISEAU, FRANCE |
| 339 | |
| 340 | (Checker itself was GPL'd.) |
| 341 | ------------------------------------------------------------------ */ |
| 342 | |
| 343 | |
| 344 | /* Some flags. */ |
| 345 | #define VG_MSG_SIGNED 1 /* The value is signed. */ |
| 346 | #define VG_MSG_ZJUSTIFY 2 /* Must justify with '0'. */ |
| 347 | #define VG_MSG_LJUSTIFY 4 /* Must justify on the left. */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 348 | #define VG_MSG_PAREN 8 /* Parenthesize if present (for %y) */ |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 349 | #define VG_MSG_COMMA 16 /* Add commas to numbers (for %d, %u) */ |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 350 | |
| 351 | /* Copy a string into the buffer. */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 352 | static UInt |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 353 | myvprintf_str ( void(*send)(Char), Int flags, Int width, Char* str, |
| 354 | Bool capitalise ) |
| 355 | { |
| 356 | # define MAYBE_TOUPPER(ch) (capitalise ? VG_(toupper)(ch) : (ch)) |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 357 | UInt ret = 0; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 358 | Int i, extra; |
| 359 | Int len = VG_(strlen)(str); |
| 360 | |
| 361 | if (width == 0) { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 362 | ret += len; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 363 | for (i = 0; i < len; i++) |
| 364 | send(MAYBE_TOUPPER(str[i])); |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 365 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 366 | } |
| 367 | |
| 368 | if (len > width) { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 369 | ret += width; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 370 | for (i = 0; i < width; i++) |
| 371 | send(MAYBE_TOUPPER(str[i])); |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 372 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 373 | } |
| 374 | |
| 375 | extra = width - len; |
| 376 | if (flags & VG_MSG_LJUSTIFY) { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 377 | ret += extra; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 378 | for (i = 0; i < extra; i++) |
| 379 | send(' '); |
| 380 | } |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 381 | ret += len; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 382 | for (i = 0; i < len; i++) |
| 383 | send(MAYBE_TOUPPER(str[i])); |
| 384 | if (!(flags & VG_MSG_LJUSTIFY)) { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 385 | ret += extra; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 386 | for (i = 0; i < extra; i++) |
| 387 | send(' '); |
| 388 | } |
| 389 | |
| 390 | # undef MAYBE_TOUPPER |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 391 | |
| 392 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 393 | } |
| 394 | |
| 395 | /* Write P into the buffer according to these args: |
| 396 | * If SIGN is true, p is a signed. |
| 397 | * BASE is the base. |
| 398 | * If WITH_ZERO is true, '0' must be added. |
| 399 | * WIDTH is the width of the field. |
| 400 | */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 401 | static UInt |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 402 | myvprintf_int64 ( void(*send)(Char), Int flags, Int base, Int width, ULong p) |
| 403 | { |
| 404 | Char buf[40]; |
| 405 | Int ind = 0; |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 406 | Int i, nc = 0; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 407 | Bool neg = False; |
| 408 | Char *digits = "0123456789ABCDEF"; |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 409 | UInt ret = 0; |
| 410 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 411 | if (base < 2 || base > 16) |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 412 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 413 | |
| 414 | if ((flags & VG_MSG_SIGNED) && (Long)p < 0) { |
| 415 | p = - (Long)p; |
| 416 | neg = True; |
| 417 | } |
| 418 | |
| 419 | if (p == 0) |
| 420 | buf[ind++] = '0'; |
| 421 | else { |
| 422 | while (p > 0) { |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 423 | if (flags & VG_MSG_COMMA && 10 == base && |
| 424 | 0 == (ind-nc) % 3 && 0 != ind) |
| 425 | { |
| 426 | buf[ind++] = ','; |
| 427 | nc++; |
| 428 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 429 | buf[ind++] = digits[p % base]; |
| 430 | p /= base; |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 431 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 432 | } |
| 433 | |
| 434 | if (neg) |
| 435 | buf[ind++] = '-'; |
| 436 | |
| 437 | if (width > 0 && !(flags & VG_MSG_LJUSTIFY)) { |
| 438 | for(; ind < width; ind++) { |
| 439 | vg_assert(ind < 39); |
| 440 | buf[ind] = (flags & VG_MSG_ZJUSTIFY) ? '0': ' '; |
| 441 | } |
| 442 | } |
| 443 | |
| 444 | /* Reverse copy to buffer. */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 445 | ret += ind; |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 446 | for (i = ind -1; i >= 0; i--) { |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 447 | send(buf[i]); |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 448 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 449 | if (width > 0 && (flags & VG_MSG_LJUSTIFY)) { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 450 | for(; ind < width; ind++) { |
| 451 | ret++; |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 452 | send(' '); // Never pad with zeroes on RHS -- changes the value! |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 453 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 454 | } |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 455 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 456 | } |
| 457 | |
| 458 | |
| 459 | /* A simple vprintf(). */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 460 | UInt |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 461 | VG_(vprintf) ( void(*send)(Char), const Char *format, va_list vargs ) |
| 462 | { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 463 | UInt ret = 0; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 464 | int i; |
| 465 | int flags; |
| 466 | int width; |
| 467 | Bool is_long; |
| 468 | |
| 469 | /* We assume that vargs has already been initialised by the |
| 470 | caller, using va_start, and that the caller will similarly |
| 471 | clean up with va_end. |
| 472 | */ |
| 473 | |
| 474 | for (i = 0; format[i] != 0; i++) { |
| 475 | if (format[i] != '%') { |
| 476 | send(format[i]); |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 477 | ret++; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 478 | continue; |
| 479 | } |
| 480 | i++; |
| 481 | /* A '%' has been found. Ignore a trailing %. */ |
| 482 | if (format[i] == 0) |
| 483 | break; |
| 484 | if (format[i] == '%') { |
| 485 | /* `%%' is replaced by `%'. */ |
| 486 | send('%'); |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 487 | ret++; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 488 | continue; |
| 489 | } |
| 490 | flags = 0; |
| 491 | is_long = False; |
| 492 | width = 0; /* length of the field. */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 493 | if (format[i] == '(') { |
| 494 | flags |= VG_MSG_PAREN; |
| 495 | i++; |
| 496 | } |
njn | 607adfc | 2003-09-30 14:15:44 +0000 | [diff] [blame] | 497 | /* If ',' follows '%', commas will be inserted. */ |
| 498 | if (format[i] == ',') { |
| 499 | flags |= VG_MSG_COMMA; |
| 500 | i++; |
| 501 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 502 | /* If '-' follows '%', justify on the left. */ |
| 503 | if (format[i] == '-') { |
| 504 | flags |= VG_MSG_LJUSTIFY; |
| 505 | i++; |
| 506 | } |
| 507 | /* If '0' follows '%', pads will be inserted. */ |
| 508 | if (format[i] == '0') { |
| 509 | flags |= VG_MSG_ZJUSTIFY; |
| 510 | i++; |
| 511 | } |
| 512 | /* Compute the field length. */ |
| 513 | while (format[i] >= '0' && format[i] <= '9') { |
| 514 | width *= 10; |
| 515 | width += format[i++] - '0'; |
| 516 | } |
| 517 | while (format[i] == 'l') { |
| 518 | i++; |
| 519 | is_long = True; |
| 520 | } |
| 521 | |
| 522 | switch (format[i]) { |
| 523 | case 'd': /* %d */ |
| 524 | flags |= VG_MSG_SIGNED; |
| 525 | if (is_long) |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 526 | ret += myvprintf_int64(send, flags, 10, width, |
| 527 | (ULong)(va_arg (vargs, Long))); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 528 | else |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 529 | ret += myvprintf_int64(send, flags, 10, width, |
| 530 | (ULong)(va_arg (vargs, Int))); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 531 | break; |
| 532 | case 'u': /* %u */ |
| 533 | if (is_long) |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 534 | ret += myvprintf_int64(send, flags, 10, width, |
| 535 | (ULong)(va_arg (vargs, ULong))); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 536 | else |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 537 | ret += myvprintf_int64(send, flags, 10, width, |
| 538 | (ULong)(va_arg (vargs, UInt))); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 539 | break; |
| 540 | case 'p': /* %p */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 541 | ret += 2; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 542 | send('0'); |
| 543 | send('x'); |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 544 | ret += myvprintf_int64(send, flags, 16, width, |
| 545 | (ULong)((UInt)va_arg (vargs, void *))); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 546 | break; |
| 547 | case 'x': /* %x */ |
| 548 | if (is_long) |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 549 | ret += myvprintf_int64(send, flags, 16, width, |
| 550 | (ULong)(va_arg (vargs, ULong))); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 551 | else |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 552 | ret += myvprintf_int64(send, flags, 16, width, |
| 553 | (ULong)(va_arg (vargs, UInt))); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 554 | break; |
| 555 | case 'c': /* %c */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 556 | ret++; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 557 | send(va_arg (vargs, int)); |
| 558 | break; |
| 559 | case 's': case 'S': { /* %s */ |
| 560 | char *str = va_arg (vargs, char *); |
| 561 | if (str == (char*) 0) str = "(null)"; |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 562 | ret += myvprintf_str(send, flags, width, str, format[i]=='S'); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 563 | break; |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 564 | } |
| 565 | case 'y': { /* %y - print symbol */ |
| 566 | Char buf[100]; |
| 567 | Char *cp = buf; |
| 568 | Addr a = va_arg(vargs, Addr); |
| 569 | |
| 570 | if (flags & VG_MSG_PAREN) |
| 571 | *cp++ = '('; |
sewardj | 6e008cb | 2002-12-15 13:11:39 +0000 | [diff] [blame] | 572 | if (VG_(get_fnname_w_offset)(a, cp, sizeof(buf)-4)) { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 573 | if (flags & VG_MSG_PAREN) { |
| 574 | cp += VG_(strlen)(cp); |
| 575 | *cp++ = ')'; |
| 576 | *cp = '\0'; |
| 577 | } |
| 578 | ret += myvprintf_str(send, flags, width, buf, 0); |
| 579 | } |
| 580 | |
| 581 | break; |
| 582 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 583 | default: |
| 584 | break; |
| 585 | } |
| 586 | } |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 587 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 588 | } |
| 589 | |
| 590 | |
| 591 | /* A general replacement for printf(). Note that only low-level |
| 592 | debugging info should be sent via here. The official route is to |
| 593 | to use vg_message(). This interface is deprecated. |
| 594 | */ |
| 595 | static char myprintf_buf[100]; |
| 596 | static int n_myprintf_buf; |
| 597 | |
| 598 | static void add_to_myprintf_buf ( Char c ) |
| 599 | { |
| 600 | if (n_myprintf_buf >= 100-10 /*paranoia*/ ) { |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 601 | if (VG_(clo_logfile_fd) >= 0) { |
sewardj | 570f890 | 2002-11-03 11:44:36 +0000 | [diff] [blame] | 602 | VG_(send_bytes_to_logging_sink)( |
| 603 | myprintf_buf, VG_(strlen)(myprintf_buf) ); |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 604 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 605 | n_myprintf_buf = 0; |
| 606 | myprintf_buf[n_myprintf_buf] = 0; |
| 607 | } |
| 608 | myprintf_buf[n_myprintf_buf++] = c; |
| 609 | myprintf_buf[n_myprintf_buf] = 0; |
| 610 | } |
| 611 | |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 612 | UInt VG_(printf) ( const char *format, ... ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 613 | { |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 614 | UInt ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 615 | va_list vargs; |
| 616 | va_start(vargs,format); |
| 617 | |
| 618 | n_myprintf_buf = 0; |
| 619 | myprintf_buf[n_myprintf_buf] = 0; |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 620 | ret = VG_(vprintf) ( add_to_myprintf_buf, format, vargs ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 621 | |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 622 | if (n_myprintf_buf > 0 && VG_(clo_logfile_fd) >= 0) { |
sewardj | 570f890 | 2002-11-03 11:44:36 +0000 | [diff] [blame] | 623 | VG_(send_bytes_to_logging_sink)( myprintf_buf, n_myprintf_buf ); |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 624 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 625 | |
| 626 | va_end(vargs); |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 627 | |
| 628 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 629 | } |
| 630 | |
| 631 | |
| 632 | /* A general replacement for sprintf(). */ |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 633 | UInt VG_(sprintf) ( Char* buf, Char *format, ... ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 634 | { |
sewardj | 05bcdcb | 2003-05-18 10:05:38 +0000 | [diff] [blame] | 635 | Int ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 636 | va_list vargs; |
sewardj | 1771e17 | 2002-11-13 22:06:35 +0000 | [diff] [blame] | 637 | Char *ptr = buf; |
| 638 | static void add_to_vg_sprintf_buf ( Char c ) |
| 639 | { |
| 640 | *ptr++ = c; |
| 641 | } |
| 642 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 643 | va_start(vargs,format); |
| 644 | |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 645 | ret = VG_(vprintf) ( add_to_vg_sprintf_buf, format, vargs ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 646 | add_to_vg_sprintf_buf(0); |
| 647 | |
| 648 | va_end(vargs); |
sewardj | 78e3cd9 | 2002-10-22 04:45:48 +0000 | [diff] [blame] | 649 | |
| 650 | vg_assert(VG_(strlen)(buf) == ret); |
| 651 | return ret; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 652 | } |
| 653 | |
| 654 | |
| 655 | /* --------------------------------------------------------------------- |
| 656 | Misc str* functions. |
| 657 | ------------------------------------------------------------------ */ |
| 658 | |
| 659 | Bool VG_(isspace) ( Char c ) |
| 660 | { |
| 661 | return (c == ' ' || c == '\n' || c == '\t' || c == 0); |
| 662 | } |
| 663 | |
njn | 7cf0bd3 | 2002-06-08 13:36:03 +0000 | [diff] [blame] | 664 | Bool VG_(isdigit) ( Char c ) |
| 665 | { |
| 666 | return (c >= '0' && c <= '9'); |
| 667 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 668 | |
| 669 | Int VG_(strlen) ( const Char* str ) |
| 670 | { |
| 671 | Int i = 0; |
| 672 | while (str[i] != 0) i++; |
| 673 | return i; |
| 674 | } |
| 675 | |
| 676 | |
| 677 | Long VG_(atoll) ( Char* str ) |
| 678 | { |
| 679 | Bool neg = False; |
| 680 | Long n = 0; |
| 681 | if (*str == '-') { str++; neg = True; }; |
| 682 | while (*str >= '0' && *str <= '9') { |
| 683 | n = 10*n + (Long)(*str - '0'); |
| 684 | str++; |
| 685 | } |
| 686 | if (neg) n = -n; |
| 687 | return n; |
| 688 | } |
| 689 | |
| 690 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 691 | Long VG_(atoll16) ( Char* str ) |
sewardj | a70ca3f | 2002-05-30 01:22:20 +0000 | [diff] [blame] | 692 | { |
| 693 | Bool neg = False; |
| 694 | Long n = 0; |
| 695 | if (*str == '-') { str++; neg = True; }; |
| 696 | while (True) { |
| 697 | if (*str >= '0' && *str <= '9') { |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 698 | n = 16*n + (Long)(*str - '0'); |
sewardj | a70ca3f | 2002-05-30 01:22:20 +0000 | [diff] [blame] | 699 | } |
| 700 | else |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 701 | if (*str >= 'A' && *str <= 'F') { |
| 702 | n = 16*n + (Long)((*str - 'A') + 10); |
sewardj | a70ca3f | 2002-05-30 01:22:20 +0000 | [diff] [blame] | 703 | } |
| 704 | else |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 705 | if (*str >= 'a' && *str <= 'f') { |
| 706 | n = 16*n + (Long)((*str - 'a') + 10); |
| 707 | } |
| 708 | else { |
| 709 | break; |
| 710 | } |
| 711 | str++; |
| 712 | } |
| 713 | if (neg) n = -n; |
| 714 | return n; |
| 715 | } |
| 716 | |
| 717 | Long VG_(atoll36) ( UInt base, Char* str ) |
| 718 | { |
| 719 | Bool neg = False; |
| 720 | Long n = 0; |
| 721 | vg_assert(base >= 2 && base <= 36); |
| 722 | if (*str == '-') { str++; neg = True; }; |
| 723 | while (True) { |
sewardj | 05bcdcb | 2003-05-18 10:05:38 +0000 | [diff] [blame] | 724 | if (*str >= '0' |
| 725 | && *str <= (Char)('9' - (10 - base))) { |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 726 | n = base*n + (Long)(*str - '0'); |
| 727 | } |
| 728 | else |
sewardj | 05bcdcb | 2003-05-18 10:05:38 +0000 | [diff] [blame] | 729 | if (base > 10 && *str >= 'A' |
| 730 | && *str <= (Char)('Z' - (36 - base))) { |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 731 | n = base*n + (Long)((*str - 'A') + 10); |
| 732 | } |
| 733 | else |
sewardj | 05bcdcb | 2003-05-18 10:05:38 +0000 | [diff] [blame] | 734 | if (base > 10 && *str >= 'a' |
| 735 | && *str <= (Char)('z' - (36 - base))) { |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 736 | n = base*n + (Long)((*str - 'a') + 10); |
sewardj | a70ca3f | 2002-05-30 01:22:20 +0000 | [diff] [blame] | 737 | } |
| 738 | else { |
| 739 | break; |
| 740 | } |
| 741 | str++; |
| 742 | } |
| 743 | if (neg) n = -n; |
| 744 | return n; |
| 745 | } |
| 746 | |
| 747 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 748 | Char* VG_(strcat) ( Char* dest, const Char* src ) |
| 749 | { |
| 750 | Char* dest_orig = dest; |
| 751 | while (*dest) dest++; |
| 752 | while (*src) *dest++ = *src++; |
| 753 | *dest = 0; |
| 754 | return dest_orig; |
| 755 | } |
| 756 | |
| 757 | |
| 758 | Char* VG_(strncat) ( Char* dest, const Char* src, Int n ) |
| 759 | { |
| 760 | Char* dest_orig = dest; |
| 761 | while (*dest) dest++; |
| 762 | while (*src && n > 0) { *dest++ = *src++; n--; } |
| 763 | *dest = 0; |
| 764 | return dest_orig; |
| 765 | } |
| 766 | |
| 767 | |
| 768 | Char* VG_(strpbrk) ( const Char* s, const Char* accept ) |
| 769 | { |
| 770 | const Char* a; |
| 771 | while (*s) { |
| 772 | a = accept; |
| 773 | while (*a) |
| 774 | if (*a++ == *s) |
| 775 | return (Char *) s; |
| 776 | s++; |
| 777 | } |
| 778 | return NULL; |
| 779 | } |
| 780 | |
| 781 | |
| 782 | Char* VG_(strcpy) ( Char* dest, const Char* src ) |
| 783 | { |
| 784 | Char* dest_orig = dest; |
| 785 | while (*src) *dest++ = *src++; |
| 786 | *dest = 0; |
| 787 | return dest_orig; |
| 788 | } |
| 789 | |
| 790 | |
| 791 | /* Copy bytes, not overrunning the end of dest and always ensuring |
| 792 | zero termination. */ |
| 793 | void VG_(strncpy_safely) ( Char* dest, const Char* src, Int ndest ) |
| 794 | { |
| 795 | Int i; |
| 796 | vg_assert(ndest > 0); |
| 797 | i = 0; |
| 798 | dest[i] = 0; |
| 799 | while (True) { |
| 800 | if (src[i] == 0) return; |
| 801 | if (i >= ndest-1) return; |
| 802 | dest[i] = src[i]; |
| 803 | i++; |
| 804 | dest[i] = 0; |
| 805 | } |
| 806 | } |
| 807 | |
| 808 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 809 | Char* VG_(strncpy) ( Char* dest, const Char* src, Int ndest ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 810 | { |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 811 | Int i = 0; |
| 812 | while (True) { |
| 813 | if (i >= ndest) return dest; /* reached limit */ |
| 814 | dest[i] = src[i]; |
| 815 | if (src[i++] == 0) { |
| 816 | /* reached NUL; pad rest with zeroes as required */ |
| 817 | while (i < ndest) dest[i++] = 0; |
| 818 | return dest; |
| 819 | } |
| 820 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 821 | } |
| 822 | |
| 823 | |
| 824 | Int VG_(strcmp) ( const Char* s1, const Char* s2 ) |
| 825 | { |
| 826 | while (True) { |
| 827 | if (*s1 == 0 && *s2 == 0) return 0; |
| 828 | if (*s1 == 0) return -1; |
| 829 | if (*s2 == 0) return 1; |
| 830 | |
| 831 | if (*(UChar*)s1 < *(UChar*)s2) return -1; |
| 832 | if (*(UChar*)s1 > *(UChar*)s2) return 1; |
| 833 | |
| 834 | s1++; s2++; |
| 835 | } |
| 836 | } |
| 837 | |
| 838 | |
| 839 | Int VG_(strcmp_ws) ( const Char* s1, const Char* s2 ) |
| 840 | { |
| 841 | while (True) { |
| 842 | if (VG_(isspace)(*s1) && VG_(isspace)(*s2)) return 0; |
| 843 | if (VG_(isspace)(*s1)) return -1; |
| 844 | if (VG_(isspace)(*s2)) return 1; |
| 845 | |
| 846 | if (*(UChar*)s1 < *(UChar*)s2) return -1; |
| 847 | if (*(UChar*)s1 > *(UChar*)s2) return 1; |
| 848 | |
| 849 | s1++; s2++; |
| 850 | } |
| 851 | } |
| 852 | |
| 853 | |
| 854 | Int VG_(strncmp) ( const Char* s1, const Char* s2, Int nmax ) |
| 855 | { |
| 856 | Int n = 0; |
| 857 | while (True) { |
| 858 | if (n >= nmax) return 0; |
| 859 | if (*s1 == 0 && *s2 == 0) return 0; |
| 860 | if (*s1 == 0) return -1; |
| 861 | if (*s2 == 0) return 1; |
| 862 | |
| 863 | if (*(UChar*)s1 < *(UChar*)s2) return -1; |
| 864 | if (*(UChar*)s1 > *(UChar*)s2) return 1; |
| 865 | |
| 866 | s1++; s2++; n++; |
| 867 | } |
| 868 | } |
| 869 | |
| 870 | |
| 871 | Int VG_(strncmp_ws) ( const Char* s1, const Char* s2, Int nmax ) |
| 872 | { |
| 873 | Int n = 0; |
| 874 | while (True) { |
| 875 | if (n >= nmax) return 0; |
| 876 | if (VG_(isspace)(*s1) && VG_(isspace)(*s2)) return 0; |
| 877 | if (VG_(isspace)(*s1)) return -1; |
| 878 | if (VG_(isspace)(*s2)) return 1; |
| 879 | |
| 880 | if (*(UChar*)s1 < *(UChar*)s2) return -1; |
| 881 | if (*(UChar*)s1 > *(UChar*)s2) return 1; |
| 882 | |
| 883 | s1++; s2++; n++; |
| 884 | } |
| 885 | } |
| 886 | |
| 887 | |
| 888 | Char* VG_(strstr) ( const Char* haystack, Char* needle ) |
| 889 | { |
sewardj | 3984b85 | 2002-05-12 03:00:17 +0000 | [diff] [blame] | 890 | Int n; |
| 891 | if (haystack == NULL) |
| 892 | return NULL; |
| 893 | n = VG_(strlen)(needle); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 894 | while (True) { |
| 895 | if (haystack[0] == 0) |
| 896 | return NULL; |
| 897 | if (VG_(strncmp)(haystack, needle, n) == 0) |
| 898 | return (Char*)haystack; |
| 899 | haystack++; |
| 900 | } |
| 901 | } |
| 902 | |
| 903 | |
| 904 | Char* VG_(strchr) ( const Char* s, Char c ) |
| 905 | { |
| 906 | while (True) { |
| 907 | if (*s == c) return (Char*)s; |
| 908 | if (*s == 0) return NULL; |
| 909 | s++; |
| 910 | } |
| 911 | } |
| 912 | |
| 913 | |
sewardj | 7ab2aca | 2002-10-20 19:40:32 +0000 | [diff] [blame] | 914 | void* VG_(memcpy) ( void *dest, const void *src, Int sz ) |
| 915 | { |
| 916 | const Char *s = (const Char *)src; |
| 917 | Char *d = (Char *)dest; |
| 918 | vg_assert(sz >= 0); |
| 919 | |
| 920 | while (sz--) |
| 921 | *d++ = *s++; |
| 922 | |
| 923 | return dest; |
| 924 | } |
| 925 | |
| 926 | |
| 927 | void* VG_(memset) ( void *dest, Int c, Int sz ) |
| 928 | { |
| 929 | Char *d = (Char *)dest; |
| 930 | vg_assert(sz >= 0); |
| 931 | |
| 932 | while (sz--) |
| 933 | *d++ = c; |
| 934 | |
| 935 | return dest; |
| 936 | } |
| 937 | |
njn | 6d68e79 | 2003-02-24 10:49:08 +0000 | [diff] [blame] | 938 | Int VG_(memcmp) ( const void* s1, const void* s2, Int n ) |
| 939 | { |
| 940 | Int res; |
njn | fa4690b | 2003-02-24 21:43:05 +0000 | [diff] [blame] | 941 | UChar a0; |
| 942 | UChar b0; |
njn | 6d68e79 | 2003-02-24 10:49:08 +0000 | [diff] [blame] | 943 | vg_assert(n >= 0); |
| 944 | |
| 945 | while (n != 0) { |
njn | fa4690b | 2003-02-24 21:43:05 +0000 | [diff] [blame] | 946 | a0 = ((UChar *) s1)[0]; |
| 947 | b0 = ((UChar *) s2)[0]; |
njn | 6d68e79 | 2003-02-24 10:49:08 +0000 | [diff] [blame] | 948 | s1 += 1; |
| 949 | s2 += 1; |
| 950 | res = a0 - b0; |
| 951 | if (res != 0) |
| 952 | return res; |
| 953 | n -= 1; |
| 954 | } |
| 955 | return 0; |
| 956 | } |
sewardj | 7ab2aca | 2002-10-20 19:40:32 +0000 | [diff] [blame] | 957 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 958 | Char VG_(toupper) ( Char c ) |
| 959 | { |
| 960 | if (c >= 'a' && c <= 'z') |
| 961 | return c + ('A' - 'a'); |
| 962 | else |
| 963 | return c; |
| 964 | } |
| 965 | |
| 966 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 967 | /* Inline just for the wrapper VG_(strdup) below */ |
| 968 | __inline__ Char* VG_(arena_strdup) ( ArenaId aid, const Char* s ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 969 | { |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 970 | Int i; |
| 971 | Int len = VG_(strlen)(s) + 1; |
| 972 | Char* res = VG_(arena_malloc) (aid, len); |
| 973 | for (i = 0; i < len; i++) |
| 974 | res[i] = s[i]; |
| 975 | return res; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 976 | } |
| 977 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 978 | /* Wrapper to avoid exposing skins to ArenaId's */ |
| 979 | Char* VG_(strdup) ( const Char* s ) |
| 980 | { |
| 981 | return VG_(arena_strdup) ( VG_AR_SKIN, s ); |
| 982 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 983 | |
| 984 | /* --------------------------------------------------------------------- |
| 985 | A simple string matching routine, purloined from Hugs98. |
| 986 | `*' matches any sequence of zero or more characters |
| 987 | `?' matches any single character exactly |
| 988 | `\c' matches the character c only (ignoring special chars) |
| 989 | c matches the character c only |
| 990 | ------------------------------------------------------------------ */ |
| 991 | |
| 992 | /* Keep track of recursion depth. */ |
| 993 | static Int recDepth; |
| 994 | |
njn | 4ba5a79 | 2002-09-30 10:23:54 +0000 | [diff] [blame] | 995 | static Bool string_match_wrk ( Char* pat, Char* str ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 996 | { |
sewardj | e54b69d | 2003-07-06 01:14:42 +0000 | [diff] [blame] | 997 | vg_assert(recDepth >= 0 && recDepth < 500); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 998 | recDepth++; |
| 999 | for (;;) { |
| 1000 | switch (*pat) { |
| 1001 | case '\0' : return (*str=='\0'); |
| 1002 | case '*' : do { |
njn | 4ba5a79 | 2002-09-30 10:23:54 +0000 | [diff] [blame] | 1003 | if (string_match_wrk(pat+1,str)) { |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1004 | recDepth--; |
| 1005 | return True; |
| 1006 | } |
| 1007 | } while (*str++); |
| 1008 | recDepth--; |
| 1009 | return False; |
| 1010 | case '?' : if (*str++=='\0') { |
| 1011 | recDepth--; |
| 1012 | return False; |
| 1013 | } |
| 1014 | pat++; |
| 1015 | break; |
| 1016 | case '\\' : if (*++pat == '\0') { |
| 1017 | recDepth--; |
| 1018 | return False; /* spurious trailing \ in pattern */ |
| 1019 | } |
| 1020 | /* falls through to ... */ |
| 1021 | default : if (*pat++ != *str++) { |
| 1022 | recDepth--; |
| 1023 | return False; |
| 1024 | } |
| 1025 | break; |
| 1026 | } |
| 1027 | } |
| 1028 | } |
| 1029 | |
njn | 4ba5a79 | 2002-09-30 10:23:54 +0000 | [diff] [blame] | 1030 | Bool VG_(string_match) ( Char* pat, Char* str ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1031 | { |
| 1032 | Bool b; |
| 1033 | recDepth = 0; |
njn | 4ba5a79 | 2002-09-30 10:23:54 +0000 | [diff] [blame] | 1034 | b = string_match_wrk ( pat, str ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1035 | /* |
| 1036 | VG_(printf)("%s %s %s\n", |
| 1037 | b?"TRUE ":"FALSE", pat, str); |
| 1038 | */ |
| 1039 | return b; |
| 1040 | } |
| 1041 | |
| 1042 | |
| 1043 | /* --------------------------------------------------------------------- |
| 1044 | Assertery. |
| 1045 | ------------------------------------------------------------------ */ |
| 1046 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1047 | /* Fake up an ExeContext which is of our actual real CPU state, so we |
| 1048 | can print a stack trace. This isn't terribly useful in the case |
| 1049 | where we were killed by a signal, since we just get a backtrace |
| 1050 | into the signal handler. Also, it could be somewhat risky if we |
| 1051 | actully got the panic/exception within the execontext/stack |
| 1052 | dump/symtab code. But it's better than nothing. */ |
| 1053 | static inline ExeContext *get_real_execontext(Addr ret) |
| 1054 | { |
| 1055 | ExeContext *ec; |
| 1056 | Addr ebp; |
| 1057 | Addr stacktop; |
| 1058 | Addr esp = (Addr)&esp; |
| 1059 | |
| 1060 | asm("movl %%ebp, %0" : "=r" (ebp)); |
| 1061 | stacktop = (Addr)&VG_(stack)[VG_STACK_SIZE_W]; |
| 1062 | if (esp >= (Addr)&VG_(sigstack)[0] && esp < (Addr)&VG_(sigstack)[VG_STACK_SIZE_W]) |
| 1063 | stacktop = (Addr)&VG_(sigstack)[VG_STACK_SIZE_W]; |
| 1064 | |
| 1065 | ec = VG_(get_ExeContext2)(ret, ebp, esp, stacktop); |
| 1066 | |
| 1067 | return ec; |
| 1068 | } |
| 1069 | |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1070 | __attribute__ ((noreturn)) |
daywalker | 3222e0a | 2003-09-18 01:39:50 +0000 | [diff] [blame] | 1071 | static void report_and_quit ( const Char* report ) |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1072 | { |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1073 | ExeContext *ec = get_real_execontext((Addr)__builtin_return_address(0)); |
| 1074 | VG_(pp_ExeContext)(ec); |
| 1075 | |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1076 | VG_(pp_sched_status)(); |
sewardj | 366ee1e | 2003-04-26 22:36:42 +0000 | [diff] [blame] | 1077 | VG_(printf)("\n"); |
| 1078 | VG_(printf)("Note: see also the FAQ.txt in the source distribution.\n"); |
| 1079 | VG_(printf)("It contains workarounds to several common problems.\n"); |
| 1080 | VG_(printf)("\n"); |
| 1081 | VG_(printf)("If that doesn't help, please report this bug to: %s\n\n", |
| 1082 | report); |
| 1083 | VG_(printf)("In the bug report, send all the above text, the valgrind\n"); |
sewardj | 96330bd | 2003-04-27 23:46:21 +0000 | [diff] [blame] | 1084 | VG_(printf)("version, and what Linux distro you are using. Thanks.\n\n"); |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1085 | VG_(shutdown_logging)(); |
| 1086 | VG_(exit)(1); |
| 1087 | } |
| 1088 | |
| 1089 | __attribute__ ((noreturn)) |
daywalker | 3222e0a | 2003-09-18 01:39:50 +0000 | [diff] [blame] | 1090 | static void assert_fail ( const Char* expr, const Char* name, const Char* report, |
| 1091 | const Char* file, Int line, const Char* fn ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1092 | { |
sewardj | 018f762 | 2002-05-15 21:13:39 +0000 | [diff] [blame] | 1093 | static Bool entered = False; |
| 1094 | if (entered) |
| 1095 | VG_(exit)(2); |
| 1096 | entered = True; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1097 | VG_(printf)("\n%s: %s:%d (%s): Assertion `%s' failed.\n", |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1098 | name, file, line, fn, expr ); |
| 1099 | report_and_quit(report); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1100 | } |
| 1101 | |
daywalker | 3222e0a | 2003-09-18 01:39:50 +0000 | [diff] [blame] | 1102 | void VG_(skin_assert_fail) ( const Char* expr, const Char* file, Int line, const Char* fn ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1103 | { |
njn | d04b7c6 | 2002-10-03 14:05:52 +0000 | [diff] [blame] | 1104 | assert_fail(expr, VG_(details).name, VG_(details).bug_reports_to, |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1105 | file, line, fn); |
| 1106 | } |
| 1107 | |
daywalker | 3222e0a | 2003-09-18 01:39:50 +0000 | [diff] [blame] | 1108 | void VG_(core_assert_fail) ( const Char* expr, const Char* file, Int line, const Char* fn ) |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1109 | { |
| 1110 | assert_fail(expr, "valgrind", VG_EMAIL_ADDR, file, line, fn); |
| 1111 | } |
| 1112 | |
| 1113 | __attribute__ ((noreturn)) |
| 1114 | static void panic ( Char* name, Char* report, Char* str ) |
| 1115 | { |
| 1116 | VG_(printf)("\n%s: the `impossible' happened:\n %s\n", name, str); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1117 | VG_(printf)("Basic block ctr is approximately %llu\n", VG_(bbs_done) ); |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1118 | report_and_quit(report); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1119 | } |
| 1120 | |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1121 | void VG_(core_panic) ( Char* str ) |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1122 | { |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1123 | panic("valgrind", VG_EMAIL_ADDR, str); |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1124 | } |
| 1125 | |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1126 | void VG_(skin_panic) ( Char* str ) |
| 1127 | { |
njn | d04b7c6 | 2002-10-03 14:05:52 +0000 | [diff] [blame] | 1128 | panic(VG_(details).name, VG_(details).bug_reports_to, str); |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1129 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1130 | |
njn | 13f0293 | 2003-04-30 20:23:58 +0000 | [diff] [blame] | 1131 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1132 | /* --------------------------------------------------------------------- |
| 1133 | Primitive support for reading files. |
| 1134 | ------------------------------------------------------------------ */ |
| 1135 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1136 | static inline Bool fd_exists(Int fd) |
| 1137 | { |
| 1138 | struct vki_stat st; |
| 1139 | |
| 1140 | return VG_(fstat)(fd, &st) == 0; |
| 1141 | } |
| 1142 | |
| 1143 | /* Move an fd into the Valgrind-safe range */ |
| 1144 | Int VG_(safe_fd)(Int oldfd) |
| 1145 | { |
| 1146 | Int newfd; |
| 1147 | |
| 1148 | newfd = VG_(fcntl)(oldfd, VKI_F_DUPFD, VG_MAX_FD+1); |
| 1149 | if (newfd != -1) |
| 1150 | VG_(close)(oldfd); |
| 1151 | |
| 1152 | VG_(fcntl)(newfd, VKI_F_SETFD, VKI_FD_CLOEXEC); |
| 1153 | |
| 1154 | vg_assert(newfd > VG_MAX_FD); |
| 1155 | return newfd; |
| 1156 | } |
| 1157 | |
| 1158 | |
| 1159 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1160 | /* Returns -1 on failure. */ |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1161 | Int VG_(open) ( const Char* pathname, Int flags, Int mode ) |
| 1162 | { |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1163 | Int fd; |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1164 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1165 | /* (old comment, not sure if it still applies NJN 2002-sep-09) */ |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1166 | /* This gets a segmentation fault if pathname isn't a valid file. |
| 1167 | I don't know why. It seems like the call to open is getting |
| 1168 | intercepted and messed with by glibc ... */ |
| 1169 | /* fd = open( pathname, O_RDONLY ); */ |
| 1170 | /* ... so we go direct to the horse's mouth, which seems to work |
| 1171 | ok: */ |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1172 | fd = VG_(do_syscall)(__NR_open, (UInt)pathname, flags, mode); |
njn | 4f9c934 | 2002-04-29 16:03:24 +0000 | [diff] [blame] | 1173 | /* VG_(printf)("result = %d\n", fd); */ |
jsgf | f3c3f1a | 2003-10-14 22:13:28 +0000 | [diff] [blame^] | 1174 | /* return -ve error code */ |
njn | 4f9c934 | 2002-04-29 16:03:24 +0000 | [diff] [blame] | 1175 | return fd; |
| 1176 | } |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1177 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1178 | Int VG_(pipe) ( Int fd[2] ) |
| 1179 | { |
| 1180 | Int ret = VG_(do_syscall)(__NR_pipe, fd); |
| 1181 | return VG_(is_kerror)(ret) ? -1 : 0; |
| 1182 | } |
| 1183 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1184 | void VG_(close) ( Int fd ) |
| 1185 | { |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1186 | VG_(do_syscall)(__NR_close, fd); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1187 | } |
| 1188 | |
| 1189 | |
| 1190 | Int VG_(read) ( Int fd, void* buf, Int count) |
| 1191 | { |
| 1192 | Int res; |
| 1193 | /* res = read( fd, buf, count ); */ |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1194 | res = VG_(do_syscall)(__NR_read, fd, (UInt)buf, count); |
| 1195 | /* return -ERRNO on error */ |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1196 | return res; |
| 1197 | } |
| 1198 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1199 | Int VG_(write) ( Int fd, const void* buf, Int count) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1200 | { |
| 1201 | Int res; |
| 1202 | /* res = write( fd, buf, count ); */ |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1203 | res = VG_(do_syscall)(__NR_write, fd, (UInt)buf, count); |
| 1204 | /* return -ERRNO on error */ |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1205 | return res; |
| 1206 | } |
| 1207 | |
sewardj | b358620 | 2002-05-09 17:38:13 +0000 | [diff] [blame] | 1208 | Int VG_(stat) ( Char* file_name, struct vki_stat* buf ) |
| 1209 | { |
| 1210 | Int res; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1211 | res = VG_(do_syscall)(__NR_stat, (UInt)file_name, (UInt)buf); |
njn | 4155712 | 2002-10-14 09:25:37 +0000 | [diff] [blame] | 1212 | return VG_(is_kerror)(res) ? (-1) : 0; |
| 1213 | } |
| 1214 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1215 | Int VG_(fstat) ( Int fd, struct vki_stat* buf ) |
| 1216 | { |
| 1217 | Int res; |
| 1218 | res = VG_(do_syscall)(__NR_fstat, (UInt)fd, (UInt)buf); |
| 1219 | return VG_(is_kerror)(res) ? (-1) : 0; |
| 1220 | } |
| 1221 | |
| 1222 | Int VG_(dup2) ( Int oldfd, Int newfd ) |
| 1223 | { |
| 1224 | Int res; |
| 1225 | res = VG_(do_syscall)(__NR_dup2, (UInt)oldfd, (UInt)newfd); |
| 1226 | return VG_(is_kerror)(res) ? (-1) : res; |
| 1227 | } |
| 1228 | |
njn | 4155712 | 2002-10-14 09:25:37 +0000 | [diff] [blame] | 1229 | Int VG_(rename) ( Char* old_name, Char* new_name ) |
| 1230 | { |
| 1231 | Int res; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1232 | res = VG_(do_syscall)(__NR_rename, (UInt)old_name, (UInt)new_name); |
njn | 4155712 | 2002-10-14 09:25:37 +0000 | [diff] [blame] | 1233 | return VG_(is_kerror)(res) ? (-1) : 0; |
sewardj | b358620 | 2002-05-09 17:38:13 +0000 | [diff] [blame] | 1234 | } |
| 1235 | |
njn | 4aca2d2 | 2002-10-04 10:29:38 +0000 | [diff] [blame] | 1236 | Int VG_(unlink) ( Char* file_name ) |
| 1237 | { |
| 1238 | Int res; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1239 | res = VG_(do_syscall)(__NR_unlink, (UInt)file_name); |
njn | 4155712 | 2002-10-14 09:25:37 +0000 | [diff] [blame] | 1240 | return VG_(is_kerror)(res) ? (-1) : 0; |
njn | 4aca2d2 | 2002-10-04 10:29:38 +0000 | [diff] [blame] | 1241 | } |
| 1242 | |
njn | 13f0293 | 2003-04-30 20:23:58 +0000 | [diff] [blame] | 1243 | /* Nb: we do not allow the Linux extension which malloc()s memory for the |
| 1244 | buffer if buf==NULL, because we don't want Linux calling malloc() */ |
| 1245 | Char* VG_(getcwd) ( Char* buf, Int size ) |
| 1246 | { |
| 1247 | Int res; |
| 1248 | vg_assert(buf != NULL); |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1249 | res = VG_(do_syscall)(__NR_getcwd, (UInt)buf, (UInt)size); |
njn | 13f0293 | 2003-04-30 20:23:58 +0000 | [diff] [blame] | 1250 | return VG_(is_kerror)(res) ? ((Char*)NULL) : (Char*)res; |
| 1251 | } |
| 1252 | |
njn | 99ccf08 | 2003-09-30 13:51:23 +0000 | [diff] [blame] | 1253 | /* Alternative version that does allocate the memory. Easier to use. */ |
| 1254 | Bool VG_(getcwd_alloc) ( Char** out ) |
| 1255 | { |
| 1256 | UInt size = 4; |
| 1257 | |
| 1258 | *out = NULL; |
| 1259 | while (True) { |
| 1260 | *out = VG_(malloc)(size); |
| 1261 | if (NULL == VG_(getcwd)(*out, size)) { |
| 1262 | VG_(free)(*out); |
| 1263 | if (size > 65535) |
| 1264 | return False; |
| 1265 | size *= 2; |
| 1266 | } else { |
| 1267 | return True; |
| 1268 | } |
| 1269 | } |
| 1270 | } |
| 1271 | |
njn | 13f0293 | 2003-04-30 20:23:58 +0000 | [diff] [blame] | 1272 | |
| 1273 | /* --------------------------------------------------------------------- |
| 1274 | Misc functions looking for a proper home. |
| 1275 | ------------------------------------------------------------------ */ |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1276 | |
| 1277 | /* We do getenv without libc's help by snooping around in |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1278 | VG_(client_envp) as determined at startup time. */ |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1279 | Char* VG_(getenv) ( Char* varname ) |
| 1280 | { |
| 1281 | Int i, n; |
| 1282 | n = VG_(strlen)(varname); |
| 1283 | for (i = 0; VG_(client_envp)[i] != NULL; i++) { |
| 1284 | Char* s = VG_(client_envp)[i]; |
| 1285 | if (VG_(strncmp)(varname, s, n) == 0 && s[n] == '=') { |
| 1286 | return & s[n+1]; |
| 1287 | } |
| 1288 | } |
| 1289 | return NULL; |
| 1290 | } |
| 1291 | |
sewardj | 4cf0569 | 2002-10-27 20:28:29 +0000 | [diff] [blame] | 1292 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1293 | /* You'd be amazed how many places need to know the current pid. */ |
| 1294 | Int VG_(getpid) ( void ) |
| 1295 | { |
| 1296 | Int res; |
| 1297 | /* res = getpid(); */ |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1298 | res = VG_(do_syscall)(__NR_getpid); |
| 1299 | return res; |
| 1300 | } |
| 1301 | |
| 1302 | Int VG_(getpgrp) ( void ) |
| 1303 | { |
| 1304 | Int res; |
| 1305 | /* res = getpgid(); */ |
| 1306 | res = VG_(do_syscall)(__NR_getpgrp); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1307 | return res; |
| 1308 | } |
| 1309 | |
sewardj | 4cf0569 | 2002-10-27 20:28:29 +0000 | [diff] [blame] | 1310 | Int VG_(getppid) ( void ) |
| 1311 | { |
| 1312 | Int res; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1313 | res = VG_(do_syscall)(__NR_getppid); |
sewardj | 4cf0569 | 2002-10-27 20:28:29 +0000 | [diff] [blame] | 1314 | return res; |
| 1315 | } |
| 1316 | |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1317 | Int VG_(setpgid) ( Int pid, Int pgrp ) |
| 1318 | { |
| 1319 | return VG_(do_syscall)(__NR_setpgid, pid, pgrp); |
| 1320 | } |
sewardj | 4cf0569 | 2002-10-27 20:28:29 +0000 | [diff] [blame] | 1321 | |
sewardj | e6a2524 | 2002-04-21 22:03:07 +0000 | [diff] [blame] | 1322 | /* Return -1 if error, else 0. NOTE does not indicate return code of |
| 1323 | child! */ |
| 1324 | Int VG_(system) ( Char* cmd ) |
| 1325 | { |
| 1326 | Int pid, res; |
| 1327 | void* environ[1] = { NULL }; |
| 1328 | if (cmd == NULL) |
| 1329 | return 1; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1330 | pid = VG_(do_syscall)(__NR_fork); |
sewardj | e6a2524 | 2002-04-21 22:03:07 +0000 | [diff] [blame] | 1331 | if (VG_(is_kerror)(pid)) |
| 1332 | return -1; |
| 1333 | if (pid == 0) { |
| 1334 | /* child */ |
| 1335 | Char* argv[4]; |
| 1336 | argv[0] = "/bin/sh"; |
| 1337 | argv[1] = "-c"; |
| 1338 | argv[2] = cmd; |
| 1339 | argv[3] = 0; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1340 | (void)VG_(do_syscall)(__NR_execve, |
| 1341 | (UInt)"/bin/sh", (UInt)argv, (UInt)&environ); |
sewardj | e6a2524 | 2002-04-21 22:03:07 +0000 | [diff] [blame] | 1342 | /* If we're still alive here, execve failed. */ |
| 1343 | return -1; |
| 1344 | } else { |
| 1345 | /* parent */ |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1346 | res = VG_(do_syscall)(__NR_waitpid, pid, (UInt)NULL, 0); |
sewardj | e6a2524 | 2002-04-21 22:03:07 +0000 | [diff] [blame] | 1347 | if (VG_(is_kerror)(res)) { |
| 1348 | return -1; |
| 1349 | } else { |
| 1350 | return 0; |
| 1351 | } |
| 1352 | } |
| 1353 | } |
| 1354 | |
| 1355 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1356 | /* --------------------------------------------------------------------- |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 1357 | Support for a millisecond-granularity counter using RDTSC. |
| 1358 | ------------------------------------------------------------------ */ |
| 1359 | |
| 1360 | static __inline__ ULong do_rdtsc_insn ( void ) |
| 1361 | { |
| 1362 | ULong x; |
| 1363 | __asm__ volatile (".byte 0x0f, 0x31" : "=A" (x)); |
| 1364 | return x; |
| 1365 | } |
| 1366 | |
| 1367 | /* 0 = pre-calibration, 1 = calibration, 2 = running */ |
| 1368 | static Int rdtsc_calibration_state = 0; |
| 1369 | static ULong rdtsc_ticks_per_millisecond = 0; /* invalid value */ |
| 1370 | |
| 1371 | static struct vki_timeval rdtsc_cal_start_timeval; |
| 1372 | static struct vki_timeval rdtsc_cal_end_timeval; |
| 1373 | |
| 1374 | static ULong rdtsc_cal_start_raw; |
| 1375 | static ULong rdtsc_cal_end_raw; |
| 1376 | |
| 1377 | UInt VG_(read_millisecond_timer) ( void ) |
| 1378 | { |
| 1379 | ULong rdtsc_now; |
njn | e7442cf | 2003-09-30 14:03:21 +0000 | [diff] [blame] | 1380 | // If called before rdtsc setup completed (eg. from SK_(pre_clo_init)()) |
| 1381 | // just return 0. |
| 1382 | if (rdtsc_calibration_state < 2) return 0; |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 1383 | rdtsc_now = do_rdtsc_insn(); |
| 1384 | vg_assert(rdtsc_now > rdtsc_cal_end_raw); |
| 1385 | rdtsc_now -= rdtsc_cal_end_raw; |
| 1386 | rdtsc_now /= rdtsc_ticks_per_millisecond; |
| 1387 | return (UInt)rdtsc_now; |
| 1388 | } |
| 1389 | |
| 1390 | |
| 1391 | void VG_(start_rdtsc_calibration) ( void ) |
| 1392 | { |
| 1393 | Int res; |
| 1394 | vg_assert(rdtsc_calibration_state == 0); |
| 1395 | rdtsc_calibration_state = 1; |
| 1396 | rdtsc_cal_start_raw = do_rdtsc_insn(); |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1397 | res = VG_(do_syscall)(__NR_gettimeofday, (UInt)&rdtsc_cal_start_timeval, |
| 1398 | (UInt)NULL); |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 1399 | vg_assert(!VG_(is_kerror)(res)); |
| 1400 | } |
| 1401 | |
| 1402 | void VG_(end_rdtsc_calibration) ( void ) |
| 1403 | { |
| 1404 | Int res, loops; |
| 1405 | ULong cpu_clock_MHZ; |
| 1406 | ULong cal_clock_ticks; |
| 1407 | ULong cal_wallclock_microseconds; |
| 1408 | ULong wallclock_start_microseconds; |
| 1409 | ULong wallclock_end_microseconds; |
| 1410 | struct vki_timespec req; |
| 1411 | struct vki_timespec rem; |
| 1412 | |
| 1413 | vg_assert(rdtsc_calibration_state == 1); |
| 1414 | rdtsc_calibration_state = 2; |
| 1415 | |
| 1416 | /* Try and delay for 20 milliseconds, so that we can at least have |
| 1417 | some minimum level of accuracy. */ |
| 1418 | req.tv_sec = 0; |
| 1419 | req.tv_nsec = 20 * 1000 * 1000; |
| 1420 | loops = 0; |
| 1421 | while (True) { |
| 1422 | res = VG_(nanosleep)(&req, &rem); |
| 1423 | vg_assert(res == 0 /*ok*/ || res == 1 /*interrupted*/); |
| 1424 | if (res == 0) |
| 1425 | break; |
| 1426 | if (rem.tv_sec == 0 && rem.tv_nsec == 0) |
| 1427 | break; |
| 1428 | req = rem; |
| 1429 | loops++; |
| 1430 | if (loops > 100) |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1431 | VG_(core_panic)("calibration nanosleep loop failed?!"); |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 1432 | } |
| 1433 | |
| 1434 | /* Now read both timers, and do the Math. */ |
| 1435 | rdtsc_cal_end_raw = do_rdtsc_insn(); |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1436 | res = VG_(do_syscall)(__NR_gettimeofday, (UInt)&rdtsc_cal_end_timeval, |
| 1437 | (UInt)NULL); |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 1438 | |
| 1439 | vg_assert(rdtsc_cal_end_raw > rdtsc_cal_start_raw); |
| 1440 | cal_clock_ticks = rdtsc_cal_end_raw - rdtsc_cal_start_raw; |
| 1441 | |
| 1442 | wallclock_start_microseconds |
| 1443 | = (1000000ULL * (ULong)(rdtsc_cal_start_timeval.tv_sec)) |
| 1444 | + (ULong)(rdtsc_cal_start_timeval.tv_usec); |
| 1445 | wallclock_end_microseconds |
| 1446 | = (1000000ULL * (ULong)(rdtsc_cal_end_timeval.tv_sec)) |
| 1447 | + (ULong)(rdtsc_cal_end_timeval.tv_usec); |
| 1448 | vg_assert(wallclock_end_microseconds > wallclock_start_microseconds); |
| 1449 | cal_wallclock_microseconds |
| 1450 | = wallclock_end_microseconds - wallclock_start_microseconds; |
| 1451 | |
| 1452 | /* Since we just nanoslept for 20 ms ... */ |
| 1453 | vg_assert(cal_wallclock_microseconds >= 20000); |
| 1454 | |
| 1455 | /* Now we know (roughly) that cal_clock_ticks on RDTSC take |
| 1456 | cal_wallclock_microseconds elapsed time. Calculate the RDTSC |
| 1457 | ticks-per-millisecond value. */ |
| 1458 | if (0) |
| 1459 | VG_(printf)("%lld ticks in %lld microseconds\n", |
| 1460 | cal_clock_ticks, cal_wallclock_microseconds ); |
| 1461 | |
| 1462 | rdtsc_ticks_per_millisecond |
| 1463 | = cal_clock_ticks / (cal_wallclock_microseconds / 1000ULL); |
| 1464 | cpu_clock_MHZ |
| 1465 | = (1000ULL * rdtsc_ticks_per_millisecond) / 1000000ULL; |
| 1466 | if (VG_(clo_verbosity) >= 1) |
| 1467 | VG_(message)(Vg_UserMsg, "Estimated CPU clock rate is %d MHz", |
| 1468 | (UInt)cpu_clock_MHZ); |
sewardj | 09c55fd | 2002-06-13 11:37:41 +0000 | [diff] [blame] | 1469 | if (cpu_clock_MHZ < 50 || cpu_clock_MHZ > 10000) |
njn | e427a66 | 2002-10-02 11:08:25 +0000 | [diff] [blame] | 1470 | VG_(core_panic)("end_rdtsc_calibration: " |
sewardj | 09c55fd | 2002-06-13 11:37:41 +0000 | [diff] [blame] | 1471 | "estimated CPU MHz outside range 50 .. 10000"); |
sewardj | 5f07b66 | 2002-04-23 16:52:51 +0000 | [diff] [blame] | 1472 | /* Paranoia about division by zero later. */ |
| 1473 | vg_assert(rdtsc_ticks_per_millisecond != 0); |
| 1474 | if (0) |
| 1475 | VG_(printf)("ticks per millisecond %llu\n", |
| 1476 | rdtsc_ticks_per_millisecond); |
| 1477 | } |
| 1478 | |
| 1479 | |
| 1480 | |
| 1481 | /* --------------------------------------------------------------------- |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1482 | Primitive support for bagging memory via mmap. |
| 1483 | ------------------------------------------------------------------ */ |
| 1484 | |
sewardj | e904795 | 2002-06-05 20:28:33 +0000 | [diff] [blame] | 1485 | void* VG_(get_memory_from_mmap) ( Int nBytes, Char* who ) |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1486 | { |
| 1487 | static UInt tot_alloc = 0; |
sewardj | 7c2020b | 2002-09-30 22:56:03 +0000 | [diff] [blame] | 1488 | void* p; |
| 1489 | p = VG_(mmap)( 0, nBytes, |
| 1490 | VKI_PROT_READ|VKI_PROT_WRITE|VKI_PROT_EXEC, |
| 1491 | VKI_MAP_PRIVATE|VKI_MAP_ANONYMOUS, -1, 0 ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1492 | if (p != ((void*)(-1))) { |
| 1493 | tot_alloc += (UInt)nBytes; |
| 1494 | if (0) |
sewardj | e904795 | 2002-06-05 20:28:33 +0000 | [diff] [blame] | 1495 | VG_(printf)( |
| 1496 | "get_memory_from_mmap: %d tot, %d req = %p .. %p, caller %s\n", |
| 1497 | tot_alloc, nBytes, p, ((char*)p) + nBytes - 1, who ); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1498 | return p; |
| 1499 | } |
sewardj | 7c2020b | 2002-09-30 22:56:03 +0000 | [diff] [blame] | 1500 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1501 | VG_(printf)("\n"); |
daywalker | b1db123 | 2003-09-26 00:26:07 +0000 | [diff] [blame] | 1502 | VG_(printf)("VG_(get_memory_from_mmap): %s's request for %d bytes failed.\n", |
| 1503 | who, nBytes); |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1504 | VG_(printf)("VG_(get_memory_from_mmap): %d bytes already allocated.\n", |
| 1505 | tot_alloc); |
| 1506 | VG_(printf)("\n"); |
| 1507 | VG_(printf)("This may mean that you have run out of swap space,\n"); |
| 1508 | VG_(printf)("since running programs on valgrind increases their memory\n"); |
| 1509 | VG_(printf)("usage at least 3 times. You might want to use 'top'\n"); |
| 1510 | VG_(printf)("to determine whether you really have run out of swap.\n"); |
| 1511 | VG_(printf)("If so, you may be able to work around it by adding a\n"); |
| 1512 | VG_(printf)("temporary swap file -- this is easier than finding a\n"); |
| 1513 | VG_(printf)("new swap partition. Go ask your sysadmin(s) [politely!]\n"); |
| 1514 | VG_(printf)("\n"); |
| 1515 | VG_(printf)("VG_(get_memory_from_mmap): out of memory! Fatal! Bye!\n"); |
| 1516 | VG_(printf)("\n"); |
| 1517 | VG_(exit)(1); |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1518 | } |
| 1519 | |
njn25 | e49d8e7 | 2002-09-23 09:36:25 +0000 | [diff] [blame] | 1520 | /* --------------------------------------------------------------------- |
| 1521 | Generally useful... |
| 1522 | ------------------------------------------------------------------ */ |
| 1523 | |
| 1524 | Int VG_(log2) ( Int x ) |
| 1525 | { |
| 1526 | Int i; |
| 1527 | /* Any more than 32 and we overflow anyway... */ |
| 1528 | for (i = 0; i < 32; i++) { |
| 1529 | if (1 << i == x) return i; |
| 1530 | } |
| 1531 | return -1; |
| 1532 | } |
| 1533 | |
| 1534 | |
njn | d3b0c5f | 2003-09-30 14:43:54 +0000 | [diff] [blame] | 1535 | // Generic shell sort. Like stdlib.h's qsort(). |
| 1536 | void VG_(ssort)( void* base, UInt nmemb, UInt size, |
| 1537 | Int (*compar)(void*, void*) ) |
| 1538 | { |
| 1539 | Int incs[14] = { 1, 4, 13, 40, 121, 364, 1093, 3280, |
| 1540 | 9841, 29524, 88573, 265720, |
| 1541 | 797161, 2391484 }; |
| 1542 | Int lo = 0; |
| 1543 | Int hi = nmemb-1; |
| 1544 | Int i, j, h, bigN, hp; |
| 1545 | |
| 1546 | bigN = hi - lo + 1; if (bigN < 2) return; |
| 1547 | hp = 0; while (hp < 14 && incs[hp] < bigN) hp++; hp--; |
| 1548 | vg_assert(0 <= hp && hp < 14); |
| 1549 | |
| 1550 | #define SORT \ |
| 1551 | for ( ; hp >= 0; hp--) { \ |
| 1552 | h = incs[hp]; \ |
| 1553 | i = lo + h; \ |
| 1554 | while (1) { \ |
| 1555 | if (i > hi) break; \ |
| 1556 | ASSIGN(v,0, a,i); \ |
| 1557 | j = i; \ |
| 1558 | while (COMPAR(a,(j-h), v,0) > 0) { \ |
| 1559 | ASSIGN(a,j, a,(j-h)); \ |
| 1560 | j = j - h; \ |
| 1561 | if (j <= (lo + h - 1)) break; \ |
| 1562 | } \ |
| 1563 | ASSIGN(a,j, v,0); \ |
| 1564 | i++; \ |
| 1565 | } \ |
| 1566 | } |
| 1567 | |
| 1568 | // Specialised cases |
| 1569 | if (sizeof(UInt) == size) { |
| 1570 | |
| 1571 | #define ASSIGN(dst, dsti, src, srci) \ |
| 1572 | (dst)[(dsti)] = (src)[(srci)]; |
| 1573 | |
| 1574 | #define COMPAR(dst, dsti, src, srci) \ |
| 1575 | compar( (void*)(& (dst)[(dsti)]), (void*)(& (src)[(srci)]) ) |
| 1576 | |
| 1577 | UInt* a = (UInt*)base; |
| 1578 | UInt v[1]; |
| 1579 | |
| 1580 | SORT; |
| 1581 | |
| 1582 | } else if (sizeof(UShort) == size) { |
| 1583 | UShort* a = (UShort*)base; |
| 1584 | UShort v[1]; |
| 1585 | |
| 1586 | SORT; |
| 1587 | |
| 1588 | } else if (sizeof(UChar) == size) { |
| 1589 | UChar* a = (UChar*)base; |
| 1590 | UChar v[1]; |
| 1591 | |
| 1592 | SORT; |
| 1593 | |
| 1594 | #undef ASSIGN |
| 1595 | #undef COMPAR |
| 1596 | |
| 1597 | // General case |
| 1598 | } else { |
| 1599 | void* a = (void*)base; |
| 1600 | Char vc[size]; // will be at least 'size' bytes |
| 1601 | void* v = (void*)vc; |
| 1602 | |
| 1603 | #define ASSIGN(dst, dsti, src, srci) \ |
| 1604 | VG_(memcpy)( (void*)((dst) + size*(dsti)), \ |
| 1605 | (void*)((src) + size*(srci)), (size) ); |
| 1606 | |
| 1607 | #define COMPAR(dst, dsti, src, srci) \ |
| 1608 | compar( (void*)((dst) + size*(dsti)), (void*)((src) + size*(srci)) ) |
| 1609 | |
| 1610 | SORT; |
| 1611 | |
| 1612 | #undef ASSIGN |
| 1613 | #undef COMPAR |
| 1614 | } |
| 1615 | #undef SORT |
| 1616 | } |
| 1617 | |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1618 | /* --------------------------------------------------------------------- |
| 1619 | Gruesome hackery for connecting to a logging server over the network. |
| 1620 | This is all very Linux-kernel specific. |
| 1621 | ------------------------------------------------------------------ */ |
| 1622 | |
| 1623 | /* Various needed constants from the kernel iface (2.4), |
| 1624 | /usr/src/linux-2.4.9-31 */ |
| 1625 | |
| 1626 | /* kernel, ./include/linux/net.h */ |
| 1627 | #define SYS_SOCKET 1 /* sys_socket(2) */ |
| 1628 | #define SYS_CONNECT 3 /* sys_connect(2) */ |
| 1629 | #define SYS_SEND 9 /* sys_send(2) */ |
| 1630 | |
| 1631 | typedef UInt __u32; |
| 1632 | |
| 1633 | /* Internet address. */ |
| 1634 | struct vki_in_addr { |
| 1635 | __u32 s_addr; |
| 1636 | }; |
| 1637 | |
| 1638 | /* kernel, include/linux/socket.h */ |
| 1639 | typedef unsigned short vki_sa_family_t; |
| 1640 | #define AF_INET 2 /* Internet IP Protocol */ |
sewardj | 570f890 | 2002-11-03 11:44:36 +0000 | [diff] [blame] | 1641 | #define MSG_NOSIGNAL 0x4000 /* Do not generate SIGPIPE */ |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1642 | |
| 1643 | /* kernel, ./include/asm-i386/socket.h */ |
| 1644 | #define SOCK_STREAM 1 /* stream (connection) socket */ |
| 1645 | |
| 1646 | /* kernel, /usr/src/linux-2.4.9-31/linux/include/in.h */ |
| 1647 | /* Structure describing an Internet (IP) socket address. */ |
| 1648 | #define __SOCK_SIZE__ 16 /* sizeof(struct sockaddr) */ |
| 1649 | struct vki_sockaddr_in { |
| 1650 | vki_sa_family_t sin_family; /* Address family */ |
| 1651 | unsigned short int sin_port; /* Port number */ |
| 1652 | struct vki_in_addr sin_addr; /* Internet address */ |
| 1653 | |
| 1654 | /* Pad to size of `struct sockaddr'. */ |
| 1655 | unsigned char __pad[__SOCK_SIZE__ - sizeof(short int) - |
| 1656 | sizeof(unsigned short int) - |
| 1657 | sizeof(struct vki_in_addr)]; |
| 1658 | }; |
| 1659 | |
| 1660 | |
| 1661 | static |
| 1662 | Int parse_inet_addr_and_port ( UChar* str, UInt* ip_addr, UShort* port ); |
| 1663 | |
| 1664 | static |
| 1665 | Int my_socket ( Int domain, Int type, Int protocol ); |
| 1666 | |
| 1667 | static |
| 1668 | Int my_connect ( Int sockfd, struct vki_sockaddr_in* serv_addr, |
| 1669 | Int addrlen ); |
| 1670 | |
| 1671 | static |
| 1672 | UInt my_htonl ( UInt x ) |
| 1673 | { |
| 1674 | return |
| 1675 | (((x >> 24) & 0xFF) << 0) | (((x >> 16) & 0xFF) << 8) |
| 1676 | | (((x >> 8) & 0xFF) << 16) | (((x >> 0) & 0xFF) << 24); |
| 1677 | } |
| 1678 | |
| 1679 | static |
| 1680 | UShort my_htons ( UShort x ) |
| 1681 | { |
| 1682 | return |
| 1683 | (((x >> 8) & 0xFF) << 0) | (((x >> 0) & 0xFF) << 8); |
| 1684 | } |
| 1685 | |
| 1686 | |
| 1687 | /* The main function. |
| 1688 | |
| 1689 | Supplied string contains either an ip address "192.168.0.1" or |
| 1690 | an ip address and port pair, "192.168.0.1:1500". Parse these, |
| 1691 | and return: |
| 1692 | -1 if there is a parse error |
| 1693 | -2 if no parse error, but specified host:port cannot be opened |
| 1694 | the relevant file (socket) descriptor, otherwise. |
sewardj | 4f094a7 | 2002-11-05 23:37:35 +0000 | [diff] [blame] | 1695 | is used. |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1696 | */ |
| 1697 | Int VG_(connect_via_socket)( UChar* str ) |
| 1698 | { |
| 1699 | Int sd, res; |
| 1700 | struct vki_sockaddr_in servAddr; |
| 1701 | UInt ip = 0; |
sewardj | 4f094a7 | 2002-11-05 23:37:35 +0000 | [diff] [blame] | 1702 | UShort port = VG_CLO_DEFAULT_LOGPORT; |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1703 | Bool ok = parse_inet_addr_and_port(str, &ip, &port); |
| 1704 | if (!ok) |
| 1705 | return -1; |
| 1706 | |
| 1707 | if (0) |
| 1708 | VG_(printf)("ip = %d.%d.%d.%d, port %d\n", |
| 1709 | (ip >> 24) & 0xFF, (ip >> 16) & 0xFF, |
| 1710 | (ip >> 8) & 0xFF, ip & 0xFF, |
| 1711 | (UInt)port ); |
| 1712 | |
| 1713 | servAddr.sin_family = AF_INET; |
| 1714 | servAddr.sin_addr.s_addr = my_htonl(ip); |
| 1715 | servAddr.sin_port = my_htons(port); |
| 1716 | |
| 1717 | /* create socket */ |
| 1718 | sd = my_socket(AF_INET, SOCK_STREAM, 0 /* IPPROTO_IP ? */); |
| 1719 | if (sd < 0) { |
| 1720 | /* this shouldn't happen ... nevertheless */ |
| 1721 | return -2; |
| 1722 | } |
| 1723 | |
| 1724 | /* connect to server */ |
| 1725 | res = my_connect(sd, (struct vki_sockaddr_in *) &servAddr, |
| 1726 | sizeof(servAddr)); |
| 1727 | if (res < 0) { |
| 1728 | /* connection failed */ |
| 1729 | return -2; |
| 1730 | } |
| 1731 | |
| 1732 | return sd; |
| 1733 | } |
| 1734 | |
| 1735 | |
| 1736 | /* Let d = one or more digits. Accept either: |
| 1737 | d.d.d.d or d.d.d.d:d |
| 1738 | */ |
| 1739 | Int parse_inet_addr_and_port ( UChar* str, UInt* ip_addr, UShort* port ) |
| 1740 | { |
| 1741 | # define GET_CH ((*str) ? (*str++) : 0) |
| 1742 | UInt ipa, i, j, c, any; |
| 1743 | ipa = 0; |
| 1744 | for (i = 0; i < 4; i++) { |
| 1745 | j = 0; |
| 1746 | any = 0; |
| 1747 | while (1) { |
| 1748 | c = GET_CH; |
| 1749 | if (c < '0' || c > '9') break; |
| 1750 | j = 10 * j + (int)(c - '0'); |
| 1751 | any = 1; |
| 1752 | } |
| 1753 | if (any == 0 || j > 255) goto syntaxerr; |
| 1754 | ipa = (ipa << 8) + j; |
| 1755 | if (i <= 2 && c != '.') goto syntaxerr; |
| 1756 | } |
| 1757 | if (c == 0 || c == ':') |
| 1758 | *ip_addr = ipa; |
| 1759 | if (c == 0) goto ok; |
| 1760 | if (c != ':') goto syntaxerr; |
| 1761 | j = 0; |
| 1762 | any = 0; |
| 1763 | while (1) { |
| 1764 | c = GET_CH; |
| 1765 | if (c < '0' || c > '9') break; |
| 1766 | j = j * 10 + (int)(c - '0'); |
| 1767 | any = 1; |
| 1768 | if (j > 65535) goto syntaxerr; |
| 1769 | } |
| 1770 | if (any == 0 || c != 0) goto syntaxerr; |
sewardj | d222067 | 2002-11-13 19:41:41 +0000 | [diff] [blame] | 1771 | if (j < 1024) goto syntaxerr; |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1772 | *port = (UShort)j; |
| 1773 | ok: |
| 1774 | return 1; |
| 1775 | syntaxerr: |
| 1776 | return 0; |
| 1777 | # undef GET_CH |
| 1778 | } |
| 1779 | |
| 1780 | |
| 1781 | static |
| 1782 | Int my_socket ( Int domain, Int type, Int protocol ) |
| 1783 | { |
| 1784 | Int res; |
| 1785 | UInt args[3]; |
| 1786 | args[0] = domain; |
| 1787 | args[1] = type; |
| 1788 | args[2] = protocol; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1789 | res = VG_(do_syscall)(__NR_socketcall, SYS_SOCKET, (UInt)&args); |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1790 | if (VG_(is_kerror)(res)) |
| 1791 | res = -1; |
| 1792 | return res; |
| 1793 | } |
| 1794 | |
| 1795 | static |
| 1796 | Int my_connect ( Int sockfd, struct vki_sockaddr_in* serv_addr, |
| 1797 | Int addrlen ) |
| 1798 | { |
| 1799 | Int res; |
| 1800 | UInt args[3]; |
| 1801 | args[0] = sockfd; |
| 1802 | args[1] = (UInt)serv_addr; |
| 1803 | args[2] = addrlen; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1804 | res = VG_(do_syscall)(__NR_socketcall, SYS_CONNECT, (UInt)&args); |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1805 | if (VG_(is_kerror)(res)) |
| 1806 | res = -1; |
| 1807 | return res; |
| 1808 | } |
| 1809 | |
| 1810 | Int VG_(write_socket)( Int sd, void *msg, Int count ) |
| 1811 | { |
| 1812 | /* This is actually send(). */ |
sewardj | 570f890 | 2002-11-03 11:44:36 +0000 | [diff] [blame] | 1813 | |
| 1814 | /* Requests not to send SIGPIPE on errors on stream oriented |
| 1815 | sockets when the other end breaks the connection. The EPIPE |
| 1816 | error is still returned. */ |
| 1817 | Int flags = MSG_NOSIGNAL; |
| 1818 | |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1819 | Int res; |
| 1820 | UInt args[4]; |
| 1821 | args[0] = sd; |
| 1822 | args[1] = (UInt)msg; |
| 1823 | args[2] = count; |
| 1824 | args[3] = flags; |
jsgf | 855d93d | 2003-10-13 22:26:55 +0000 | [diff] [blame] | 1825 | res = VG_(do_syscall)(__NR_socketcall, SYS_SEND, (UInt)&args); |
sewardj | 73cf3bc | 2002-11-03 03:20:15 +0000 | [diff] [blame] | 1826 | if (VG_(is_kerror)(res)) |
| 1827 | res = -1; |
| 1828 | return res; |
| 1829 | } |
| 1830 | |
sewardj | de4a1d0 | 2002-03-22 01:27:54 +0000 | [diff] [blame] | 1831 | |
| 1832 | /*--------------------------------------------------------------------*/ |
| 1833 | /*--- end vg_mylibc.c ---*/ |
| 1834 | /*--------------------------------------------------------------------*/ |