| 1 | /*************************************************************************** |
| 2 | * _ _ ____ _ |
| 3 | * Project ___| | | | _ \| | |
| 4 | * / __| | | | |_) | | |
| 5 | * | (__| |_| | _ <| |___ |
| 6 | * \___|\___/|_| \_\_____| |
| 7 | * |
| 8 | * Copyright (C) 1998 - 2021, Daniel Stenberg, <daniel@haxx.se>, et al. |
| 9 | * |
| 10 | * This software is licensed as described in the file COPYING, which |
| 11 | * you should have received as part of this distribution. The terms |
| 12 | * are also available at https://curl.se/docs/copyright.html. |
| 13 | * |
| 14 | * You may opt to use, copy, modify, merge, publish, distribute and/or sell |
| 15 | * copies of the Software, and permit persons to whom the Software is |
| 16 | * furnished to do so, under the terms of the COPYING file. |
| 17 | * |
| 18 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY |
| 19 | * KIND, either express or implied. |
| 20 | * |
| 21 | ***************************************************************************/ |
| 22 | #include "server_setup.h" |
| 23 | |
| 24 | /* Purpose |
| 25 | * |
| 26 | * 1. Accept a TCP connection on a custom port (IPv4 or IPv6), or connect |
| 27 | * to a given (localhost) port. |
| 28 | * |
| 29 | * 2. Get commands on STDIN. Pass data on to the TCP stream. |
| 30 | * Get data from TCP stream and pass on to STDOUT. |
| 31 | * |
| 32 | * This program is made to perform all the socket/stream/connection stuff for |
| 33 | * the test suite's (perl) FTP server. Previously the perl code did all of |
| 34 | * this by its own, but I decided to let this program do the socket layer |
| 35 | * because of several things: |
| 36 | * |
| 37 | * o We want the perl code to work with rather old perl installations, thus |
| 38 | * we cannot use recent perl modules or features. |
| 39 | * |
| 40 | * o We want IPv6 support for systems that provide it, and doing optional IPv6 |
| 41 | * support in perl seems if not impossible so at least awkward. |
| 42 | * |
| 43 | * o We want FTP-SSL support, which means that a connection that starts with |
| 44 | * plain sockets needs to be able to "go SSL" in the midst. This would also |
| 45 | * require some nasty perl stuff I'd rather avoid. |
| 46 | * |
| 47 | * (Source originally based on sws.c) |
| 48 | */ |
| 49 | |
| 50 | /* |
| 51 | * Signal handling notes for sockfilt |
| 52 | * ---------------------------------- |
| 53 | * |
| 54 | * This program is a single-threaded process. |
| 55 | * |
| 56 | * This program is intended to be highly portable and as such it must be kept |
| 57 | * as simple as possible, due to this the only signal handling mechanisms used |
| 58 | * will be those of ANSI C, and used only in the most basic form which is good |
| 59 | * enough for the purpose of this program. |
| 60 | * |
| 61 | * For the above reason and the specific needs of this program signals SIGHUP, |
| 62 | * SIGPIPE and SIGALRM will be simply ignored on systems where this can be |
| 63 | * done. If possible, signals SIGINT and SIGTERM will be handled by this |
| 64 | * program as an indication to cleanup and finish execution as soon as |
| 65 | * possible. This will be achieved with a single signal handler |
| 66 | * 'exit_signal_handler' for both signals. |
| 67 | * |
| 68 | * The 'exit_signal_handler' upon the first SIGINT or SIGTERM received signal |
| 69 | * will just set to one the global var 'got_exit_signal' storing in global var |
| 70 | * 'exit_signal' the signal that triggered this change. |
| 71 | * |
| 72 | * Nothing fancy that could introduce problems is used, the program at certain |
| 73 | * points in its normal flow checks if var 'got_exit_signal' is set and in |
| 74 | * case this is true it just makes its way out of loops and functions in |
| 75 | * structured and well behaved manner to achieve proper program cleanup and |
| 76 | * termination. |
| 77 | * |
| 78 | * Even with the above mechanism implemented it is worthwhile to note that |
| 79 | * other signals might still be received, or that there might be systems on |
| 80 | * which it is not possible to trap and ignore some of the above signals. |
| 81 | * This implies that for increased portability and reliability the program |
| 82 | * must be coded as if no signal was being ignored or handled at all. Enjoy |
| 83 | * it! |
| 84 | */ |
| 85 | |
| 86 | #ifdef HAVE_SIGNAL_H |
| 87 | #include <signal.h> |
| 88 | #endif |
| 89 | #ifdef HAVE_NETINET_IN_H |
| 90 | #include <netinet/in.h> |
| 91 | #endif |
| 92 | #ifdef HAVE_NETINET_IN6_H |
| 93 | #include <netinet/in6.h> |
| 94 | #endif |
| 95 | #ifdef HAVE_ARPA_INET_H |
| 96 | #include <arpa/inet.h> |
| 97 | #endif |
| 98 | #ifdef HAVE_NETDB_H |
| 99 | #include <netdb.h> |
| 100 | #endif |
| 101 | |
| 102 | #define ENABLE_CURLX_PRINTF |
| 103 | /* make the curlx header define all printf() functions to use the curlx_* |
| 104 | versions instead */ |
| 105 | #include "curlx.h" /* from the private lib dir */ |
| 106 | #include "getpart.h" |
| 107 | #include "inet_pton.h" |
| 108 | #include "util.h" |
| 109 | #include "server_sockaddr.h" |
| 110 | #include "warnless.h" |
| 111 | |
| 112 | /* include memdebug.h last */ |
| 113 | #include "memdebug.h" |
| 114 | |
| 115 | #ifdef USE_WINSOCK |
| 116 | #undef EINTR |
| 117 | #define EINTR 4 /* errno.h value */ |
| 118 | #undef EAGAIN |
| 119 | #define EAGAIN 11 /* errno.h value */ |
| 120 | #undef ENOMEM |
| 121 | #define ENOMEM 12 /* errno.h value */ |
| 122 | #undef EINVAL |
| 123 | #define EINVAL 22 /* errno.h value */ |
| 124 | #endif |
| 125 | |
| 126 | #define DEFAULT_PORT 8999 |
| 127 | |
| 128 | #ifndef DEFAULT_LOGFILE |
| 129 | #define DEFAULT_LOGFILE "log/sockfilt.log" |
| 130 | #endif |
| 131 | |
| 132 | const char *serverlogfile = DEFAULT_LOGFILE; |
| 133 | |
| 134 | static bool verbose = FALSE; |
| 135 | static bool bind_only = FALSE; |
| 136 | #ifdef ENABLE_IPV6 |
| 137 | static bool use_ipv6 = FALSE; |
| 138 | #endif |
| 139 | static const char *ipv_inuse = "IPv4" ; |
| 140 | static unsigned short port = DEFAULT_PORT; |
| 141 | static unsigned short connectport = 0; /* if non-zero, we activate this mode */ |
| 142 | |
| 143 | enum sockmode { |
| 144 | PASSIVE_LISTEN, /* as a server waiting for connections */ |
| 145 | PASSIVE_CONNECT, /* as a server, connected to a client */ |
| 146 | ACTIVE, /* as a client, connected to a server */ |
| 147 | ACTIVE_DISCONNECT /* as a client, disconnected from server */ |
| 148 | }; |
| 149 | |
| 150 | #ifdef WIN32 |
| 151 | /* |
| 152 | * read-wrapper to support reading from stdin on Windows. |
| 153 | */ |
| 154 | static ssize_t read_wincon(int fd, void *buf, size_t count) |
| 155 | { |
| 156 | HANDLE handle = NULL; |
| 157 | DWORD mode, rcount = 0; |
| 158 | BOOL success; |
| 159 | |
| 160 | if(fd == fileno(stdin)) { |
| 161 | handle = GetStdHandle(STD_INPUT_HANDLE); |
| 162 | } |
| 163 | else { |
| 164 | return read(fd, buf, count); |
| 165 | } |
| 166 | |
| 167 | if(GetConsoleMode(handle, &mode)) { |
| 168 | success = ReadConsole(handle, buf, curlx_uztoul(count), &rcount, NULL); |
| 169 | } |
| 170 | else { |
| 171 | success = ReadFile(handle, buf, curlx_uztoul(count), &rcount, NULL); |
| 172 | } |
| 173 | if(success) { |
| 174 | return rcount; |
| 175 | } |
| 176 | |
| 177 | errno = GetLastError(); |
| 178 | return -1; |
| 179 | } |
| 180 | #undef read |
| 181 | #define read(a,b,c) read_wincon(a,b,c) |
| 182 | |
| 183 | /* |
| 184 | * write-wrapper to support writing to stdout and stderr on Windows. |
| 185 | */ |
| 186 | static ssize_t write_wincon(int fd, const void *buf, size_t count) |
| 187 | { |
| 188 | HANDLE handle = NULL; |
| 189 | DWORD mode, wcount = 0; |
| 190 | BOOL success; |
| 191 | |
| 192 | if(fd == fileno(stdout)) { |
| 193 | handle = GetStdHandle(STD_OUTPUT_HANDLE); |
| 194 | } |
| 195 | else if(fd == fileno(stderr)) { |
| 196 | handle = GetStdHandle(STD_ERROR_HANDLE); |
| 197 | } |
| 198 | else { |
| 199 | return write(fd, buf, count); |
| 200 | } |
| 201 | |
| 202 | if(GetConsoleMode(handle, &mode)) { |
| 203 | success = WriteConsole(handle, buf, curlx_uztoul(count), &wcount, NULL); |
| 204 | } |
| 205 | else { |
| 206 | success = WriteFile(handle, buf, curlx_uztoul(count), &wcount, NULL); |
| 207 | } |
| 208 | if(success) { |
| 209 | return wcount; |
| 210 | } |
| 211 | |
| 212 | errno = GetLastError(); |
| 213 | return -1; |
| 214 | } |
| 215 | #undef write |
| 216 | #define write(a,b,c) write_wincon(a,b,c) |
| 217 | #endif |
| 218 | |
| 219 | /* |
| 220 | * fullread is a wrapper around the read() function. This will repeat the call |
| 221 | * to read() until it actually has read the complete number of bytes indicated |
| 222 | * in nbytes or it fails with a condition that cannot be handled with a simple |
| 223 | * retry of the read call. |
| 224 | */ |
| 225 | |
| 226 | static ssize_t fullread(int filedes, void *buffer, size_t nbytes) |
| 227 | { |
| 228 | int error; |
| 229 | ssize_t nread = 0; |
| 230 | |
| 231 | do { |
| 232 | ssize_t rc = read(filedes, |
| 233 | (unsigned char *)buffer + nread, nbytes - nread); |
| 234 | |
| 235 | if(got_exit_signal) { |
| 236 | logmsg("signalled to die" ); |
| 237 | return -1; |
| 238 | } |
| 239 | |
| 240 | if(rc < 0) { |
| 241 | error = errno; |
| 242 | if((error == EINTR) || (error == EAGAIN)) |
| 243 | continue; |
| 244 | logmsg("reading from file descriptor: %d," , filedes); |
| 245 | logmsg("unrecoverable read() failure: (%d) %s" , |
| 246 | error, strerror(error)); |
| 247 | return -1; |
| 248 | } |
| 249 | |
| 250 | if(rc == 0) { |
| 251 | logmsg("got 0 reading from stdin" ); |
| 252 | return 0; |
| 253 | } |
| 254 | |
| 255 | nread += rc; |
| 256 | |
| 257 | } while((size_t)nread < nbytes); |
| 258 | |
| 259 | if(verbose) |
| 260 | logmsg("read %zd bytes" , nread); |
| 261 | |
| 262 | return nread; |
| 263 | } |
| 264 | |
| 265 | /* |
| 266 | * fullwrite is a wrapper around the write() function. This will repeat the |
| 267 | * call to write() until it actually has written the complete number of bytes |
| 268 | * indicated in nbytes or it fails with a condition that cannot be handled |
| 269 | * with a simple retry of the write call. |
| 270 | */ |
| 271 | |
| 272 | static ssize_t fullwrite(int filedes, const void *buffer, size_t nbytes) |
| 273 | { |
| 274 | int error; |
| 275 | ssize_t nwrite = 0; |
| 276 | |
| 277 | do { |
| 278 | ssize_t wc = write(filedes, (const unsigned char *)buffer + nwrite, |
| 279 | nbytes - nwrite); |
| 280 | |
| 281 | if(got_exit_signal) { |
| 282 | logmsg("signalled to die" ); |
| 283 | return -1; |
| 284 | } |
| 285 | |
| 286 | if(wc < 0) { |
| 287 | error = errno; |
| 288 | if((error == EINTR) || (error == EAGAIN)) |
| 289 | continue; |
| 290 | logmsg("writing to file descriptor: %d," , filedes); |
| 291 | logmsg("unrecoverable write() failure: (%d) %s" , |
| 292 | error, strerror(error)); |
| 293 | return -1; |
| 294 | } |
| 295 | |
| 296 | if(wc == 0) { |
| 297 | logmsg("put 0 writing to stdout" ); |
| 298 | return 0; |
| 299 | } |
| 300 | |
| 301 | nwrite += wc; |
| 302 | |
| 303 | } while((size_t)nwrite < nbytes); |
| 304 | |
| 305 | if(verbose) |
| 306 | logmsg("wrote %zd bytes" , nwrite); |
| 307 | |
| 308 | return nwrite; |
| 309 | } |
| 310 | |
| 311 | /* |
| 312 | * read_stdin tries to read from stdin nbytes into the given buffer. This is a |
| 313 | * blocking function that will only return TRUE when nbytes have actually been |
| 314 | * read or FALSE when an unrecoverable error has been detected. Failure of this |
| 315 | * function is an indication that the sockfilt process should terminate. |
| 316 | */ |
| 317 | |
| 318 | static bool read_stdin(void *buffer, size_t nbytes) |
| 319 | { |
| 320 | ssize_t nread = fullread(fileno(stdin), buffer, nbytes); |
| 321 | if(nread != (ssize_t)nbytes) { |
| 322 | logmsg("exiting..." ); |
| 323 | return FALSE; |
| 324 | } |
| 325 | return TRUE; |
| 326 | } |
| 327 | |
| 328 | /* |
| 329 | * write_stdout tries to write to stdio nbytes from the given buffer. This is a |
| 330 | * blocking function that will only return TRUE when nbytes have actually been |
| 331 | * written or FALSE when an unrecoverable error has been detected. Failure of |
| 332 | * this function is an indication that the sockfilt process should terminate. |
| 333 | */ |
| 334 | |
| 335 | static bool write_stdout(const void *buffer, size_t nbytes) |
| 336 | { |
| 337 | ssize_t nwrite = fullwrite(fileno(stdout), buffer, nbytes); |
| 338 | if(nwrite != (ssize_t)nbytes) { |
| 339 | logmsg("exiting..." ); |
| 340 | return FALSE; |
| 341 | } |
| 342 | return TRUE; |
| 343 | } |
| 344 | |
| 345 | static void lograw(unsigned char *buffer, ssize_t len) |
| 346 | { |
| 347 | char data[120]; |
| 348 | ssize_t i; |
| 349 | unsigned char *ptr = buffer; |
| 350 | char *optr = data; |
| 351 | ssize_t width = 0; |
| 352 | int left = sizeof(data); |
| 353 | |
| 354 | for(i = 0; i<len; i++) { |
| 355 | switch(ptr[i]) { |
| 356 | case '\n': |
| 357 | msnprintf(optr, left, "\\n" ); |
| 358 | width += 2; |
| 359 | optr += 2; |
| 360 | left -= 2; |
| 361 | break; |
| 362 | case '\r': |
| 363 | msnprintf(optr, left, "\\r" ); |
| 364 | width += 2; |
| 365 | optr += 2; |
| 366 | left -= 2; |
| 367 | break; |
| 368 | default: |
| 369 | msnprintf(optr, left, "%c" , (ISGRAPH(ptr[i]) || |
| 370 | ptr[i] == 0x20) ?ptr[i]:'.'); |
| 371 | width++; |
| 372 | optr++; |
| 373 | left--; |
| 374 | break; |
| 375 | } |
| 376 | |
| 377 | if(width>60) { |
| 378 | logmsg("'%s'" , data); |
| 379 | width = 0; |
| 380 | optr = data; |
| 381 | left = sizeof(data); |
| 382 | } |
| 383 | } |
| 384 | if(width) |
| 385 | logmsg("'%s'" , data); |
| 386 | } |
| 387 | |
| 388 | #ifdef USE_WINSOCK |
| 389 | /* |
| 390 | * WinSock select() does not support standard file descriptors, |
| 391 | * it can only check SOCKETs. The following function is an attempt |
| 392 | * to re-create a select() function with support for other handle types. |
| 393 | * |
| 394 | * select() function with support for WINSOCK2 sockets and all |
| 395 | * other handle types supported by WaitForMultipleObjectsEx() as |
| 396 | * well as disk files, anonymous and names pipes, and character input. |
| 397 | * |
| 398 | * https://msdn.microsoft.com/en-us/library/windows/desktop/ms687028.aspx |
| 399 | * https://msdn.microsoft.com/en-us/library/windows/desktop/ms741572.aspx |
| 400 | */ |
| 401 | struct select_ws_wait_data { |
| 402 | HANDLE handle; /* actual handle to wait for during select */ |
| 403 | HANDLE signal; /* internal event to signal handle trigger */ |
| 404 | HANDLE abort; /* internal event to abort waiting thread */ |
| 405 | HANDLE mutex; /* mutex to prevent event race-condition */ |
| 406 | }; |
| 407 | static DWORD WINAPI select_ws_wait_thread(LPVOID lpParameter) |
| 408 | { |
| 409 | struct select_ws_wait_data *data; |
| 410 | HANDLE mutex, signal, handle, handles[2]; |
| 411 | INPUT_RECORD inputrecord; |
| 412 | LARGE_INTEGER size, pos; |
| 413 | DWORD type, length, ret; |
| 414 | |
| 415 | /* retrieve handles from internal structure */ |
| 416 | data = (struct select_ws_wait_data *) lpParameter; |
| 417 | if(data) { |
| 418 | handle = data->handle; |
| 419 | handles[0] = data->abort; |
| 420 | handles[1] = handle; |
| 421 | signal = data->signal; |
| 422 | mutex = data->mutex; |
| 423 | free(data); |
| 424 | } |
| 425 | else |
| 426 | return (DWORD)-1; |
| 427 | |
| 428 | /* retrieve the type of file to wait on */ |
| 429 | type = GetFileType(handle); |
| 430 | switch(type) { |
| 431 | case FILE_TYPE_DISK: |
| 432 | /* The handle represents a file on disk, this means: |
| 433 | * - WaitForMultipleObjectsEx will always be signalled for it. |
| 434 | * - comparison of current position in file and total size of |
| 435 | * the file can be used to check if we reached the end yet. |
| 436 | * |
| 437 | * Approach: Loop till either the internal event is signalled |
| 438 | * or if the end of the file has already been reached. |
| 439 | */ |
| 440 | while(WaitForMultipleObjectsEx(1, handles, FALSE, 0, FALSE) |
| 441 | == WAIT_TIMEOUT) { |
| 442 | ret = WaitForSingleObjectEx(mutex, 0, FALSE); |
| 443 | if(ret == WAIT_OBJECT_0) { |
| 444 | /* get total size of file */ |
| 445 | length = 0; |
| 446 | size.QuadPart = 0; |
| 447 | size.LowPart = GetFileSize(handle, &length); |
| 448 | if((size.LowPart != INVALID_FILE_SIZE) || |
| 449 | (GetLastError() == NO_ERROR)) { |
| 450 | size.HighPart = length; |
| 451 | /* get the current position within the file */ |
| 452 | pos.QuadPart = 0; |
| 453 | pos.LowPart = SetFilePointer(handle, 0, &pos.HighPart, |
| 454 | FILE_CURRENT); |
| 455 | if((pos.LowPart != INVALID_SET_FILE_POINTER) || |
| 456 | (GetLastError() == NO_ERROR)) { |
| 457 | /* compare position with size, abort if not equal */ |
| 458 | if(size.QuadPart == pos.QuadPart) { |
| 459 | /* sleep and continue waiting */ |
| 460 | SleepEx(0, FALSE); |
| 461 | ReleaseMutex(mutex); |
| 462 | continue; |
| 463 | } |
| 464 | } |
| 465 | } |
| 466 | /* there is some data available, stop waiting */ |
| 467 | logmsg("[select_ws_wait_thread] data available, DISK: %p" , handle); |
| 468 | SetEvent(signal); |
| 469 | ReleaseMutex(mutex); |
| 470 | break; |
| 471 | } |
| 472 | else if(ret == WAIT_ABANDONED) { |
| 473 | /* we are not allowed to process this event, because select_ws |
| 474 | is post-processing the signalled events and we must exit. */ |
| 475 | break; |
| 476 | } |
| 477 | } |
| 478 | break; |
| 479 | |
| 480 | case FILE_TYPE_CHAR: |
| 481 | /* The handle represents a character input, this means: |
| 482 | * - WaitForMultipleObjectsEx will be signalled on any kind of input, |
| 483 | * including mouse and window size events we do not care about. |
| 484 | * |
| 485 | * Approach: Loop till either the internal event is signalled |
| 486 | * or we get signalled for an actual key-event. |
| 487 | */ |
| 488 | while(WaitForMultipleObjectsEx(2, handles, FALSE, INFINITE, FALSE) |
| 489 | == WAIT_OBJECT_0 + 1) { |
| 490 | ret = WaitForSingleObjectEx(mutex, 0, FALSE); |
| 491 | if(ret == WAIT_OBJECT_0) { |
| 492 | /* check if this is an actual console handle */ |
| 493 | if(GetConsoleMode(handle, &ret)) { |
| 494 | /* retrieve an event from the console buffer */ |
| 495 | length = 0; |
| 496 | if(PeekConsoleInput(handle, &inputrecord, 1, &length)) { |
| 497 | /* check if the event is not an actual key-event */ |
| 498 | if(length == 1 && inputrecord.EventType != KEY_EVENT) { |
| 499 | /* purge the non-key-event and continue waiting */ |
| 500 | ReadConsoleInput(handle, &inputrecord, 1, &length); |
| 501 | ReleaseMutex(mutex); |
| 502 | continue; |
| 503 | } |
| 504 | } |
| 505 | } |
| 506 | /* there is some data available, stop waiting */ |
| 507 | logmsg("[select_ws_wait_thread] data available, CHAR: %p" , handle); |
| 508 | SetEvent(signal); |
| 509 | ReleaseMutex(mutex); |
| 510 | break; |
| 511 | } |
| 512 | else if(ret == WAIT_ABANDONED) { |
| 513 | /* we are not allowed to process this event, because select_ws |
| 514 | is post-processing the signalled events and we must exit. */ |
| 515 | break; |
| 516 | } |
| 517 | } |
| 518 | break; |
| 519 | |
| 520 | case FILE_TYPE_PIPE: |
| 521 | /* The handle represents an anonymous or named pipe, this means: |
| 522 | * - WaitForMultipleObjectsEx will always be signalled for it. |
| 523 | * - peek into the pipe and retrieve the amount of data available. |
| 524 | * |
| 525 | * Approach: Loop till either the internal event is signalled |
| 526 | * or there is data in the pipe available for reading. |
| 527 | */ |
| 528 | while(WaitForMultipleObjectsEx(1, handles, FALSE, 0, FALSE) |
| 529 | == WAIT_TIMEOUT) { |
| 530 | ret = WaitForSingleObjectEx(mutex, 0, FALSE); |
| 531 | if(ret == WAIT_OBJECT_0) { |
| 532 | /* peek into the pipe and retrieve the amount of data available */ |
| 533 | length = 0; |
| 534 | if(PeekNamedPipe(handle, NULL, 0, NULL, &length, NULL)) { |
| 535 | /* if there is no data available, sleep and continue waiting */ |
| 536 | if(length == 0) { |
| 537 | SleepEx(0, FALSE); |
| 538 | ReleaseMutex(mutex); |
| 539 | continue; |
| 540 | } |
| 541 | else { |
| 542 | logmsg("[select_ws_wait_thread] PeekNamedPipe len: %d" , length); |
| 543 | } |
| 544 | } |
| 545 | else { |
| 546 | /* if the pipe has NOT been closed, sleep and continue waiting */ |
| 547 | ret = GetLastError(); |
| 548 | if(ret != ERROR_BROKEN_PIPE) { |
| 549 | logmsg("[select_ws_wait_thread] PeekNamedPipe error: %d" , ret); |
| 550 | SleepEx(0, FALSE); |
| 551 | ReleaseMutex(mutex); |
| 552 | continue; |
| 553 | } |
| 554 | else { |
| 555 | logmsg("[select_ws_wait_thread] pipe closed, PIPE: %p" , handle); |
| 556 | } |
| 557 | } |
| 558 | /* there is some data available, stop waiting */ |
| 559 | logmsg("[select_ws_wait_thread] data available, PIPE: %p" , handle); |
| 560 | SetEvent(signal); |
| 561 | ReleaseMutex(mutex); |
| 562 | break; |
| 563 | } |
| 564 | else if(ret == WAIT_ABANDONED) { |
| 565 | /* we are not allowed to process this event, because select_ws |
| 566 | is post-processing the signalled events and we must exit. */ |
| 567 | break; |
| 568 | } |
| 569 | } |
| 570 | break; |
| 571 | |
| 572 | default: |
| 573 | /* The handle has an unknown type, try to wait on it */ |
| 574 | if(WaitForMultipleObjectsEx(2, handles, FALSE, INFINITE, FALSE) |
| 575 | == WAIT_OBJECT_0 + 1) { |
| 576 | if(WaitForSingleObjectEx(mutex, 0, FALSE) == WAIT_OBJECT_0) { |
| 577 | logmsg("[select_ws_wait_thread] data available, HANDLE: %p" , handle); |
| 578 | SetEvent(signal); |
| 579 | ReleaseMutex(mutex); |
| 580 | } |
| 581 | } |
| 582 | break; |
| 583 | } |
| 584 | |
| 585 | return 0; |
| 586 | } |
| 587 | static HANDLE select_ws_wait(HANDLE handle, HANDLE signal, |
| 588 | HANDLE abort, HANDLE mutex) |
| 589 | { |
| 590 | struct select_ws_wait_data *data; |
| 591 | HANDLE thread = NULL; |
| 592 | |
| 593 | /* allocate internal waiting data structure */ |
| 594 | data = malloc(sizeof(struct select_ws_wait_data)); |
| 595 | if(data) { |
| 596 | data->handle = handle; |
| 597 | data->signal = signal; |
| 598 | data->abort = abort; |
| 599 | data->mutex = mutex; |
| 600 | |
| 601 | /* launch waiting thread */ |
| 602 | thread = CreateThread(NULL, 0, |
| 603 | &select_ws_wait_thread, |
| 604 | data, 0, NULL); |
| 605 | |
| 606 | /* free data if thread failed to launch */ |
| 607 | if(!thread) { |
| 608 | free(data); |
| 609 | } |
| 610 | } |
| 611 | |
| 612 | return thread; |
| 613 | } |
| 614 | struct select_ws_data { |
| 615 | int fd; /* provided file descriptor (indexed by nfd) */ |
| 616 | long wsastate; /* internal pre-select state (indexed by nfd) */ |
| 617 | curl_socket_t wsasock; /* internal socket handle (indexed by nws) */ |
| 618 | WSAEVENT wsaevent; /* internal select event (indexed by nws) */ |
| 619 | HANDLE signal; /* internal thread signal (indexed by nth) */ |
| 620 | HANDLE thread; /* internal thread handle (indexed by nth) */ |
| 621 | }; |
| 622 | static int select_ws(int nfds, fd_set *readfds, fd_set *writefds, |
| 623 | fd_set *exceptfds, struct timeval *tv) |
| 624 | { |
| 625 | HANDLE abort, mutex, signal, handle, *handles; |
| 626 | DWORD timeout_ms, wait, nfd, nth, nws, i; |
| 627 | fd_set readsock, writesock, exceptsock; |
| 628 | struct select_ws_data *data; |
| 629 | WSANETWORKEVENTS wsaevents; |
| 630 | curl_socket_t wsasock; |
| 631 | int error, ret, fd; |
| 632 | WSAEVENT wsaevent; |
| 633 | |
| 634 | /* check if the input value is valid */ |
| 635 | if(nfds < 0) { |
| 636 | errno = EINVAL; |
| 637 | return -1; |
| 638 | } |
| 639 | |
| 640 | /* convert struct timeval to milliseconds */ |
| 641 | if(tv) { |
| 642 | timeout_ms = (tv->tv_sec*1000) + (DWORD)(((double)tv->tv_usec)/1000.0); |
| 643 | } |
| 644 | else { |
| 645 | timeout_ms = INFINITE; |
| 646 | } |
| 647 | |
| 648 | /* check if we got descriptors, sleep in case we got none */ |
| 649 | if(!nfds) { |
| 650 | SleepEx(timeout_ms, FALSE); |
| 651 | return 0; |
| 652 | } |
| 653 | |
| 654 | /* create internal event to abort waiting threads */ |
| 655 | abort = CreateEvent(NULL, TRUE, FALSE, NULL); |
| 656 | if(!abort) { |
| 657 | errno = ENOMEM; |
| 658 | return -1; |
| 659 | } |
| 660 | |
| 661 | /* create internal mutex to lock event handling in threads */ |
| 662 | mutex = CreateMutex(NULL, FALSE, NULL); |
| 663 | if(!mutex) { |
| 664 | CloseHandle(abort); |
| 665 | errno = ENOMEM; |
| 666 | return -1; |
| 667 | } |
| 668 | |
| 669 | /* allocate internal array for the internal data */ |
| 670 | data = calloc(nfds, sizeof(struct select_ws_data)); |
| 671 | if(!data) { |
| 672 | CloseHandle(abort); |
| 673 | CloseHandle(mutex); |
| 674 | errno = ENOMEM; |
| 675 | return -1; |
| 676 | } |
| 677 | |
| 678 | /* allocate internal array for the internal event handles */ |
| 679 | handles = calloc(nfds + 1, sizeof(HANDLE)); |
| 680 | if(!handles) { |
| 681 | CloseHandle(abort); |
| 682 | CloseHandle(mutex); |
| 683 | free(data); |
| 684 | errno = ENOMEM; |
| 685 | return -1; |
| 686 | } |
| 687 | |
| 688 | /* loop over the handles in the input descriptor sets */ |
| 689 | nfd = 0; /* number of handled file descriptors */ |
| 690 | nth = 0; /* number of internal waiting threads */ |
| 691 | nws = 0; /* number of handled WINSOCK sockets */ |
| 692 | for(fd = 0; fd < nfds; fd++) { |
| 693 | wsasock = curlx_sitosk(fd); |
| 694 | wsaevents.lNetworkEvents = 0; |
| 695 | handles[nfd] = 0; |
| 696 | |
| 697 | FD_ZERO(&readsock); |
| 698 | FD_ZERO(&writesock); |
| 699 | FD_ZERO(&exceptsock); |
| 700 | |
| 701 | if(FD_ISSET(wsasock, readfds)) { |
| 702 | FD_SET(wsasock, &readsock); |
| 703 | wsaevents.lNetworkEvents |= FD_READ|FD_ACCEPT|FD_CLOSE; |
| 704 | } |
| 705 | |
| 706 | if(FD_ISSET(wsasock, writefds)) { |
| 707 | FD_SET(wsasock, &writesock); |
| 708 | wsaevents.lNetworkEvents |= FD_WRITE|FD_CONNECT|FD_CLOSE; |
| 709 | } |
| 710 | |
| 711 | if(FD_ISSET(wsasock, exceptfds)) { |
| 712 | FD_SET(wsasock, &exceptsock); |
| 713 | wsaevents.lNetworkEvents |= FD_OOB; |
| 714 | } |
| 715 | |
| 716 | /* only wait for events for which we actually care */ |
| 717 | if(wsaevents.lNetworkEvents) { |
| 718 | data[nfd].fd = fd; |
| 719 | if(fd == fileno(stdin)) { |
| 720 | signal = CreateEvent(NULL, TRUE, FALSE, NULL); |
| 721 | if(signal) { |
| 722 | handle = GetStdHandle(STD_INPUT_HANDLE); |
| 723 | handle = select_ws_wait(handle, signal, abort, mutex); |
| 724 | if(handle) { |
| 725 | handles[nfd] = signal; |
| 726 | data[nth].signal = signal; |
| 727 | data[nth].thread = handle; |
| 728 | nfd++; |
| 729 | nth++; |
| 730 | } |
| 731 | else { |
| 732 | CloseHandle(signal); |
| 733 | } |
| 734 | } |
| 735 | } |
| 736 | else if(fd == fileno(stdout)) { |
| 737 | handles[nfd] = GetStdHandle(STD_OUTPUT_HANDLE); |
| 738 | nfd++; |
| 739 | } |
| 740 | else if(fd == fileno(stderr)) { |
| 741 | handles[nfd] = GetStdHandle(STD_ERROR_HANDLE); |
| 742 | nfd++; |
| 743 | } |
| 744 | else { |
| 745 | wsaevent = WSACreateEvent(); |
| 746 | if(wsaevent != WSA_INVALID_EVENT) { |
| 747 | if(wsaevents.lNetworkEvents & FD_WRITE) { |
| 748 | send(wsasock, NULL, 0, 0); /* reset FD_WRITE */ |
| 749 | } |
| 750 | error = WSAEventSelect(wsasock, wsaevent, wsaevents.lNetworkEvents); |
| 751 | if(error != SOCKET_ERROR) { |
| 752 | handles[nfd] = (HANDLE)wsaevent; |
| 753 | data[nws].wsasock = wsasock; |
| 754 | data[nws].wsaevent = wsaevent; |
| 755 | data[nfd].wsastate = 0; |
| 756 | tv->tv_sec = 0; |
| 757 | tv->tv_usec = 0; |
| 758 | /* check if the socket is already ready */ |
| 759 | if(select(fd + 1, &readsock, &writesock, &exceptsock, tv) == 1) { |
| 760 | logmsg("[select_ws] socket %d is ready" , fd); |
| 761 | WSASetEvent(wsaevent); |
| 762 | if(FD_ISSET(wsasock, &readsock)) |
| 763 | data[nfd].wsastate |= FD_READ; |
| 764 | if(FD_ISSET(wsasock, &writesock)) |
| 765 | data[nfd].wsastate |= FD_WRITE; |
| 766 | if(FD_ISSET(wsasock, &exceptsock)) |
| 767 | data[nfd].wsastate |= FD_OOB; |
| 768 | } |
| 769 | nfd++; |
| 770 | nws++; |
| 771 | } |
| 772 | else { |
| 773 | WSACloseEvent(wsaevent); |
| 774 | signal = CreateEvent(NULL, TRUE, FALSE, NULL); |
| 775 | if(signal) { |
| 776 | handle = (HANDLE)wsasock; |
| 777 | handle = select_ws_wait(handle, signal, abort, mutex); |
| 778 | if(handle) { |
| 779 | handles[nfd] = signal; |
| 780 | data[nth].signal = signal; |
| 781 | data[nth].thread = handle; |
| 782 | nfd++; |
| 783 | nth++; |
| 784 | } |
| 785 | else { |
| 786 | CloseHandle(signal); |
| 787 | } |
| 788 | } |
| 789 | } |
| 790 | } |
| 791 | } |
| 792 | } |
| 793 | } |
| 794 | |
| 795 | /* wait on the number of handles */ |
| 796 | wait = nfd; |
| 797 | |
| 798 | /* make sure we stop waiting on exit signal event */ |
| 799 | if(exit_event) { |
| 800 | /* we allocated handles nfds + 1 for this */ |
| 801 | handles[nfd] = exit_event; |
| 802 | wait += 1; |
| 803 | } |
| 804 | |
| 805 | /* wait for one of the internal handles to trigger */ |
| 806 | wait = WaitForMultipleObjectsEx(wait, handles, FALSE, timeout_ms, FALSE); |
| 807 | |
| 808 | /* wait for internal mutex to lock event handling in threads */ |
| 809 | WaitForSingleObjectEx(mutex, INFINITE, FALSE); |
| 810 | |
| 811 | /* loop over the internal handles returned in the descriptors */ |
| 812 | ret = 0; /* number of ready file descriptors */ |
| 813 | for(i = 0; i < nfd; i++) { |
| 814 | fd = data[i].fd; |
| 815 | handle = handles[i]; |
| 816 | wsasock = curlx_sitosk(fd); |
| 817 | |
| 818 | /* check if the current internal handle was triggered */ |
| 819 | if(wait != WAIT_FAILED && (wait - WAIT_OBJECT_0) <= i && |
| 820 | WaitForSingleObjectEx(handle, 0, FALSE) == WAIT_OBJECT_0) { |
| 821 | /* first handle stdin, stdout and stderr */ |
| 822 | if(fd == fileno(stdin)) { |
| 823 | /* stdin is never ready for write or exceptional */ |
| 824 | FD_CLR(wsasock, writefds); |
| 825 | FD_CLR(wsasock, exceptfds); |
| 826 | } |
| 827 | else if(fd == fileno(stdout) || fd == fileno(stderr)) { |
| 828 | /* stdout and stderr are never ready for read or exceptional */ |
| 829 | FD_CLR(wsasock, readfds); |
| 830 | FD_CLR(wsasock, exceptfds); |
| 831 | } |
| 832 | else { |
| 833 | /* try to handle the event with the WINSOCK2 functions */ |
| 834 | wsaevents.lNetworkEvents = 0; |
| 835 | error = WSAEnumNetworkEvents(wsasock, handle, &wsaevents); |
| 836 | if(error != SOCKET_ERROR) { |
| 837 | /* merge result from pre-check using select */ |
| 838 | wsaevents.lNetworkEvents |= data[i].wsastate; |
| 839 | |
| 840 | /* remove from descriptor set if not ready for read/accept/close */ |
| 841 | if(!(wsaevents.lNetworkEvents & (FD_READ|FD_ACCEPT|FD_CLOSE))) |
| 842 | FD_CLR(wsasock, readfds); |
| 843 | |
| 844 | /* remove from descriptor set if not ready for write/connect */ |
| 845 | if(!(wsaevents.lNetworkEvents & (FD_WRITE|FD_CONNECT|FD_CLOSE))) |
| 846 | FD_CLR(wsasock, writefds); |
| 847 | |
| 848 | /* remove from descriptor set if not exceptional */ |
| 849 | if(!(wsaevents.lNetworkEvents & FD_OOB)) |
| 850 | FD_CLR(wsasock, exceptfds); |
| 851 | } |
| 852 | } |
| 853 | |
| 854 | /* check if the event has not been filtered using specific tests */ |
| 855 | if(FD_ISSET(wsasock, readfds) || FD_ISSET(wsasock, writefds) || |
| 856 | FD_ISSET(wsasock, exceptfds)) { |
| 857 | ret++; |
| 858 | } |
| 859 | } |
| 860 | else { |
| 861 | /* remove from all descriptor sets since this handle did not trigger */ |
| 862 | FD_CLR(wsasock, readfds); |
| 863 | FD_CLR(wsasock, writefds); |
| 864 | FD_CLR(wsasock, exceptfds); |
| 865 | } |
| 866 | } |
| 867 | |
| 868 | /* signal the event handle for the other waiting threads */ |
| 869 | SetEvent(abort); |
| 870 | |
| 871 | for(fd = 0; fd < nfds; fd++) { |
| 872 | if(FD_ISSET(fd, readfds)) |
| 873 | logmsg("[select_ws] %d is readable" , fd); |
| 874 | if(FD_ISSET(fd, writefds)) |
| 875 | logmsg("[select_ws] %d is writable" , fd); |
| 876 | if(FD_ISSET(fd, exceptfds)) |
| 877 | logmsg("[select_ws] %d is exceptional" , fd); |
| 878 | } |
| 879 | |
| 880 | for(i = 0; i < nws; i++) { |
| 881 | WSAEventSelect(data[i].wsasock, NULL, 0); |
| 882 | WSACloseEvent(data[i].wsaevent); |
| 883 | } |
| 884 | |
| 885 | for(i = 0; i < nth; i++) { |
| 886 | WaitForSingleObjectEx(data[i].thread, INFINITE, FALSE); |
| 887 | CloseHandle(data[i].thread); |
| 888 | CloseHandle(data[i].signal); |
| 889 | } |
| 890 | |
| 891 | CloseHandle(abort); |
| 892 | CloseHandle(mutex); |
| 893 | |
| 894 | free(handles); |
| 895 | free(data); |
| 896 | |
| 897 | return ret; |
| 898 | } |
| 899 | #define select(a,b,c,d,e) select_ws(a,b,c,d,e) |
| 900 | #endif /* USE_WINSOCK */ |
| 901 | |
| 902 | /* |
| 903 | sockfdp is a pointer to an established stream or CURL_SOCKET_BAD |
| 904 | |
| 905 | if sockfd is CURL_SOCKET_BAD, listendfd is a listening socket we must |
| 906 | accept() |
| 907 | */ |
| 908 | static bool juggle(curl_socket_t *sockfdp, |
| 909 | curl_socket_t listenfd, |
| 910 | enum sockmode *mode) |
| 911 | { |
| 912 | struct timeval timeout; |
| 913 | fd_set fds_read; |
| 914 | fd_set fds_write; |
| 915 | fd_set fds_err; |
| 916 | curl_socket_t sockfd = CURL_SOCKET_BAD; |
| 917 | int maxfd = -99; |
| 918 | ssize_t rc; |
| 919 | int error = 0; |
| 920 | |
| 921 | /* 'buffer' is this excessively large only to be able to support things like |
| 922 | test 1003 which tests exceedingly large server response lines */ |
| 923 | unsigned char buffer[17010]; |
| 924 | char data[16]; |
| 925 | |
| 926 | if(got_exit_signal) { |
| 927 | logmsg("signalled to die, exiting..." ); |
| 928 | return FALSE; |
| 929 | } |
| 930 | |
| 931 | #ifdef HAVE_GETPPID |
| 932 | /* As a last resort, quit if sockfilt process becomes orphan. Just in case |
| 933 | parent ftpserver process has died without killing its sockfilt children */ |
| 934 | if(getppid() <= 1) { |
| 935 | logmsg("process becomes orphan, exiting" ); |
| 936 | return FALSE; |
| 937 | } |
| 938 | #endif |
| 939 | |
| 940 | timeout.tv_sec = 120; |
| 941 | timeout.tv_usec = 0; |
| 942 | |
| 943 | FD_ZERO(&fds_read); |
| 944 | FD_ZERO(&fds_write); |
| 945 | FD_ZERO(&fds_err); |
| 946 | |
| 947 | FD_SET((curl_socket_t)fileno(stdin), &fds_read); |
| 948 | |
| 949 | switch(*mode) { |
| 950 | |
| 951 | case PASSIVE_LISTEN: |
| 952 | |
| 953 | /* server mode */ |
| 954 | sockfd = listenfd; |
| 955 | /* there's always a socket to wait for */ |
| 956 | FD_SET(sockfd, &fds_read); |
| 957 | maxfd = (int)sockfd; |
| 958 | break; |
| 959 | |
| 960 | case PASSIVE_CONNECT: |
| 961 | |
| 962 | sockfd = *sockfdp; |
| 963 | if(CURL_SOCKET_BAD == sockfd) { |
| 964 | /* eeek, we are supposedly connected and then this cannot be -1 ! */ |
| 965 | logmsg("socket is -1! on %s:%d" , __FILE__, __LINE__); |
| 966 | maxfd = 0; /* stdin */ |
| 967 | } |
| 968 | else { |
| 969 | /* there's always a socket to wait for */ |
| 970 | FD_SET(sockfd, &fds_read); |
| 971 | maxfd = (int)sockfd; |
| 972 | } |
| 973 | break; |
| 974 | |
| 975 | case ACTIVE: |
| 976 | |
| 977 | sockfd = *sockfdp; |
| 978 | /* sockfd turns CURL_SOCKET_BAD when our connection has been closed */ |
| 979 | if(CURL_SOCKET_BAD != sockfd) { |
| 980 | FD_SET(sockfd, &fds_read); |
| 981 | maxfd = (int)sockfd; |
| 982 | } |
| 983 | else { |
| 984 | logmsg("No socket to read on" ); |
| 985 | maxfd = 0; |
| 986 | } |
| 987 | break; |
| 988 | |
| 989 | case ACTIVE_DISCONNECT: |
| 990 | |
| 991 | logmsg("disconnected, no socket to read on" ); |
| 992 | maxfd = 0; |
| 993 | sockfd = CURL_SOCKET_BAD; |
| 994 | break; |
| 995 | |
| 996 | } /* switch(*mode) */ |
| 997 | |
| 998 | |
| 999 | do { |
| 1000 | |
| 1001 | /* select() blocking behavior call on blocking descriptors please */ |
| 1002 | |
| 1003 | rc = select(maxfd + 1, &fds_read, &fds_write, &fds_err, &timeout); |
| 1004 | |
| 1005 | if(got_exit_signal) { |
| 1006 | logmsg("signalled to die, exiting..." ); |
| 1007 | return FALSE; |
| 1008 | } |
| 1009 | |
| 1010 | } while((rc == -1) && ((error = errno) == EINTR)); |
| 1011 | |
| 1012 | if(rc < 0) { |
| 1013 | logmsg("select() failed with error: (%d) %s" , |
| 1014 | error, strerror(error)); |
| 1015 | return FALSE; |
| 1016 | } |
| 1017 | |
| 1018 | if(rc == 0) |
| 1019 | /* timeout */ |
| 1020 | return TRUE; |
| 1021 | |
| 1022 | |
| 1023 | if(FD_ISSET(fileno(stdin), &fds_read)) { |
| 1024 | ssize_t buffer_len; |
| 1025 | /* read from stdin, commands/data to be dealt with and possibly passed on |
| 1026 | to the socket |
| 1027 | |
| 1028 | protocol: |
| 1029 | |
| 1030 | 4 letter command + LF [mandatory] |
| 1031 | |
| 1032 | 4-digit hexadecimal data length + LF [if the command takes data] |
| 1033 | data [the data being as long as set above] |
| 1034 | |
| 1035 | Commands: |
| 1036 | |
| 1037 | DATA - plain pass-through data |
| 1038 | */ |
| 1039 | |
| 1040 | if(!read_stdin(buffer, 5)) |
| 1041 | return FALSE; |
| 1042 | |
| 1043 | logmsg("Received %c%c%c%c (on stdin)" , |
| 1044 | buffer[0], buffer[1], buffer[2], buffer[3]); |
| 1045 | |
| 1046 | if(!memcmp("PING" , buffer, 4)) { |
| 1047 | /* send reply on stdout, just proving we are alive */ |
| 1048 | if(!write_stdout("PONG\n" , 5)) |
| 1049 | return FALSE; |
| 1050 | } |
| 1051 | |
| 1052 | else if(!memcmp("PORT" , buffer, 4)) { |
| 1053 | /* Question asking us what PORT number we are listening to. |
| 1054 | Replies to PORT with "IPv[num]/[port]" */ |
| 1055 | msnprintf((char *)buffer, sizeof(buffer), "%s/%hu\n" , ipv_inuse, port); |
| 1056 | buffer_len = (ssize_t)strlen((char *)buffer); |
| 1057 | msnprintf(data, sizeof(data), "PORT\n%04zx\n" , buffer_len); |
| 1058 | if(!write_stdout(data, 10)) |
| 1059 | return FALSE; |
| 1060 | if(!write_stdout(buffer, buffer_len)) |
| 1061 | return FALSE; |
| 1062 | } |
| 1063 | else if(!memcmp("QUIT" , buffer, 4)) { |
| 1064 | /* just die */ |
| 1065 | logmsg("quits" ); |
| 1066 | return FALSE; |
| 1067 | } |
| 1068 | else if(!memcmp("DATA" , buffer, 4)) { |
| 1069 | /* data IN => data OUT */ |
| 1070 | |
| 1071 | if(!read_stdin(buffer, 5)) |
| 1072 | return FALSE; |
| 1073 | |
| 1074 | buffer[5] = '\0'; |
| 1075 | |
| 1076 | buffer_len = (ssize_t)strtol((char *)buffer, NULL, 16); |
| 1077 | if(buffer_len > (ssize_t)sizeof(buffer)) { |
| 1078 | logmsg("ERROR: Buffer size (%zu bytes) too small for data size " |
| 1079 | "(%zd bytes)" , sizeof(buffer), buffer_len); |
| 1080 | return FALSE; |
| 1081 | } |
| 1082 | logmsg("> %zd bytes data, server => client" , buffer_len); |
| 1083 | |
| 1084 | if(!read_stdin(buffer, buffer_len)) |
| 1085 | return FALSE; |
| 1086 | |
| 1087 | lograw(buffer, buffer_len); |
| 1088 | |
| 1089 | if(*mode == PASSIVE_LISTEN) { |
| 1090 | logmsg("*** We are disconnected!" ); |
| 1091 | if(!write_stdout("DISC\n" , 5)) |
| 1092 | return FALSE; |
| 1093 | } |
| 1094 | else { |
| 1095 | /* send away on the socket */ |
| 1096 | ssize_t bytes_written = swrite(sockfd, buffer, buffer_len); |
| 1097 | if(bytes_written != buffer_len) { |
| 1098 | logmsg("Not all data was sent. Bytes to send: %zd sent: %zd" , |
| 1099 | buffer_len, bytes_written); |
| 1100 | } |
| 1101 | } |
| 1102 | } |
| 1103 | else if(!memcmp("DISC" , buffer, 4)) { |
| 1104 | /* disconnect! */ |
| 1105 | if(!write_stdout("DISC\n" , 5)) |
| 1106 | return FALSE; |
| 1107 | if(sockfd != CURL_SOCKET_BAD) { |
| 1108 | logmsg("====> Client forcibly disconnected" ); |
| 1109 | sclose(sockfd); |
| 1110 | *sockfdp = CURL_SOCKET_BAD; |
| 1111 | if(*mode == PASSIVE_CONNECT) |
| 1112 | *mode = PASSIVE_LISTEN; |
| 1113 | else |
| 1114 | *mode = ACTIVE_DISCONNECT; |
| 1115 | } |
| 1116 | else |
| 1117 | logmsg("attempt to close already dead connection" ); |
| 1118 | return TRUE; |
| 1119 | } |
| 1120 | } |
| 1121 | |
| 1122 | |
| 1123 | if((sockfd != CURL_SOCKET_BAD) && (FD_ISSET(sockfd, &fds_read)) ) { |
| 1124 | ssize_t nread_socket; |
| 1125 | if(*mode == PASSIVE_LISTEN) { |
| 1126 | /* there's no stream set up yet, this is an indication that there's a |
| 1127 | client connecting. */ |
| 1128 | curl_socket_t newfd = accept(sockfd, NULL, NULL); |
| 1129 | if(CURL_SOCKET_BAD == newfd) { |
| 1130 | error = SOCKERRNO; |
| 1131 | logmsg("accept(%d, NULL, NULL) failed with error: (%d) %s" , |
| 1132 | sockfd, error, strerror(error)); |
| 1133 | } |
| 1134 | else { |
| 1135 | logmsg("====> Client connect" ); |
| 1136 | if(!write_stdout("CNCT\n" , 5)) |
| 1137 | return FALSE; |
| 1138 | *sockfdp = newfd; /* store the new socket */ |
| 1139 | *mode = PASSIVE_CONNECT; /* we have connected */ |
| 1140 | } |
| 1141 | return TRUE; |
| 1142 | } |
| 1143 | |
| 1144 | /* read from socket, pass on data to stdout */ |
| 1145 | nread_socket = sread(sockfd, buffer, sizeof(buffer)); |
| 1146 | |
| 1147 | if(nread_socket > 0) { |
| 1148 | msnprintf(data, sizeof(data), "DATA\n%04zx\n" , nread_socket); |
| 1149 | if(!write_stdout(data, 10)) |
| 1150 | return FALSE; |
| 1151 | if(!write_stdout(buffer, nread_socket)) |
| 1152 | return FALSE; |
| 1153 | |
| 1154 | logmsg("< %zd bytes data, client => server" , nread_socket); |
| 1155 | lograw(buffer, nread_socket); |
| 1156 | } |
| 1157 | |
| 1158 | if(nread_socket <= 0) { |
| 1159 | logmsg("====> Client disconnect" ); |
| 1160 | if(!write_stdout("DISC\n" , 5)) |
| 1161 | return FALSE; |
| 1162 | sclose(sockfd); |
| 1163 | *sockfdp = CURL_SOCKET_BAD; |
| 1164 | if(*mode == PASSIVE_CONNECT) |
| 1165 | *mode = PASSIVE_LISTEN; |
| 1166 | else |
| 1167 | *mode = ACTIVE_DISCONNECT; |
| 1168 | return TRUE; |
| 1169 | } |
| 1170 | } |
| 1171 | |
| 1172 | return TRUE; |
| 1173 | } |
| 1174 | |
| 1175 | static curl_socket_t sockdaemon(curl_socket_t sock, |
| 1176 | unsigned short *listenport) |
| 1177 | { |
| 1178 | /* passive daemon style */ |
| 1179 | srvr_sockaddr_union_t listener; |
| 1180 | int flag; |
| 1181 | int rc; |
| 1182 | int totdelay = 0; |
| 1183 | int maxretr = 10; |
| 1184 | int delay = 20; |
| 1185 | int attempt = 0; |
| 1186 | int error = 0; |
| 1187 | |
| 1188 | do { |
| 1189 | attempt++; |
| 1190 | flag = 1; |
| 1191 | rc = setsockopt(sock, SOL_SOCKET, SO_REUSEADDR, |
| 1192 | (void *)&flag, sizeof(flag)); |
| 1193 | if(rc) { |
| 1194 | error = SOCKERRNO; |
| 1195 | logmsg("setsockopt(SO_REUSEADDR) failed with error: (%d) %s" , |
| 1196 | error, strerror(error)); |
| 1197 | if(maxretr) { |
| 1198 | rc = wait_ms(delay); |
| 1199 | if(rc) { |
| 1200 | /* should not happen */ |
| 1201 | error = errno; |
| 1202 | logmsg("wait_ms() failed with error: (%d) %s" , |
| 1203 | error, strerror(error)); |
| 1204 | sclose(sock); |
| 1205 | return CURL_SOCKET_BAD; |
| 1206 | } |
| 1207 | if(got_exit_signal) { |
| 1208 | logmsg("signalled to die, exiting..." ); |
| 1209 | sclose(sock); |
| 1210 | return CURL_SOCKET_BAD; |
| 1211 | } |
| 1212 | totdelay += delay; |
| 1213 | delay *= 2; /* double the sleep for next attempt */ |
| 1214 | } |
| 1215 | } |
| 1216 | } while(rc && maxretr--); |
| 1217 | |
| 1218 | if(rc) { |
| 1219 | logmsg("setsockopt(SO_REUSEADDR) failed %d times in %d ms. Error: (%d) %s" , |
| 1220 | attempt, totdelay, error, strerror(error)); |
| 1221 | logmsg("Continuing anyway..." ); |
| 1222 | } |
| 1223 | |
| 1224 | /* When the specified listener port is zero, it is actually a |
| 1225 | request to let the system choose a non-zero available port. */ |
| 1226 | |
| 1227 | #ifdef ENABLE_IPV6 |
| 1228 | if(!use_ipv6) { |
| 1229 | #endif |
| 1230 | memset(&listener.sa4, 0, sizeof(listener.sa4)); |
| 1231 | listener.sa4.sin_family = AF_INET; |
| 1232 | listener.sa4.sin_addr.s_addr = INADDR_ANY; |
| 1233 | listener.sa4.sin_port = htons(*listenport); |
| 1234 | rc = bind(sock, &listener.sa, sizeof(listener.sa4)); |
| 1235 | #ifdef ENABLE_IPV6 |
| 1236 | } |
| 1237 | else { |
| 1238 | memset(&listener.sa6, 0, sizeof(listener.sa6)); |
| 1239 | listener.sa6.sin6_family = AF_INET6; |
| 1240 | listener.sa6.sin6_addr = in6addr_any; |
| 1241 | listener.sa6.sin6_port = htons(*listenport); |
| 1242 | rc = bind(sock, &listener.sa, sizeof(listener.sa6)); |
| 1243 | } |
| 1244 | #endif /* ENABLE_IPV6 */ |
| 1245 | if(rc) { |
| 1246 | error = SOCKERRNO; |
| 1247 | logmsg("Error binding socket on port %hu: (%d) %s" , |
| 1248 | *listenport, error, strerror(error)); |
| 1249 | sclose(sock); |
| 1250 | return CURL_SOCKET_BAD; |
| 1251 | } |
| 1252 | |
| 1253 | if(!*listenport) { |
| 1254 | /* The system was supposed to choose a port number, figure out which |
| 1255 | port we actually got and update the listener port value with it. */ |
| 1256 | curl_socklen_t la_size; |
| 1257 | srvr_sockaddr_union_t localaddr; |
| 1258 | #ifdef ENABLE_IPV6 |
| 1259 | if(!use_ipv6) |
| 1260 | #endif |
| 1261 | la_size = sizeof(localaddr.sa4); |
| 1262 | #ifdef ENABLE_IPV6 |
| 1263 | else |
| 1264 | la_size = sizeof(localaddr.sa6); |
| 1265 | #endif |
| 1266 | memset(&localaddr.sa, 0, (size_t)la_size); |
| 1267 | if(getsockname(sock, &localaddr.sa, &la_size) < 0) { |
| 1268 | error = SOCKERRNO; |
| 1269 | logmsg("getsockname() failed with error: (%d) %s" , |
| 1270 | error, strerror(error)); |
| 1271 | sclose(sock); |
| 1272 | return CURL_SOCKET_BAD; |
| 1273 | } |
| 1274 | switch(localaddr.sa.sa_family) { |
| 1275 | case AF_INET: |
| 1276 | *listenport = ntohs(localaddr.sa4.sin_port); |
| 1277 | break; |
| 1278 | #ifdef ENABLE_IPV6 |
| 1279 | case AF_INET6: |
| 1280 | *listenport = ntohs(localaddr.sa6.sin6_port); |
| 1281 | break; |
| 1282 | #endif |
| 1283 | default: |
| 1284 | break; |
| 1285 | } |
| 1286 | if(!*listenport) { |
| 1287 | /* Real failure, listener port shall not be zero beyond this point. */ |
| 1288 | logmsg("Apparently getsockname() succeeded, with listener port zero." ); |
| 1289 | logmsg("A valid reason for this failure is a binary built without" ); |
| 1290 | logmsg("proper network library linkage. This might not be the only" ); |
| 1291 | logmsg("reason, but double check it before anything else." ); |
| 1292 | sclose(sock); |
| 1293 | return CURL_SOCKET_BAD; |
| 1294 | } |
| 1295 | } |
| 1296 | |
| 1297 | /* bindonly option forces no listening */ |
| 1298 | if(bind_only) { |
| 1299 | logmsg("instructed to bind port without listening" ); |
| 1300 | return sock; |
| 1301 | } |
| 1302 | |
| 1303 | /* start accepting connections */ |
| 1304 | rc = listen(sock, 5); |
| 1305 | if(0 != rc) { |
| 1306 | error = SOCKERRNO; |
| 1307 | logmsg("listen(%d, 5) failed with error: (%d) %s" , |
| 1308 | sock, error, strerror(error)); |
| 1309 | sclose(sock); |
| 1310 | return CURL_SOCKET_BAD; |
| 1311 | } |
| 1312 | |
| 1313 | return sock; |
| 1314 | } |
| 1315 | |
| 1316 | |
| 1317 | int main(int argc, char *argv[]) |
| 1318 | { |
| 1319 | srvr_sockaddr_union_t me; |
| 1320 | curl_socket_t sock = CURL_SOCKET_BAD; |
| 1321 | curl_socket_t msgsock = CURL_SOCKET_BAD; |
| 1322 | int wrotepidfile = 0; |
| 1323 | int wroteportfile = 0; |
| 1324 | const char *pidname = ".sockfilt.pid" ; |
| 1325 | const char *portname = NULL; /* none by default */ |
| 1326 | bool juggle_again; |
| 1327 | int rc; |
| 1328 | int error; |
| 1329 | int arg = 1; |
| 1330 | enum sockmode mode = PASSIVE_LISTEN; /* default */ |
| 1331 | const char *addr = NULL; |
| 1332 | |
| 1333 | while(argc>arg) { |
| 1334 | if(!strcmp("--version" , argv[arg])) { |
| 1335 | printf("sockfilt IPv4%s\n" , |
| 1336 | #ifdef ENABLE_IPV6 |
| 1337 | "/IPv6" |
| 1338 | #else |
| 1339 | "" |
| 1340 | #endif |
| 1341 | ); |
| 1342 | return 0; |
| 1343 | } |
| 1344 | else if(!strcmp("--verbose" , argv[arg])) { |
| 1345 | verbose = TRUE; |
| 1346 | arg++; |
| 1347 | } |
| 1348 | else if(!strcmp("--pidfile" , argv[arg])) { |
| 1349 | arg++; |
| 1350 | if(argc>arg) |
| 1351 | pidname = argv[arg++]; |
| 1352 | } |
| 1353 | else if(!strcmp("--portfile" , argv[arg])) { |
| 1354 | arg++; |
| 1355 | if(argc > arg) |
| 1356 | portname = argv[arg++]; |
| 1357 | } |
| 1358 | else if(!strcmp("--logfile" , argv[arg])) { |
| 1359 | arg++; |
| 1360 | if(argc>arg) |
| 1361 | serverlogfile = argv[arg++]; |
| 1362 | } |
| 1363 | else if(!strcmp("--ipv6" , argv[arg])) { |
| 1364 | #ifdef ENABLE_IPV6 |
| 1365 | ipv_inuse = "IPv6" ; |
| 1366 | use_ipv6 = TRUE; |
| 1367 | #endif |
| 1368 | arg++; |
| 1369 | } |
| 1370 | else if(!strcmp("--ipv4" , argv[arg])) { |
| 1371 | /* for completeness, we support this option as well */ |
| 1372 | #ifdef ENABLE_IPV6 |
| 1373 | ipv_inuse = "IPv4" ; |
| 1374 | use_ipv6 = FALSE; |
| 1375 | #endif |
| 1376 | arg++; |
| 1377 | } |
| 1378 | else if(!strcmp("--bindonly" , argv[arg])) { |
| 1379 | bind_only = TRUE; |
| 1380 | arg++; |
| 1381 | } |
| 1382 | else if(!strcmp("--port" , argv[arg])) { |
| 1383 | arg++; |
| 1384 | if(argc>arg) { |
| 1385 | char *endptr; |
| 1386 | unsigned long ulnum = strtoul(argv[arg], &endptr, 10); |
| 1387 | port = curlx_ultous(ulnum); |
| 1388 | arg++; |
| 1389 | } |
| 1390 | } |
| 1391 | else if(!strcmp("--connect" , argv[arg])) { |
| 1392 | /* Asked to actively connect to the specified local port instead of |
| 1393 | doing a passive server-style listening. */ |
| 1394 | arg++; |
| 1395 | if(argc>arg) { |
| 1396 | char *endptr; |
| 1397 | unsigned long ulnum = strtoul(argv[arg], &endptr, 10); |
| 1398 | if((endptr != argv[arg] + strlen(argv[arg])) || |
| 1399 | (ulnum < 1025UL) || (ulnum > 65535UL)) { |
| 1400 | fprintf(stderr, "sockfilt: invalid --connect argument (%s)\n" , |
| 1401 | argv[arg]); |
| 1402 | return 0; |
| 1403 | } |
| 1404 | connectport = curlx_ultous(ulnum); |
| 1405 | arg++; |
| 1406 | } |
| 1407 | } |
| 1408 | else if(!strcmp("--addr" , argv[arg])) { |
| 1409 | /* Set an IP address to use with --connect; otherwise use localhost */ |
| 1410 | arg++; |
| 1411 | if(argc>arg) { |
| 1412 | addr = argv[arg]; |
| 1413 | arg++; |
| 1414 | } |
| 1415 | } |
| 1416 | else { |
| 1417 | puts("Usage: sockfilt [option]\n" |
| 1418 | " --version\n" |
| 1419 | " --verbose\n" |
| 1420 | " --logfile [file]\n" |
| 1421 | " --pidfile [file]\n" |
| 1422 | " --portfile [file]\n" |
| 1423 | " --ipv4\n" |
| 1424 | " --ipv6\n" |
| 1425 | " --bindonly\n" |
| 1426 | " --port [port]\n" |
| 1427 | " --connect [port]\n" |
| 1428 | " --addr [address]" ); |
| 1429 | return 0; |
| 1430 | } |
| 1431 | } |
| 1432 | |
| 1433 | #ifdef WIN32 |
| 1434 | win32_init(); |
| 1435 | atexit(win32_cleanup); |
| 1436 | |
| 1437 | setmode(fileno(stdin), O_BINARY); |
| 1438 | setmode(fileno(stdout), O_BINARY); |
| 1439 | setmode(fileno(stderr), O_BINARY); |
| 1440 | #endif |
| 1441 | |
| 1442 | install_signal_handlers(false); |
| 1443 | |
| 1444 | #ifdef ENABLE_IPV6 |
| 1445 | if(!use_ipv6) |
| 1446 | #endif |
| 1447 | sock = socket(AF_INET, SOCK_STREAM, 0); |
| 1448 | #ifdef ENABLE_IPV6 |
| 1449 | else |
| 1450 | sock = socket(AF_INET6, SOCK_STREAM, 0); |
| 1451 | #endif |
| 1452 | |
| 1453 | if(CURL_SOCKET_BAD == sock) { |
| 1454 | error = SOCKERRNO; |
| 1455 | logmsg("Error creating socket: (%d) %s" , |
| 1456 | error, strerror(error)); |
| 1457 | write_stdout("FAIL\n" , 5); |
| 1458 | goto sockfilt_cleanup; |
| 1459 | } |
| 1460 | |
| 1461 | if(connectport) { |
| 1462 | /* Active mode, we should connect to the given port number */ |
| 1463 | mode = ACTIVE; |
| 1464 | #ifdef ENABLE_IPV6 |
| 1465 | if(!use_ipv6) { |
| 1466 | #endif |
| 1467 | memset(&me.sa4, 0, sizeof(me.sa4)); |
| 1468 | me.sa4.sin_family = AF_INET; |
| 1469 | me.sa4.sin_port = htons(connectport); |
| 1470 | me.sa4.sin_addr.s_addr = INADDR_ANY; |
| 1471 | if(!addr) |
| 1472 | addr = "127.0.0.1" ; |
| 1473 | Curl_inet_pton(AF_INET, addr, &me.sa4.sin_addr); |
| 1474 | |
| 1475 | rc = connect(sock, &me.sa, sizeof(me.sa4)); |
| 1476 | #ifdef ENABLE_IPV6 |
| 1477 | } |
| 1478 | else { |
| 1479 | memset(&me.sa6, 0, sizeof(me.sa6)); |
| 1480 | me.sa6.sin6_family = AF_INET6; |
| 1481 | me.sa6.sin6_port = htons(connectport); |
| 1482 | if(!addr) |
| 1483 | addr = "::1" ; |
| 1484 | Curl_inet_pton(AF_INET6, addr, &me.sa6.sin6_addr); |
| 1485 | |
| 1486 | rc = connect(sock, &me.sa, sizeof(me.sa6)); |
| 1487 | } |
| 1488 | #endif /* ENABLE_IPV6 */ |
| 1489 | if(rc) { |
| 1490 | error = SOCKERRNO; |
| 1491 | logmsg("Error connecting to port %hu: (%d) %s" , |
| 1492 | connectport, error, strerror(error)); |
| 1493 | write_stdout("FAIL\n" , 5); |
| 1494 | goto sockfilt_cleanup; |
| 1495 | } |
| 1496 | logmsg("====> Client connect" ); |
| 1497 | msgsock = sock; /* use this as stream */ |
| 1498 | } |
| 1499 | else { |
| 1500 | /* passive daemon style */ |
| 1501 | sock = sockdaemon(sock, &port); |
| 1502 | if(CURL_SOCKET_BAD == sock) { |
| 1503 | write_stdout("FAIL\n" , 5); |
| 1504 | goto sockfilt_cleanup; |
| 1505 | } |
| 1506 | msgsock = CURL_SOCKET_BAD; /* no stream socket yet */ |
| 1507 | } |
| 1508 | |
| 1509 | logmsg("Running %s version" , ipv_inuse); |
| 1510 | |
| 1511 | if(connectport) |
| 1512 | logmsg("Connected to port %hu" , connectport); |
| 1513 | else if(bind_only) |
| 1514 | logmsg("Bound without listening on port %hu" , port); |
| 1515 | else |
| 1516 | logmsg("Listening on port %hu" , port); |
| 1517 | |
| 1518 | wrotepidfile = write_pidfile(pidname); |
| 1519 | if(!wrotepidfile) { |
| 1520 | write_stdout("FAIL\n" , 5); |
| 1521 | goto sockfilt_cleanup; |
| 1522 | } |
| 1523 | if(portname) { |
| 1524 | wroteportfile = write_portfile(portname, port); |
| 1525 | if(!wroteportfile) { |
| 1526 | write_stdout("FAIL\n" , 5); |
| 1527 | goto sockfilt_cleanup; |
| 1528 | } |
| 1529 | } |
| 1530 | |
| 1531 | do { |
| 1532 | juggle_again = juggle(&msgsock, sock, &mode); |
| 1533 | } while(juggle_again); |
| 1534 | |
| 1535 | sockfilt_cleanup: |
| 1536 | |
| 1537 | if((msgsock != sock) && (msgsock != CURL_SOCKET_BAD)) |
| 1538 | sclose(msgsock); |
| 1539 | |
| 1540 | if(sock != CURL_SOCKET_BAD) |
| 1541 | sclose(sock); |
| 1542 | |
| 1543 | if(wrotepidfile) |
| 1544 | unlink(pidname); |
| 1545 | if(wroteportfile) |
| 1546 | unlink(portname); |
| 1547 | |
| 1548 | restore_signal_handlers(false); |
| 1549 | |
| 1550 | if(got_exit_signal) { |
| 1551 | logmsg("============> sockfilt exits with signal (%d)" , exit_signal); |
| 1552 | /* |
| 1553 | * To properly set the return status of the process we |
| 1554 | * must raise the same signal SIGINT or SIGTERM that we |
| 1555 | * caught and let the old handler take care of it. |
| 1556 | */ |
| 1557 | raise(exit_signal); |
| 1558 | } |
| 1559 | |
| 1560 | logmsg("============> sockfilt quits" ); |
| 1561 | return 0; |
| 1562 | } |
| 1563 | |