2009-11-25 19:48:57 +01:00
|
|
|
/*
|
|
|
|
* QEMU System Emulator
|
|
|
|
*
|
|
|
|
* Copyright (c) 2003-2008 Fabrice Bellard
|
|
|
|
*
|
|
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
|
|
* in the Software without restriction, including without limitation the rights
|
|
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
|
|
* furnished to do so, subject to the following conditions:
|
|
|
|
*
|
|
|
|
* The above copyright notice and this permission notice shall be included in
|
|
|
|
* all copies or substantial portions of the Software.
|
|
|
|
*
|
|
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
|
|
* THE SOFTWARE.
|
|
|
|
*/
|
|
|
|
|
2012-09-17 18:43:51 +02:00
|
|
|
#include "clients.h"
|
2009-11-25 19:48:57 +01:00
|
|
|
#include "qemu-common.h"
|
2012-12-17 18:20:00 +01:00
|
|
|
#include "qemu/error-report.h"
|
|
|
|
#include "qemu/log.h"
|
|
|
|
#include "qemu/timer.h"
|
2012-07-24 17:35:05 +02:00
|
|
|
#include "hub.h"
|
2009-11-25 19:48:57 +01:00
|
|
|
|
|
|
|
typedef struct DumpState {
|
2012-07-24 17:35:13 +02:00
|
|
|
NetClientState nc;
|
2011-11-30 21:35:38 +01:00
|
|
|
int64_t start_ts;
|
2009-11-25 19:48:57 +01:00
|
|
|
int fd;
|
|
|
|
int pcap_caplen;
|
|
|
|
} DumpState;
|
|
|
|
|
|
|
|
#define PCAP_MAGIC 0xa1b2c3d4
|
|
|
|
|
|
|
|
struct pcap_file_hdr {
|
|
|
|
uint32_t magic;
|
|
|
|
uint16_t version_major;
|
|
|
|
uint16_t version_minor;
|
|
|
|
int32_t thiszone;
|
|
|
|
uint32_t sigfigs;
|
|
|
|
uint32_t snaplen;
|
|
|
|
uint32_t linktype;
|
|
|
|
};
|
|
|
|
|
|
|
|
struct pcap_sf_pkthdr {
|
|
|
|
struct {
|
|
|
|
int32_t tv_sec;
|
|
|
|
int32_t tv_usec;
|
|
|
|
} ts;
|
|
|
|
uint32_t caplen;
|
|
|
|
uint32_t len;
|
|
|
|
};
|
|
|
|
|
2012-07-24 17:35:13 +02:00
|
|
|
static ssize_t dump_receive(NetClientState *nc, const uint8_t *buf, size_t size)
|
2009-11-25 19:48:57 +01:00
|
|
|
{
|
2009-11-25 19:49:09 +01:00
|
|
|
DumpState *s = DO_UPCAST(DumpState, nc, nc);
|
2009-11-25 19:48:57 +01:00
|
|
|
struct pcap_sf_pkthdr hdr;
|
|
|
|
int64_t ts;
|
|
|
|
int caplen;
|
|
|
|
|
|
|
|
/* Early return in case of previous error. */
|
|
|
|
if (s->fd < 0) {
|
|
|
|
return size;
|
|
|
|
}
|
|
|
|
|
2013-08-21 17:03:08 +02:00
|
|
|
ts = muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), 1000000, get_ticks_per_sec());
|
2009-11-25 19:48:57 +01:00
|
|
|
caplen = size > s->pcap_caplen ? s->pcap_caplen : size;
|
|
|
|
|
2011-11-30 21:35:38 +01:00
|
|
|
hdr.ts.tv_sec = ts / 1000000 + s->start_ts;
|
2009-11-25 19:48:57 +01:00
|
|
|
hdr.ts.tv_usec = ts % 1000000;
|
|
|
|
hdr.caplen = caplen;
|
|
|
|
hdr.len = size;
|
|
|
|
if (write(s->fd, &hdr, sizeof(hdr)) != sizeof(hdr) ||
|
|
|
|
write(s->fd, buf, caplen) != caplen) {
|
|
|
|
qemu_log("-net dump write error - stop dump\n");
|
|
|
|
close(s->fd);
|
|
|
|
s->fd = -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
return size;
|
|
|
|
}
|
|
|
|
|
2012-07-24 17:35:13 +02:00
|
|
|
static void dump_cleanup(NetClientState *nc)
|
2009-11-25 19:48:57 +01:00
|
|
|
{
|
2009-11-25 19:49:09 +01:00
|
|
|
DumpState *s = DO_UPCAST(DumpState, nc, nc);
|
2009-11-25 19:48:57 +01:00
|
|
|
|
|
|
|
close(s->fd);
|
|
|
|
}
|
|
|
|
|
2009-11-25 19:49:09 +01:00
|
|
|
static NetClientInfo net_dump_info = {
|
2012-07-17 16:17:12 +02:00
|
|
|
.type = NET_CLIENT_OPTIONS_KIND_DUMP,
|
2009-11-25 19:49:09 +01:00
|
|
|
.size = sizeof(DumpState),
|
|
|
|
.receive = dump_receive,
|
|
|
|
.cleanup = dump_cleanup,
|
|
|
|
};
|
|
|
|
|
2012-07-24 17:35:13 +02:00
|
|
|
static int net_dump_init(NetClientState *peer, const char *device,
|
2009-11-25 19:48:57 +01:00
|
|
|
const char *name, const char *filename, int len)
|
|
|
|
{
|
|
|
|
struct pcap_file_hdr hdr;
|
2012-07-24 17:35:13 +02:00
|
|
|
NetClientState *nc;
|
2009-11-25 19:48:57 +01:00
|
|
|
DumpState *s;
|
2011-11-30 21:35:38 +01:00
|
|
|
struct tm tm;
|
2009-11-25 19:49:09 +01:00
|
|
|
int fd;
|
2009-11-25 19:48:57 +01:00
|
|
|
|
2011-11-30 21:35:37 +01:00
|
|
|
fd = open(filename, O_CREAT | O_TRUNC | O_WRONLY | O_BINARY, 0644);
|
2009-11-25 19:49:09 +01:00
|
|
|
if (fd < 0) {
|
2010-02-18 17:25:24 +01:00
|
|
|
error_report("-net dump: can't open %s", filename);
|
2009-11-25 19:48:57 +01:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
hdr.magic = PCAP_MAGIC;
|
|
|
|
hdr.version_major = 2;
|
|
|
|
hdr.version_minor = 4;
|
|
|
|
hdr.thiszone = 0;
|
|
|
|
hdr.sigfigs = 0;
|
2009-11-25 19:49:09 +01:00
|
|
|
hdr.snaplen = len;
|
2009-11-25 19:48:57 +01:00
|
|
|
hdr.linktype = 1;
|
|
|
|
|
2009-11-25 19:49:09 +01:00
|
|
|
if (write(fd, &hdr, sizeof(hdr)) < sizeof(hdr)) {
|
2010-02-18 17:25:24 +01:00
|
|
|
error_report("-net dump write error: %s", strerror(errno));
|
2009-11-25 19:49:09 +01:00
|
|
|
close(fd);
|
2009-11-25 19:48:57 +01:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2012-07-24 17:35:08 +02:00
|
|
|
nc = qemu_new_net_client(&net_dump_info, peer, device, name);
|
2009-11-25 19:49:09 +01:00
|
|
|
|
|
|
|
snprintf(nc->info_str, sizeof(nc->info_str),
|
2009-11-25 19:48:57 +01:00
|
|
|
"dump to %s (len=%d)", filename, len);
|
2009-11-25 19:49:09 +01:00
|
|
|
|
|
|
|
s = DO_UPCAST(DumpState, nc, nc);
|
|
|
|
|
|
|
|
s->fd = fd;
|
|
|
|
s->pcap_caplen = len;
|
|
|
|
|
2011-11-30 21:35:38 +01:00
|
|
|
qemu_get_timedate(&tm, 0);
|
|
|
|
s->start_ts = mktime(&tm);
|
|
|
|
|
2009-11-25 19:48:57 +01:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-07-17 16:17:21 +02:00
|
|
|
int net_init_dump(const NetClientOptions *opts, const char *name,
|
2015-05-15 13:58:50 +02:00
|
|
|
NetClientState *peer, Error **errp)
|
2009-11-25 19:48:57 +01:00
|
|
|
{
|
2015-05-15 13:58:50 +02:00
|
|
|
/* FIXME error_setg(errp, ...) on failure */
|
2009-11-25 19:48:57 +01:00
|
|
|
int len;
|
|
|
|
const char *file;
|
|
|
|
char def_file[128];
|
2012-07-17 16:17:15 +02:00
|
|
|
const NetdevDumpOptions *dump;
|
|
|
|
|
|
|
|
assert(opts->kind == NET_CLIENT_OPTIONS_KIND_DUMP);
|
|
|
|
dump = opts->dump;
|
2009-11-25 19:48:57 +01:00
|
|
|
|
2012-07-24 17:35:05 +02:00
|
|
|
assert(peer);
|
2009-11-25 19:48:57 +01:00
|
|
|
|
2012-07-17 16:17:15 +02:00
|
|
|
if (dump->has_file) {
|
|
|
|
file = dump->file;
|
|
|
|
} else {
|
2012-07-24 17:35:05 +02:00
|
|
|
int id;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = net_hub_id_for_client(peer, &id);
|
|
|
|
assert(ret == 0); /* peer must be on a hub */
|
|
|
|
|
|
|
|
snprintf(def_file, sizeof(def_file), "qemu-vlan%d.pcap", id);
|
2009-11-25 19:48:57 +01:00
|
|
|
file = def_file;
|
|
|
|
}
|
|
|
|
|
2012-07-17 16:17:15 +02:00
|
|
|
if (dump->has_len) {
|
|
|
|
if (dump->len > INT_MAX) {
|
|
|
|
error_report("invalid length: %"PRIu64, dump->len);
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
len = dump->len;
|
|
|
|
} else {
|
|
|
|
len = 65536;
|
|
|
|
}
|
2009-11-25 19:48:57 +01:00
|
|
|
|
2012-07-24 17:35:05 +02:00
|
|
|
return net_dump_init(peer, "dump", name, file, len);
|
2009-11-25 19:48:57 +01:00
|
|
|
}
|