Sean Middleditch | ce753de | 2009-03-14 02:20:03 -0400 | [diff] [blame] | 1 | /* |
| 2 | * Sean Middleditch |
| 3 | * sean@sourcemud.org |
| 4 | * |
| 5 | * The author or authors of this code dedicate any and all copyright interest |
| 6 | * in this code to the public domain. We make this dedication for the benefit |
| 7 | * of the public at large and to the detriment of our heirs and successors. We |
| 8 | * intend this dedication to be an overt act of relinquishment in perpetuity of |
| 9 | * all present and future rights to this code under copyright law. |
| 10 | */ |
| 11 | |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 12 | #include <sys/socket.h> |
| 13 | #include <netinet/in.h> |
| 14 | #include <arpa/inet.h> |
Sean Middleditch | d88f183 | 2009-03-15 01:06:17 -0400 | [diff] [blame] | 15 | #include <netdb.h> |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 16 | #include <poll.h> |
| 17 | #include <errno.h> |
| 18 | #include <stdio.h> |
| 19 | #include <string.h> |
| 20 | #include <stdlib.h> |
| 21 | #include <ctype.h> |
| 22 | #include <unistd.h> |
| 23 | |
Sean Middleditch | 9de1598 | 2009-03-14 03:35:49 -0400 | [diff] [blame] | 24 | #ifdef HAVE_ZLIB |
| 25 | #include "zlib.h" |
| 26 | #endif |
| 27 | |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 28 | #include "libtelnet.h" |
| 29 | |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 30 | #ifdef ENABLE_COLOR |
| 31 | # define COLOR_SERVER "\e[35m" |
| 32 | # define COLOR_CLIENT "\e[34m" |
| 33 | # define COLOR_BOLD "\e[1m" |
| 34 | # define COLOR_UNBOLD "\e[22m" |
| 35 | # define COLOR_NORMAL "\e[0m" |
| 36 | #else |
| 37 | # define COLOR_SERVER "" |
| 38 | # define COLOR_CLIENT "" |
| 39 | # define COLOR_BOLD "" |
| 40 | # define COLOR_UNBOLD "" |
| 41 | # define COLOR_NORMAL "" |
| 42 | #endif |
| 43 | |
Sean Middleditch | 5b43a58 | 2009-03-14 02:04:28 -0400 | [diff] [blame] | 44 | struct conn_t { |
| 45 | const char *name; |
| 46 | int sock; |
Sean Middleditch | 812358d | 2009-03-15 23:24:03 -0400 | [diff] [blame] | 47 | libtelnet_t telnet; |
Sean Middleditch | 5b43a58 | 2009-03-14 02:04:28 -0400 | [diff] [blame] | 48 | struct conn_t *remote; |
| 49 | }; |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 50 | |
Sean Middleditch | 0f91258 | 2009-03-14 01:57:07 -0400 | [diff] [blame] | 51 | static const char *get_cmd(unsigned char cmd) { |
| 52 | static char buffer[4]; |
| 53 | |
| 54 | switch (cmd) { |
| 55 | case 255: return "IAC"; |
| 56 | case 254: return "DONT"; |
| 57 | case 253: return "DO"; |
| 58 | case 252: return "WONT"; |
| 59 | case 251: return "WILL"; |
| 60 | case 250: return "SB"; |
| 61 | case 249: return "GA"; |
| 62 | case 248: return "EL"; |
| 63 | case 247: return "EC"; |
| 64 | case 246: return "AYT"; |
| 65 | case 245: return "AO"; |
| 66 | case 244: return "IP"; |
| 67 | case 243: return "BREAK"; |
| 68 | case 242: return "DM"; |
| 69 | case 241: return "NOP"; |
| 70 | case 240: return "SE"; |
| 71 | case 239: return "EOR"; |
| 72 | case 238: return "ABORT"; |
| 73 | case 237: return "SUSP"; |
| 74 | case 236: return "xEOF"; |
| 75 | default: |
| 76 | snprintf(buffer, sizeof(buffer), "%d", (int)cmd); |
| 77 | return buffer; |
| 78 | } |
| 79 | } |
| 80 | |
| 81 | static const char *get_opt(unsigned char opt) { |
| 82 | switch (opt) { |
| 83 | case 0: return "BINARY"; |
| 84 | case 1: return "ECHO"; |
| 85 | case 2: return "RCP"; |
| 86 | case 3: return "SGA"; |
| 87 | case 4: return "NAMS"; |
| 88 | case 5: return "STATUS"; |
| 89 | case 6: return "TM"; |
| 90 | case 7: return "RCTE"; |
| 91 | case 8: return "NAOL"; |
| 92 | case 9: return "NAOP"; |
| 93 | case 10: return "NAOCRD"; |
| 94 | case 11: return "NAOHTS"; |
| 95 | case 12: return "NAOHTD"; |
| 96 | case 13: return "NAOFFD"; |
| 97 | case 14: return "NAOVTS"; |
| 98 | case 15: return "NAOVTD"; |
| 99 | case 16: return "NAOLFD"; |
| 100 | case 17: return "XASCII"; |
| 101 | case 18: return "LOGOUT"; |
| 102 | case 19: return "BM"; |
| 103 | case 20: return "DET"; |
| 104 | case 21: return "SUPDUP"; |
| 105 | case 22: return "SUPDUPOUTPUT"; |
| 106 | case 23: return "SNDLOC"; |
| 107 | case 24: return "TTYPE"; |
| 108 | case 25: return "EOR"; |
| 109 | case 26: return "TUID"; |
| 110 | case 27: return "OUTMRK"; |
| 111 | case 28: return "TTYLOC"; |
| 112 | case 29: return "3270REGIME"; |
| 113 | case 30: return "X3PAD"; |
| 114 | case 31: return "NAWS"; |
| 115 | case 32: return "TSPEED"; |
| 116 | case 33: return "LFLOW"; |
| 117 | case 34: return "LINEMODE"; |
| 118 | case 35: return "XDISPLOC"; |
| 119 | case 36: return "ENVIRON"; |
| 120 | case 37: return "AUTHENTICATION"; |
| 121 | case 38: return "ENCRYPT"; |
| 122 | case 39: return "NEW-ENVIRON"; |
| 123 | case 70: return "MSSP"; |
| 124 | case 85: return "COMPRESS"; |
| 125 | case 86: return "COMPRESS2"; |
| 126 | case 93: return "ZMP"; |
| 127 | case 255: return "EXOPL"; |
| 128 | default: return "unknown"; |
| 129 | } |
| 130 | } |
| 131 | |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 132 | static void print_buffer(unsigned char *buffer, unsigned int size) { |
| 133 | unsigned int i; |
| 134 | for (i = 0; i != size; ++i) { |
| 135 | if (buffer[i] == ' ' || (isprint(buffer[i]) && !isspace(buffer[i]))) |
| 136 | printf("%c", (char)buffer[i]); |
| 137 | else if (buffer[i] == '\n') |
Sean Middleditch | a720527 | 2009-03-15 20:01:56 -0400 | [diff] [blame] | 138 | printf("<" COLOR_BOLD "0x%02X" COLOR_UNBOLD ">\n", |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 139 | (int)buffer[i]); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 140 | else |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 141 | printf("<" COLOR_BOLD "0x%02X" COLOR_UNBOLD ">", (int)buffer[i]); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 142 | } |
| 143 | } |
| 144 | |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 145 | static void _send(int sock, unsigned char *buffer, unsigned int size) { |
Sean Middleditch | d99b36d | 2009-03-14 02:13:50 -0400 | [diff] [blame] | 146 | int rs; |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 147 | |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 148 | /* send data */ |
Sean Middleditch | d99b36d | 2009-03-14 02:13:50 -0400 | [diff] [blame] | 149 | while (size > 0) { |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 150 | if ((rs = send(sock, buffer, size, 0)) == -1) { |
Sean Middleditch | d99b36d | 2009-03-14 02:13:50 -0400 | [diff] [blame] | 151 | fprintf(stderr, "send() failed: %s\n", strerror(errno)); |
| 152 | exit(1); |
| 153 | } else if (rs == 0) { |
| 154 | fprintf(stderr, "send() unexpectedly returned 0\n"); |
| 155 | exit(1); |
| 156 | } |
| 157 | |
| 158 | /* update pointer and size to see if we've got more to send */ |
| 159 | buffer += rs; |
| 160 | size -= rs; |
| 161 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 162 | } |
| 163 | |
Sean Middleditch | 812358d | 2009-03-15 23:24:03 -0400 | [diff] [blame] | 164 | static void _event_handler(libtelnet_t *telnet, libtelnet_event_t *ev, |
| 165 | void *user_data) { |
Sean Middleditch | 5b43a58 | 2009-03-14 02:04:28 -0400 | [diff] [blame] | 166 | struct conn_t *conn = (struct conn_t*)user_data; |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 167 | |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 168 | switch (ev->type) { |
| 169 | /* data received */ |
| 170 | case LIBTELNET_EV_DATA: |
| 171 | printf("%s DATA: ", conn->name); |
| 172 | print_buffer(ev->buffer, ev->size); |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 173 | printf(COLOR_NORMAL "\n"); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 174 | |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 175 | libtelnet_send_data(&conn->remote->telnet, ev->buffer, ev->size); |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 176 | break; |
| 177 | /* data must be sent */ |
| 178 | case LIBTELNET_EV_SEND: |
| 179 | /* DONT SPAM |
| 180 | printf("%s SEND: ", conn->name); |
| 181 | print_buffer(ev->buffer, ev->size); |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 182 | printf(COLOR_BOLD "\n"); |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 183 | */ |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 184 | |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 185 | _send(conn->sock, ev->buffer, ev->size); |
| 186 | break; |
| 187 | /* IAC command */ |
| 188 | case LIBTELNET_EV_IAC: |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 189 | printf("%s IAC %s" COLOR_NORMAL "\n", conn->name, |
| 190 | get_cmd(ev->command)); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 191 | |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 192 | libtelnet_send_command(&conn->remote->telnet, ev->command); |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 193 | break; |
Sean Middleditch | 5b5bc92 | 2009-03-15 23:02:10 -0400 | [diff] [blame] | 194 | /* negotiation, WILL */ |
| 195 | case LIBTELNET_EV_WILL: |
| 196 | printf("%s IAC WILL %d (%s)" COLOR_NORMAL "\n", conn->name, |
| 197 | (int)ev->telopt, get_opt(ev->telopt)); |
| 198 | libtelnet_send_negotiate(&conn->remote->telnet, LIBTELNET_WILL, |
| 199 | ev->telopt); |
| 200 | break; |
| 201 | /* negotiation, WONT */ |
| 202 | case LIBTELNET_EV_WONT: |
| 203 | printf("%s IAC WONT %d (%s)" COLOR_NORMAL "\n", conn->name, |
| 204 | (int)ev->telopt, get_opt(ev->telopt)); |
| 205 | libtelnet_send_negotiate(&conn->remote->telnet, LIBTELNET_WONT, |
| 206 | ev->telopt); |
| 207 | break; |
| 208 | /* negotiation, DO */ |
| 209 | case LIBTELNET_EV_DO: |
| 210 | printf("%s IAC DO %d (%s)" COLOR_NORMAL "\n", conn->name, |
| 211 | (int)ev->telopt, get_opt(ev->telopt)); |
| 212 | libtelnet_send_negotiate(&conn->remote->telnet, LIBTELNET_DO, |
| 213 | ev->telopt); |
| 214 | break; |
| 215 | case LIBTELNET_EV_DONT: |
| 216 | printf("%s IAC DONT %d (%s)" COLOR_NORMAL "\n", conn->name, |
| 217 | (int)ev->telopt, get_opt(ev->telopt)); |
| 218 | libtelnet_send_negotiate(&conn->remote->telnet, LIBTELNET_DONT, |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 219 | ev->telopt); |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 220 | break; |
| 221 | /* subnegotiation */ |
| 222 | case LIBTELNET_EV_SUBNEGOTIATION: |
| 223 | printf("%s SUB %d (%s)", conn->name, (int)ev->telopt, |
| 224 | get_opt(ev->telopt)); |
| 225 | if (ev->size > 0) { |
| 226 | printf(" [%u]: ", ev->size); |
| 227 | print_buffer(ev->buffer, ev->size); |
| 228 | } |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 229 | printf(COLOR_NORMAL "\n"); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 230 | |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 231 | libtelnet_send_subnegotiation(&conn->remote->telnet, ev->telopt, |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 232 | ev->buffer, ev->size); |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 233 | break; |
| 234 | /* compression notification */ |
| 235 | case LIBTELNET_EV_COMPRESS: |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 236 | printf("%s COMPRESSION %s" COLOR_NORMAL "\n", conn->name, |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 237 | ev->command ? "ON" : "OFF"); |
| 238 | break; |
Sean Middleditch | 1699227 | 2009-03-15 19:42:03 -0400 | [diff] [blame] | 239 | /* warning */ |
| 240 | case LIBTELNET_EV_WARNING: |
| 241 | printf("%s WARNING: %.*s" COLOR_NORMAL "\n", conn->name, ev->size, |
| 242 | ev->buffer); |
| 243 | break; |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 244 | /* error */ |
| 245 | case LIBTELNET_EV_ERROR: |
Sean Middleditch | 93b8980 | 2009-03-15 13:10:08 -0400 | [diff] [blame] | 246 | printf("%s ERROR: %.*s" COLOR_NORMAL "\n", conn->name, ev->size, |
| 247 | ev->buffer); |
Sean Middleditch | 637df7f | 2009-03-15 12:57:32 -0400 | [diff] [blame] | 248 | exit(1); |
Sean Middleditch | 0f91258 | 2009-03-14 01:57:07 -0400 | [diff] [blame] | 249 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 250 | } |
| 251 | |
| 252 | int main(int argc, char **argv) { |
| 253 | unsigned char buffer[512]; |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 254 | short listen_port; |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 255 | int listen_sock; |
| 256 | int rs; |
| 257 | struct sockaddr_in addr; |
| 258 | socklen_t addrlen; |
| 259 | struct pollfd pfd[2]; |
Sean Middleditch | 5b43a58 | 2009-03-14 02:04:28 -0400 | [diff] [blame] | 260 | struct conn_t server; |
| 261 | struct conn_t client; |
Sean Middleditch | d88f183 | 2009-03-15 01:06:17 -0400 | [diff] [blame] | 262 | struct addrinfo *ai; |
| 263 | struct addrinfo hints; |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 264 | |
| 265 | /* check usage */ |
| 266 | if (argc != 4) { |
Sean Middleditch | 5b43a58 | 2009-03-14 02:04:28 -0400 | [diff] [blame] | 267 | fprintf(stderr, "Usage:\n ./telnet-proxy <remote ip> <remote port> " |
| 268 | "<local port>\n"); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 269 | return 1; |
| 270 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 271 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 272 | /* parse listening port */ |
| 273 | listen_port = strtol(argv[3], 0, 10); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 274 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 275 | /* loop forever, until user kills process */ |
| 276 | for (;;) { |
| 277 | /* create listening socket */ |
| 278 | if ((listen_sock = socket(AF_INET, SOCK_STREAM, 0)) == -1) { |
| 279 | fprintf(stderr, "socket() failed: %s\n", strerror(errno)); |
| 280 | return 1; |
| 281 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 282 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 283 | /* reuse address option */ |
| 284 | rs = 1; |
| 285 | setsockopt(listen_sock, SOL_SOCKET, SO_REUSEADDR, &rs, sizeof(rs)); |
Sean Middleditch | d88f183 | 2009-03-15 01:06:17 -0400 | [diff] [blame] | 286 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 287 | /* bind to listening addr/port */ |
| 288 | memset(&addr, 0, sizeof(addr)); |
| 289 | addr.sin_family = AF_INET; |
| 290 | addr.sin_addr.s_addr = INADDR_ANY; |
| 291 | addr.sin_port = htons(listen_port); |
| 292 | if (bind(listen_sock, (struct sockaddr *)&addr, sizeof(addr)) == -1) { |
| 293 | fprintf(stderr, "bind() failed: %s\n", strerror(errno)); |
| 294 | return 1; |
| 295 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 296 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 297 | printf("LISTENING ON PORT %d\n", listen_port); |
Sean Middleditch | d88f183 | 2009-03-15 01:06:17 -0400 | [diff] [blame] | 298 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 299 | /* wait for client */ |
| 300 | if (listen(listen_sock, 1) == -1) { |
| 301 | fprintf(stderr, "listen() failed: %s\n", strerror(errno)); |
| 302 | return 1; |
| 303 | } |
| 304 | addrlen = sizeof(addr); |
| 305 | if ((client.sock = accept(listen_sock, (struct sockaddr *)&addr, |
| 306 | &addrlen)) == -1) { |
| 307 | fprintf(stderr, "accept() failed: %s\n", strerror(errno)); |
| 308 | return 1; |
| 309 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 310 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 311 | printf("CLIENT CONNECTION RECEIVED\n"); |
| 312 | |
| 313 | /* stop listening now that we have a client */ |
| 314 | close(listen_sock); |
Sean Middleditch | d88f183 | 2009-03-15 01:06:17 -0400 | [diff] [blame] | 315 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 316 | /* look up server host */ |
| 317 | memset(&hints, 0, sizeof(hints)); |
| 318 | hints.ai_family = AF_UNSPEC; |
| 319 | hints.ai_socktype = SOCK_STREAM; |
| 320 | if ((rs = getaddrinfo(argv[1], argv[2], &hints, &ai)) != 0) { |
| 321 | fprintf(stderr, "getaddrinfo() failed for %s: %s\n", argv[1], |
| 322 | gai_strerror(rs)); |
| 323 | return 1; |
| 324 | } |
| 325 | |
| 326 | /* create server socket */ |
| 327 | if ((server.sock = socket(AF_INET, SOCK_STREAM, 0)) == -1) { |
| 328 | fprintf(stderr, "socket() failed: %s\n", strerror(errno)); |
| 329 | return 1; |
| 330 | } |
Sean Middleditch | 5b43a58 | 2009-03-14 02:04:28 -0400 | [diff] [blame] | 331 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 332 | /* bind server socket */ |
| 333 | memset(&addr, 0, sizeof(addr)); |
| 334 | addr.sin_family = AF_INET; |
| 335 | if (bind(server.sock, (struct sockaddr *)&addr, sizeof(addr)) == -1) { |
| 336 | fprintf(stderr, "bind() failed: %s\n", strerror(errno)); |
| 337 | return 1; |
| 338 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 339 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 340 | /* connect */ |
| 341 | if (connect(server.sock, ai->ai_addr, ai->ai_addrlen) == -1) { |
| 342 | fprintf(stderr, "server() failed: %s\n", strerror(errno)); |
| 343 | return 1; |
| 344 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 345 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 346 | /* free address lookup info */ |
| 347 | freeaddrinfo(ai); |
| 348 | |
| 349 | printf("SERVER CONNECTION ESTABLISHED\n"); |
| 350 | |
| 351 | /* initialize connection structs */ |
| 352 | server.name = COLOR_SERVER "SERVER"; |
| 353 | server.remote = &client; |
| 354 | client.name = COLOR_CLIENT "CLIENT"; |
| 355 | client.remote = &server; |
| 356 | |
| 357 | /* initialize telnet boxes */ |
Sean Middleditch | 08bb05f | 2009-03-15 23:29:46 -0400 | [diff] [blame] | 358 | libtelnet_init(&server.telnet, _event_handler, LIBTELNET_FLAG_PROXY, |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 359 | &server); |
Sean Middleditch | 08bb05f | 2009-03-15 23:29:46 -0400 | [diff] [blame] | 360 | libtelnet_init(&client.telnet, _event_handler, LIBTELNET_FLAG_PROXY, |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 361 | &client); |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 362 | |
| 363 | /* initialize poll descriptors */ |
| 364 | memset(pfd, 0, sizeof(pfd)); |
| 365 | pfd[0].fd = server.sock; |
| 366 | pfd[0].events = POLLIN; |
| 367 | pfd[1].fd = client.sock; |
| 368 | pfd[1].events = POLLIN; |
| 369 | |
| 370 | /* loop while both connections are open */ |
| 371 | while (poll(pfd, 2, -1) != -1) { |
| 372 | /* read from server */ |
| 373 | if (pfd[0].revents & POLLIN) { |
| 374 | if ((rs = recv(server.sock, buffer, sizeof(buffer), 0)) > 0) { |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 375 | libtelnet_push(&server.telnet, buffer, rs); |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 376 | } else if (rs == 0) { |
| 377 | printf("%s DISCONNECTED" COLOR_NORMAL "\n", server.name); |
| 378 | break; |
| 379 | } else { |
| 380 | fprintf(stderr, "recv(server) failed: %s\n", |
| 381 | strerror(errno)); |
| 382 | exit(1); |
| 383 | } |
| 384 | } |
| 385 | |
| 386 | /* read from client */ |
| 387 | if (pfd[1].revents & POLLIN) { |
| 388 | if ((rs = recv(client.sock, buffer, sizeof(buffer), 0)) > 0) { |
Sean Middleditch | 9f79cc5 | 2009-03-15 13:39:24 -0400 | [diff] [blame] | 389 | libtelnet_push(&client.telnet, buffer, rs); |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 390 | } else if (rs == 0) { |
| 391 | printf("%s DISCONNECTED" COLOR_NORMAL "\n", client.name); |
| 392 | break; |
| 393 | } else { |
| 394 | fprintf(stderr, "recv(client) failed: %s\n", |
| 395 | strerror(errno)); |
| 396 | exit(1); |
| 397 | } |
Sean Middleditch | d99b36d | 2009-03-14 02:13:50 -0400 | [diff] [blame] | 398 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 399 | } |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 400 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 401 | /* clean up */ |
| 402 | libtelnet_free(&server.telnet); |
| 403 | libtelnet_free(&client.telnet); |
| 404 | close(server.sock); |
| 405 | close(client.sock); |
| 406 | |
| 407 | /* all done */ |
| 408 | printf("BOTH CONNECTIONS CLOSED\n"); |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 409 | } |
| 410 | |
Sean Middleditch | aefcd0c | 2009-03-15 13:16:44 -0400 | [diff] [blame] | 411 | /* not that we can reach this, but GCC will cry if it's not here */ |
Sean Middleditch | b9ab0b6 | 2009-03-14 00:18:44 -0400 | [diff] [blame] | 412 | return 0; |
| 413 | } |