C++程序  |  148行  |  3.18 KB

/* Copyright (C) 2008 The Android Open Source Project
**
** This software is licensed under the terms of the GNU General Public
** License version 2, as published by the Free Software Foundation, and
** may be copied, distributed, and modified under those terms.
**
** This program is distributed in the hope that it will be useful,
** but WITHOUT ANY WARRANTY; without even the implied warranty of
** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
** GNU General Public License for more details.
*/
#include "tcpdump.h"
#include <stdio.h>
#include <stdlib.h>
#include <sys/time.h>

int  qemu_tcpdump_active;

static FILE*     capture_file;
static uint64_t  capture_count;
static uint64_t  capture_size;
static int       capture_init;

static void
capture_atexit(void)
{
    if (qemu_tcpdump_active) {
        fclose(capture_file);
        qemu_tcpdump_active = 0;
    }
}

/* See http://wiki.wireshark.org/Development/LibpcapFileFormat for
 * the complete description of the packet capture file format
 */

#define  PCAP_MAGIC     0xa1b2c3d4
#define  PCAP_MAJOR     2
#define  PCAP_MINOR     4
#define  PCAP_SNAPLEN   65535
#define  PCAP_ETHERNET  1

static int
pcap_write_header( FILE*  out )
{
    typedef struct {
        uint32_t   magic;
        uint16_t   version_major;
        uint16_t   version_minor;
        int32_t    this_zone;
        uint32_t   sigfigs;
        uint32_t   snaplen;
        uint32_t   network;
    } PcapHeader;

    PcapHeader  h;

    h.magic         = PCAP_MAGIC;
    h.version_major = PCAP_MAJOR;
    h.version_minor = PCAP_MINOR;
    h.this_zone     = 0;
    h.sigfigs       = 0;  /* all tools set it to 0 in practice */
    h.snaplen       = PCAP_SNAPLEN;
    h.network       = PCAP_ETHERNET;

    if (fwrite(&h, sizeof(h), 1, out) != 1) {
        return -1;
    }
    return 0;
}

int
qemu_tcpdump_start( const char*  filepath )
{
    if (!capture_init) {
        capture_init = 1;
        atexit(capture_atexit);
    }

    qemu_tcpdump_stop();

    if (filepath == NULL)
        return -1;

    capture_file = fopen(filepath, "wb");
    if (capture_file == NULL)
        return -1;

    if (pcap_write_header(capture_file) < 0)
        return -1;

    qemu_tcpdump_active = 1;
    return 0;
}

void
qemu_tcpdump_stop( void )
{
    if (!qemu_tcpdump_active)
        return;

    qemu_tcpdump_active = 0;

    capture_count = 0;
    capture_size  = 0;

    fclose(capture_file);
    capture_file = NULL;
}

void
qemu_tcpdump_packet( const void*  base, int  len )
{
    typedef struct {
        uint32_t  ts_sec;
        uint32_t  ts_usec;
        uint32_t  incl_len;
        uint32_t  orig_len;
    } PacketHeader;

    PacketHeader    h;
    struct timeval  now;
    int             len2 = len;

    if (len2 > PCAP_SNAPLEN)
        len2 = PCAP_SNAPLEN;

    gettimeofday(&now, NULL);
    h.ts_sec   = (uint32_t) now.tv_sec;
    h.ts_usec  = (uint32_t) now.tv_usec;
    h.incl_len = (uint32_t) len2;
    h.orig_len = (uint32_t) len;

    fwrite( &h, sizeof(h), 1, capture_file );
    fwrite( base, 1, len2, capture_file );

    capture_count += 1;
    capture_size  += len2;
}

void
qemu_tcpdump_stats( uint64_t  *pcount, uint64_t*  psize )
{
    *pcount = capture_count;
    *psize  = capture_size;
}