一个简单的C语言TCP Proxy实现

前几天项目中需要一个抓取并分析TCP包的工具,在网上倒腾了一阵子整理了一个工具,现在发布在这儿提供参考。
这个工具是使用C语言开发的一个TCP Proxy,实现TCP转发的功能并dump出来数据包的内容。

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <netdb.h>
#include <signal.h>

#define LOG_ERROR(...)
#define LOG_INFO(...)
#define LOG_DEBUG(...)
#define DEBUG 0

#define BUFFER_SIZE 16384
#define LINE_SIZE 32

/* parameter variable */
int listen_port = 0;
int remote_port = 0;
char * remote_host = NULL;
int foreground = 1;

/*global variable */
int listen_socket;

void help(char * program) {
    printf("Usage syntax: %s -l listen_port -r remote_host -p remote_port [-f (in foreground)]\n", program);
}

void dumpBufferRaw(const unsigned char buffer[], size_t len) {
    int i = 0;
    int j = 0;
    int k = 0;
    char output[LINE_SIZE * 4 + 10] = { ' ' };

    // print header
    for (k = 0; k < LINE_SIZE; k++) {
        printf("%02d ", k);
    }
    printf("\n");
    for (k = 0; k < LINE_SIZE; k++) {
        printf("---");
    }
    printf("\n");

    memset(output, ' ', sizeof(output));
    for (; i < len; i++) {
        sprintf(output + j * 3, "%02X ", buffer[i]);
        sprintf(output + LINE_SIZE * 3 + 4 + j , "%c", isprint(buffer[i]) ? buffer[i] : '.');

        j++;
        if (j >= LINE_SIZE) {
            output[j * 3] = ' ';
            printf("%s\n", output);
            memset(output, ' ', sizeof(output));
            j = 0;
        }
    }
    if (j > 0) {
        output[j * 3] = ' ';
        printf("%s\n", output);
    };

    // print tailer
    for (k = 0; k < LINE_SIZE; k++) {
        printf("---");
    }
    printf("\n");
}

/* create server socket */
int server_listen() {
    int optval = 1;
    struct sockaddr_in listen_addr;
    LOG_DEBUG("Entry of server_listen");
    if ((listen_socket = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
        LOG_ERROR("Cannot create listen socket, errno=[%d], errstr=[%s]", errno, strerror(errno));
        return -1;
    }

    if (setsockopt(listen_socket, SOL_SOCKET, SO_REUSEADDR, &optval, sizeof(optval)) < 0) {
        LOG_ERROR("Cannot set listen socket option, errno=[%d], errstr=[%s]", errno, strerror(errno));
        return -1;
    }

    memset(&listen_addr, 0, sizeof(listen_addr));
    listen_addr.sin_family = AF_INET;
    listen_addr.sin_port = htons(listen_port);
    listen_addr.sin_addr.s_addr = INADDR_ANY;

    if (bind(listen_socket, (struct sockaddr *)&listen_addr, sizeof(listen_addr)) != 0) {
        LOG_ERROR("Cannot bind listen socket, errno=[%d], errstr=[%s]", errno, strerror(errno));
        return -1;
    }

    if (listen(listen_socket, 5) < 0) {
        LOG_ERROR("Cannot listen socket, errno=[%d], errstr=[%s]", errno, strerror(errno));
        return -1;
    }

    LOG_DEBUG("Server listen on port: %d", listen_port);
    return 0;
}

/**
 * return > 0 : success
 *        = 0 : socket close
 *        < 0 : error
 */
ssize_t forward_data(int fromsocket, int tosocket) {
    unsigned char buffer[BUFFER_SIZE];
    ssize_t n = recv(fromsocket, buffer, sizeof(buffer), 0);
    if (n > 0) {
        LOG_DEBUG("data socket: %d -> %d, size: %d", fromsocket, tosocket, n);
        if (!DEBUG) {
            dumpBufferRaw(buffer, n);
        }

        ssize_t m = send(tosocket, buffer, n, 0); // send data to output socket
        if (m < 0) {
            LOG_ERROR("Cannot call send, errno=[%d], errstr=[%s]", errno, strerror(errno));
            return m;
        }
        else if (m != n) {
            LOG_ERROR("Cannot call send, return %ld, expected %ld", m, n);
            return -1;
        }
        else {
            return n;
        }
    }
    else if (n == 0) {
        LOG_INFO("socket closed: %d", fromsocket);
        return 0;
    }
    else {
        LOG_ERROR("Cannot call recv, errno=[%d], errstr=[%s]", errno, strerror(errno));
        return n;
    }
}

void message_loop(int client_socket) {
    fd_set fdsets;
    int remote_socket = connect_remote(client_socket);
    if (remote_socket > 0) {
        LOG_INFO("Remote connection, remote socket=%d", remote_socket);
        while (1) {
            FD_ZERO(&fdsets);
            FD_SET(client_socket, &fdsets);
            FD_SET(remote_socket, &fdsets);

            int ret = select(FD_SETSIZE, &fdsets, NULL, NULL, NULL);
            if (ret < 0) {
                LOG_ERROR("Cannot call select, errno=[%d], errstr=[%s]", errno, strerror(errno));
                break;
            }
            else if (ret == 0) {
                continue;
            }

            if (FD_ISSET(client_socket, &fdsets)) {
                ssize_t n = forward_data(client_socket, remote_socket);
                if (n <= 0) {
                    break;
                }
            }

            if (FD_ISSET(remote_socket, &fdsets)) {
                ssize_t n = forward_data(remote_socket, client_socket);
                if (n <= 0) {
                    break;
                }
            }
        }
        close(remote_socket);
    }

    close(client_socket);
}

void server_loop() {
    while (1) {
        struct sockaddr client_addr;
        socklen_t client_size = sizeof(client_addr);
        int client_socket = accept(listen_socket, (struct sockaddr *)&client_addr, &client_size);
        if (client_socket < 0) {
            LOG_ERROR("Cannot accept client connection, errno=[%d], errstr=[%s]", errno, strerror(errno));
            continue;
        }

        LOG_INFO("Connection accept, client socket=%d", client_socket);
        pid_t pid = fork();
        if (pid > 0) {  // parent process
            LOG_INFO("close client socket in parent process");
            close(client_socket);
        }
        else if (pid == 0) { // child process
            close(listen_socket);
            LOG_INFO("close listen socket in child process");
            message_loop(client_socket);
            exit(0);
        }
        else if (pid < 0) {
            LOG_ERROR("Cannot fork client process, errno=[%d], errstr=[%s]", errno, strerror(errno));
            continue;
        }
    }
}

int connect_remote(int client_socket) {
    struct sockaddr_in remote_addr;
    struct hostent * remote_server;
    int remote_socket;
    if ((remote_socket = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
        LOG_ERROR("Cannot create remote socket, errno=[%d], errstr=[%s]", errno, strerror(errno));
        return -1;
    }

    if ((remote_server = gethostbyname(remote_host)) == NULL) {
        LOG_ERROR("Cannot get host by remote host name %s, errno=[%d], errstr=[%s]", remote_host, errno, strerror(errno));
        return -1;
    }

    memset(&remote_addr, 0, sizeof(remote_addr));
    remote_addr.sin_family = AF_INET;
    memcpy(&remote_addr.sin_addr.s_addr, remote_server->h_addr, remote_server->h_length);
    remote_addr.sin_port = htons(remote_port);

    if (connect(remote_socket, (struct sockaddr *) &remote_addr, sizeof(remote_addr)) < 0) {
        LOG_ERROR("Cannot connect to remote host %s:%d, errno=[%d], errstr=[%s]", remote_host, remote_port, errno, strerror(errno));
        return -1;
    }

    return remote_socket;
}

int parse_options(int argc, char *argv[]) {
    int c = 0;
    while ((c = getopt(argc, argv, "l:r:p:f:h")) != -1) {
        switch(c) {
            case 'l':
                listen_port = atoi(optarg);
                break;
            case 'r':
                remote_host = optarg;
                break;
            case 'p':
                remote_port = atoi(optarg);
                break;
            case 'f':
                foreground = 1;
                break;
            case 'h':
                help(argv[0]);
                exit(0);
            default:
                fprintf(stderr, "ERROR: unsupported parameter %c\n", c);
                return -1;
        }
    }

    if (listen_port == 0) {
        return -1;
    }    
    
    LOG_INFO("Server configuration, listen on %d", listen_port);
    return 0;
}

/* handle finished child process */
void sigchld_handler(int signal) {
    while (waitpid(-1, NULL, WNOHANG) > 0);
}

int main(int argc, char *argv[]) {
    if (parse_options(argc, argv) < 0) {
        help(argv[0]);
        return -1;
    }

    if (server_listen() < 0) { // start server
        LOG_ERROR("Cannot start server listen on port %d", listen_port);
        return -1;
    }

    signal(SIGCHLD, sigchld_handler); // prevent ended children from becoming zombies

    if (!foreground) {
        pid_t pid = fork();
        if (pid > 0) {  // parent
            exit(0);
        }
        else if (pid == 0) {    // // deamonized child
        }
        else {  // error
            LOG_ERROR("Cannot create listen socket, errno=[%d], errstr=[%s]", errno, strerror(errno));
            return -1;
        }
    }

    server_loop();
    return 0;
}

Linux环境下编译测试通过

$ gcc main.c 
$ ./a.out 
Usage syntax: ./a.out-l listen_port -r remote_host -p remote_port [-f (in foreground)]

此外,如果需要支持client使用HTTP CONNECT命令指定的proxy则需要在int connect_remote(int client_socket)里把proxy信息取出来即可。

例如:

    // Retrieve proxy information from CONNECT HTTP command if
    // they are not provided through command line.
    if (remote_host == NULL) {
       char buffer[4096];
       int n = read(client_sock, buffer, 4096 - 1);
       buffer[n] = '\0';

       // Extract the target host and port from the CONNECT request
       char method[10], host[256];
       int port;
       sscanf(buffer, "%s %255s", method, host);
       char *port_str = strchr(host, ':');
       if (port_str) {
           *port_str = '\0';
           port = atoi(port_str + 1);
       } else {
           port = 443;  // Default to HTTPS
       }
    }

这里读出的host和port分别存储proxy的主机和端口信息,只要再把他们赋值给remote_host, remote_port即可。

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 211,123评论 6 490
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 90,031评论 2 384
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 156,723评论 0 345
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 56,357评论 1 283
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 65,412评论 5 384
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 49,760评论 1 289
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 38,904评论 3 405
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 37,672评论 0 266
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 44,118评论 1 303
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 36,456评论 2 325
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 38,599评论 1 340
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 34,264评论 4 328
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 39,857评论 3 312
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 30,731评论 0 21
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,956评论 1 264
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 46,286评论 2 360
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 43,465评论 2 348

推荐阅读更多精彩内容

  • 简介 用简单的话来定义tcpdump,就是:dump the traffic on a network,根据使用者...
    保川阅读 5,942评论 1 13
  • Android 自定义View的各种姿势1 Activity的显示之ViewRootImpl详解 Activity...
    passiontim阅读 171,742评论 25 707
  • Spring Cloud为开发人员提供了快速构建分布式系统中一些常见模式的工具(例如配置管理,服务发现,断路器,智...
    卡卡罗2017阅读 134,628评论 18 139
  • 文/山雨林夕 人们常说“书中自有黄金屋,书中自有颜如玉。”可是,读了这么多年书,却只见颜如玉,未见黄金屋。 为什么...
    山雨林夕阅读 545评论 0 2