/* subscribe to the (configured) multicast channel */ static int subscribe( int* sockfd, struct in_addr* mcast_inaddr ) { struct sockaddr_in sa; const char* ipaddr = g_recopt.rec_channel; size_t rcvbuf_len = 0; int rc = 0; assert( sockfd && mcast_inaddr ); if( 1 != inet_aton( ipaddr, &sa.sin_addr ) ) { mperror( g_flog, errno, "%s: Invalid subscription [%s:%d]: inet_aton", __func__, ipaddr, g_recopt.rec_port ); return -1; } sa.sin_family = AF_INET; sa.sin_port = htons( (uint16_t)g_recopt.rec_port ); if( 1 != inet_aton( g_recopt.mcast_addr, mcast_inaddr ) ) { mperror( g_flog, errno, "%s: Invalid multicast interface: [%s]: inet_aton", __func__, g_recopt.mcast_addr ); return -1; } rc = calc_buf_settings( NULL, &rcvbuf_len ); if (0 != rc) return rc; return setup_mcast_listener( &sa, mcast_inaddr, sockfd, (g_recopt.nosync_sbuf ? 0 : rcvbuf_len) ); }
/* record network stream as per spec in opt */ static int record() { int rsock = -1, destfd = -1, rc = 0, wtime_sec = 0; struct in_addr raddr; struct timeval rtv; struct dstream_ctx ds; ssize_t nmsgs = 0; ssize_t nrcv = -1, lrcv = -1, t_delta = 0; int64_t n_total = 0; ssize_t nwr = -1, lwr = -1; sig_atomic_t quit = 0; struct rdata_opt ropt; int oflags = 0; char* data = NULL; static const u_short RSOCK_TIMEOUT = 5; extern const char CMD_UDP[]; /* NOPs to eliminate warnings in lean version */ (void)&t_delta; (void)&lrcv; t_delta = lrcv = lwr = 0; quit=0; check_fragments( NULL, 0, 0, 0, 0, g_flog ); /* init */ do { data = malloc( g_recopt.bufsize ); if( NULL == data ) { mperror(g_flog, errno, "%s: cannot allocate [%ld] bytes", __func__, (long)g_recopt.bufsize ); rc = ERR_INTERNAL; break; } rc = subscribe( &rsock, &raddr ); if( 0 != rc ) break; rtv.tv_sec = RSOCK_TIMEOUT; rtv.tv_usec = 0; rc = setsockopt( rsock, SOL_SOCKET, SO_RCVTIMEO, &rtv, sizeof(rtv) ); if( -1 == rc ) { mperror(g_flog, errno, "%s: setsockopt - SO_RCVTIMEO", __func__); rc = ERR_INTERNAL; break; } oflags = O_CREAT | O_TRUNC | O_WRONLY | S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH; # if defined(O_LARGEFILE) /* O_LARGEFILE is not defined under FreeBSD ??-7.1 */ oflags |= O_LARGEFILE; # endif destfd = open( g_recopt.dstfile, oflags, (mode_t)(S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH)); if( -1 == destfd ) { mperror( g_flog, errno, "%s: cannot create destination file [%s]", __func__, g_recopt.dstfile ); rc = ERR_INTERNAL; break; } rc = calc_buf_settings( &nmsgs, NULL ); if (0 != rc) return -1; if( nmsgs < (ssize_t)1 ) { (void) tmfprintf( g_flog, "Buffer for inbound data is too small [%ld] bytes; " "the minimum size is [%ld] bytes\n", (long)g_recopt.bufsize, (long)ETHERNET_MTU ); rc = ERR_PARAM; break; } TRACE( (void)tmfprintf( g_flog, "Inbound buffer set to " "[%d] messages\n", nmsgs ) ); rc = init_dstream_ctx( &ds, CMD_UDP, NULL, nmsgs ); if( 0 != rc ) return -1; (void) set_nice( g_recopt.nice_incr, g_flog ); /* set up alarm to break main loop */ if( 0 != g_recopt.end_time ) { wtime_sec = (int)difftime( g_recopt.end_time, time(NULL) ); assert( wtime_sec >= 0 ); (void) alarm( wtime_sec ); (void)tmfprintf( g_flog, "Recording will end in [%d] seconds\n", wtime_sec ); } } while(0); /* record loop */ ropt.max_frgs = g_recopt.rbuf_msgs; ropt.buf_tmout = -1; for( n_total = 0; (0 == rc) && !(quit = must_quit()); ) { nrcv = read_data( &ds, rsock, data, g_recopt.bufsize, &ropt ); if( -1 == nrcv ) { rc = ERR_INTERNAL; break; } if( 0 == n_total ) { (void) tmfprintf( g_flog, "Recording to file=[%s] started.\n", g_recopt.dstfile ); } TRACE( check_fragments( "received new", g_recopt.bufsize, lrcv, nrcv, t_delta, g_flog ) ); lrcv = nrcv; if( nrcv > 0 ) { if( g_recopt.max_fsize && ((n_total + nrcv) >= g_recopt.max_fsize) ) { break; } nwr = write_data( &ds, data, nrcv, destfd ); if( -1 == nwr ) { rc = ERR_INTERNAL; break; } n_total += (size_t)nwr; /* TRACE( tmfprintf( g_flog, "Wrote [%ld] to file, total=[%ld]\n", (long)nwr, (long)n_total ) ); */ TRACE( check_fragments( "wrote to file", nrcv, lwr, nwr, t_delta, g_flog ) ); lwr = nwr; } if( ds.flags & F_SCATTERED ) reset_pkt_registry( &ds ); } /* record loop */ (void) tmfprintf( g_flog, "Recording to file=[%s] stopped at filesize=[%lu] bytes\n", g_recopt.dstfile, (u_long)n_total ); /* CLEANUP */ (void) alarm(0); TRACE( (void)tmfprintf( g_flog, "Exited record loop: wrote [%lu] bytes to file [%s], " "rc=[%d], alarm=[%ld], quit=[%ld]\n", (u_long)n_total, g_recopt.dstfile, rc, g_alarm, (long)quit ) ); free_dstream_ctx( &ds ); if( data ) free( data ); close_mcast_listener( rsock, &raddr ); if( destfd >= 0 ) (void) close( destfd ); if( quit ) TRACE( (void)tmfprintf( g_flog, "%s process must quit\n", g_udpxrec_app ) ); return rc; }
/* process command to relay udp traffic * */ static int udp_relay( int sockfd, const char* param, size_t plen, const struct in_addr* mifaddr, struct server_ctx* ctx ) { char mcast_addr[ IPADDR_STR_SIZE ]; struct sockaddr_in addr; uint16_t port; pid_t new_pid; int rc = 0, flags; int msockfd = -1, sfilefd = -1, dfilefd = -1, srcfd = -1; char dfile_name[ MAXPATHLEN ]; size_t rcvbuf_len = 0; assert( (sockfd > 0) && param && plen && ctx ); TRACE( (void)tmfprintf( g_flog, "udp_relay : new_socket=[%d] param=[%s]\n", sockfd, param) ); do { rc = parse_udprelay( param, plen, mcast_addr, IPADDR_STR_SIZE, &port ); if( 0 != rc ) { (void) tmfprintf( g_flog, "Error [%d] parsing parameters [%s]\n", rc, param ); break; } if( 1 != inet_aton(mcast_addr, &addr.sin_addr) ) { (void) tmfprintf( g_flog, "Invalid address: [%s]\n", mcast_addr ); rc = ERR_INTERNAL; break; } addr.sin_family = AF_INET; addr.sin_port = htons( (short)port ); } while(0); if( 0 != rc ) { (void) send_http_response( sockfd, 500, "Service error" ); return rc; } /* start the (new) process to relay traffic */ if( 0 != (new_pid = fork()) ) { rc = add_client( ctx, new_pid, mcast_addr, port, sockfd ); return rc; /* parent returns */ } /* child process: */ TRACE( (void)tmfprintf( g_flog, "Client process=[%d] started " "for socket=[%d]\n", getpid(), sockfd) ); (void) get_pidstr( PID_RESET, "c" ); (void)close( ctx->lsockfd ); /* close the reading end of the comm. pipe */ (void)close( ctx->cpipe[0] ); ctx->cpipe[0] = -1; do { /* make write end of pipe non-blocking (we don't want to * block on pipe write while relaying traffic) */ if( -1 == (flags = fcntl( ctx->cpipe[1], F_GETFL )) || -1 == fcntl( ctx->cpipe[1], F_SETFL, flags | O_NONBLOCK ) ) { mperror( g_flog, errno, "%s: fcntl", __func__ ); rc = -1; break; } if( NULL != g_uopt.dstfile ) { (void) snprintf( dfile_name, MAXPATHLEN - 1, "%s.%d", g_uopt.dstfile, getpid() ); dfilefd = creat( dfile_name, S_IRUSR | S_IWUSR | S_IRGRP ); if( -1 == dfilefd ) { mperror( g_flog, errno, "%s: g_uopt.dstfile open", __func__ ); rc = -1; break; } TRACE( (void)tmfprintf( g_flog, "Dest file [%s] opened as fd=[%d]\n", dfile_name, dfilefd ) ); } else dfilefd = -1; if( NULL != g_uopt.srcfile ) { sfilefd = open( g_uopt.srcfile, O_RDONLY | O_NOCTTY ); if( -1 == sfilefd ) { mperror( g_flog, errno, "%s: g_uopt.srcfile open", __func__ ); rc = -1; } else { TRACE( (void) tmfprintf( g_flog, "Source file [%s] opened\n", g_uopt.srcfile ) ); srcfd = sfilefd; } } else { rc = calc_buf_settings( NULL, &rcvbuf_len ); if (0 == rc ) { rc = setup_mcast_listener( &addr, mifaddr, &msockfd, (g_uopt.nosync_sbuf ? 0 : rcvbuf_len) ); srcfd = msockfd; } } if( 0 != rc ) break; rc = relay_traffic( srcfd, sockfd, ctx, dfilefd, mifaddr ); if( 0 != rc ) break; } while(0); if( msockfd > 0 ) { close_mcast_listener( msockfd, mifaddr ); } if( sfilefd > 0 ) { (void) close( sfilefd ); TRACE( (void) tmfprintf( g_flog, "Source file [%s] closed\n", g_uopt.srcfile ) ); } if( dfilefd > 0 ) { (void) close( dfilefd ); TRACE( (void) tmfprintf( g_flog, "Dest file [%s] closed\n", dfile_name ) ); } if( 0 != rc ) { (void) send_http_response( sockfd, 500, "Service error" ); } (void) close( sockfd ); free_server_ctx( ctx ); closelog(); TRACE( (void)tmfprintf( g_flog, "Child process=[%d] exits with rc=[%d]\n", getpid(), rc) ); if( g_flog && (stderr != g_flog) ) { (void) fclose(g_flog); } free_uopt( &g_uopt ); rc = ( 0 != rc ) ? ERR_INTERNAL : rc; exit(rc); /* child exits */ return rc; }
/* relay traffic from source to destination socket * */ static int relay_traffic( int ssockfd, int dsockfd, struct server_ctx* ctx, int dfilefd, const struct in_addr* mifaddr ) { volatile sig_atomic_t quit = 0; int rc = 0; ssize_t nmsgs = -1; ssize_t nrcv = 0, nsent = 0, nwr = 0, lrcv = 0, lsent = 0; char* data = NULL; size_t data_len = g_uopt.rbuf_len; struct rdata_opt ropt; time_t pause_time = 0, rfr_tm = time(NULL); sigset_t ubset; const int ALLOW_PAUSES = get_flagval( "UDPXY_ALLOW_PAUSES", 0 ); const ssize_t MAX_PAUSE_MSEC = get_sizeval( "UDPXY_PAUSE_MSEC", 1000); /* permissible variation in data-packet size */ static const ssize_t t_delta = 0x20; struct dstream_ctx ds; static const int SET_PID = 1; struct tps_data tps; assert( ctx && mifaddr && MAX_PAUSE_MSEC > 0 ); (void) sigemptyset (&ubset); sigaddset (&ubset, SIGINT); sigaddset (&ubset, SIGQUIT); sigaddset (&ubset, SIGTERM); /* restore the ability to receive *quit* signals */ rc = sigprocmask (SIG_UNBLOCK, &ubset, NULL); if (0 != rc) { mperror (g_flog, errno, "%s: sigprocmask", __func__); return -1; } /* NOPs to eliminate warnings in lean version */ (void)&lrcv; (void)&lsent; (void)&t_delta; check_fragments( NULL, 0, 0, 0, 0, g_flog ); /* INIT */ rc = calc_buf_settings( &nmsgs, NULL ); if (0 != rc) return -1; TRACE( (void)tmfprintf( g_flog, "Data buffer will hold up to " "[%d] messages\n", nmsgs ) ); rc = init_dstream_ctx( &ds, ctx->cmd, g_uopt.srcfile, nmsgs ); if( 0 != rc ) return -1; (void) set_nice( g_uopt.nice_incr, g_flog ); do { if( NULL == g_uopt.srcfile ) { rc = set_timeouts( ssockfd, dsockfd, ctx->rcv_tmout, 0, ctx->snd_tmout, 0 ); if( 0 != rc ) break; } if( dsockfd > 0 ) { rc = sync_dsockbuf_len( ssockfd, dsockfd ); if( 0 != rc ) break; rc = send_http_response( dsockfd, 200, "OK" ); if( 0 != rc ) break; /* timeshift: to detect PAUSE make destination * socket non-blocking, otherwise make it blocking * (since it might have been set unblocking earlier) */ rc = set_nblock( dsockfd, (ALLOW_PAUSES ? 1 : 0) ); if( 0 != rc ) break; } data = malloc(data_len); if( NULL == data ) { mperror( g_flog, errno, "%s: malloc", __func__ ); break; } if( g_uopt.cl_tpstat ) tpstat_init( &tps, SET_PID ); } while(0); TRACE( (void)tmfprintf( g_flog, "Relaying traffic from socket[%d] " "to socket[%d], buffer size=[%d], Rmsgs=[%d], pauses=[%d]\n", ssockfd, dsockfd, data_len, g_uopt.rbuf_msgs, ALLOW_PAUSES) ); /* RELAY LOOP */ ropt.max_frgs = g_uopt.rbuf_msgs; ropt.buf_tmout = g_uopt.dhold_tmout; pause_time = 0; while( (0 == rc) && !(quit = must_quit()) ) { if( g_uopt.mcast_refresh > 0 ) { check_mcast_refresh( ssockfd, &rfr_tm, mifaddr ); } nrcv = read_data( &ds, ssockfd, data, data_len, &ropt ); if( -1 == nrcv ) break; TRACE( check_fragments( "received new", data_len, lrcv, nrcv, t_delta, g_flog ) ); lrcv = nrcv; if( dsockfd && (nrcv > 0) ) { nsent = write_data( &ds, data, nrcv, dsockfd ); if( -1 == nsent ) break; if ( nsent < 0 ) { if ( !ALLOW_PAUSES ) break; if ( 0 != pause_detect( nsent, MAX_PAUSE_MSEC, &pause_time ) ) break; } TRACE( check_fragments("sent", nrcv, lsent, nsent, t_delta, g_flog) ); lsent = nsent; } if( (dfilefd > 0) && (nrcv > 0) ) { nwr = write_data( &ds, data, nrcv, dfilefd ); if( -1 == nwr ) break; TRACE( check_fragments( "wrote to file", nrcv, lsent, nwr, t_delta, g_flog ) ); lsent = nwr; } if( ds.flags & F_SCATTERED ) reset_pkt_registry( &ds ); if( uf_TRUE == g_uopt.cl_tpstat ) tpstat_update( ctx, &tps, nsent ); } /* end of RELAY LOOP */ /* CLEANUP */ TRACE( (void)tmfprintf( g_flog, "Exited relay loop: received=[%ld], " "sent=[%ld], quit=[%ld]\n", (long)nrcv, (long)nsent, (long)quit ) ); free_dstream_ctx( &ds ); if( NULL != data ) free( data ); if( 0 != (quit = must_quit()) ) { TRACE( (void)tmfprintf( g_flog, "Child process=[%d] must quit\n", getpid()) ); } return rc; }