Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 1 | /* |
| 2 | * QEMU System Emulator |
| 3 | * |
| 4 | * Copyright (c) 2003-2008 Fabrice Bellard |
| 5 | * |
| 6 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
| 7 | * of this software and associated documentation files (the "Software"), to deal |
| 8 | * in the Software without restriction, including without limitation the rights |
| 9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| 10 | * copies of the Software, and to permit persons to whom the Software is |
| 11 | * furnished to do so, subject to the following conditions: |
| 12 | * |
| 13 | * The above copyright notice and this permission notice shall be included in |
| 14 | * all copies or substantial portions of the Software. |
| 15 | * |
| 16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| 17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| 19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| 20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| 21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| 22 | * THE SOFTWARE. |
| 23 | */ |
| 24 | |
| 25 | #include "dump.h" |
| 26 | #include "qemu-common.h" |
Markus Armbruster | 2f79201 | 2010-02-18 16:24:31 +0100 | [diff] [blame] | 27 | #include "qemu-error.h" |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 28 | #include "qemu-log.h" |
Blue Swirl | d8dfad9 | 2011-03-27 14:31:31 +0000 | [diff] [blame] | 29 | #include "qemu-timer.h" |
Stefan Hajnoczi | d33d93b | 2012-07-24 16:35:05 +0100 | [diff] [blame] | 30 | #include "hub.h" |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 31 | |
| 32 | typedef struct DumpState { |
Stefan Hajnoczi | 4e68f7a | 2012-07-24 16:35:13 +0100 | [diff] [blame] | 33 | NetClientState nc; |
Hervé Poussineau | 0fa2991 | 2011-11-30 21:35:38 +0100 | [diff] [blame] | 34 | int64_t start_ts; |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 35 | int fd; |
| 36 | int pcap_caplen; |
| 37 | } DumpState; |
| 38 | |
| 39 | #define PCAP_MAGIC 0xa1b2c3d4 |
| 40 | |
| 41 | struct pcap_file_hdr { |
| 42 | uint32_t magic; |
| 43 | uint16_t version_major; |
| 44 | uint16_t version_minor; |
| 45 | int32_t thiszone; |
| 46 | uint32_t sigfigs; |
| 47 | uint32_t snaplen; |
| 48 | uint32_t linktype; |
| 49 | }; |
| 50 | |
| 51 | struct pcap_sf_pkthdr { |
| 52 | struct { |
| 53 | int32_t tv_sec; |
| 54 | int32_t tv_usec; |
| 55 | } ts; |
| 56 | uint32_t caplen; |
| 57 | uint32_t len; |
| 58 | }; |
| 59 | |
Stefan Hajnoczi | 4e68f7a | 2012-07-24 16:35:13 +0100 | [diff] [blame] | 60 | static ssize_t dump_receive(NetClientState *nc, const uint8_t *buf, size_t size) |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 61 | { |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 62 | DumpState *s = DO_UPCAST(DumpState, nc, nc); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 63 | struct pcap_sf_pkthdr hdr; |
| 64 | int64_t ts; |
| 65 | int caplen; |
| 66 | |
| 67 | /* Early return in case of previous error. */ |
| 68 | if (s->fd < 0) { |
| 69 | return size; |
| 70 | } |
| 71 | |
Paolo Bonzini | 7447545 | 2011-03-11 16:47:48 +0100 | [diff] [blame] | 72 | ts = muldiv64(qemu_get_clock_ns(vm_clock), 1000000, get_ticks_per_sec()); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 73 | caplen = size > s->pcap_caplen ? s->pcap_caplen : size; |
| 74 | |
Hervé Poussineau | 0fa2991 | 2011-11-30 21:35:38 +0100 | [diff] [blame] | 75 | hdr.ts.tv_sec = ts / 1000000 + s->start_ts; |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 76 | hdr.ts.tv_usec = ts % 1000000; |
| 77 | hdr.caplen = caplen; |
| 78 | hdr.len = size; |
| 79 | if (write(s->fd, &hdr, sizeof(hdr)) != sizeof(hdr) || |
| 80 | write(s->fd, buf, caplen) != caplen) { |
| 81 | qemu_log("-net dump write error - stop dump\n"); |
| 82 | close(s->fd); |
| 83 | s->fd = -1; |
| 84 | } |
| 85 | |
| 86 | return size; |
| 87 | } |
| 88 | |
Stefan Hajnoczi | 4e68f7a | 2012-07-24 16:35:13 +0100 | [diff] [blame] | 89 | static void dump_cleanup(NetClientState *nc) |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 90 | { |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 91 | DumpState *s = DO_UPCAST(DumpState, nc, nc); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 92 | |
| 93 | close(s->fd); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 94 | } |
| 95 | |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 96 | static NetClientInfo net_dump_info = { |
Laszlo Ersek | 2be64a6 | 2012-07-17 16:17:12 +0200 | [diff] [blame] | 97 | .type = NET_CLIENT_OPTIONS_KIND_DUMP, |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 98 | .size = sizeof(DumpState), |
| 99 | .receive = dump_receive, |
| 100 | .cleanup = dump_cleanup, |
| 101 | }; |
| 102 | |
Stefan Hajnoczi | 4e68f7a | 2012-07-24 16:35:13 +0100 | [diff] [blame] | 103 | static int net_dump_init(NetClientState *peer, const char *device, |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 104 | const char *name, const char *filename, int len) |
| 105 | { |
| 106 | struct pcap_file_hdr hdr; |
Stefan Hajnoczi | 4e68f7a | 2012-07-24 16:35:13 +0100 | [diff] [blame] | 107 | NetClientState *nc; |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 108 | DumpState *s; |
Hervé Poussineau | 0fa2991 | 2011-11-30 21:35:38 +0100 | [diff] [blame] | 109 | struct tm tm; |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 110 | int fd; |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 111 | |
Hervé Poussineau | 6514ed5 | 2011-11-30 21:35:37 +0100 | [diff] [blame] | 112 | fd = open(filename, O_CREAT | O_TRUNC | O_WRONLY | O_BINARY, 0644); |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 113 | if (fd < 0) { |
Markus Armbruster | 1ecda02 | 2010-02-18 17:25:24 +0100 | [diff] [blame] | 114 | error_report("-net dump: can't open %s", filename); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 115 | return -1; |
| 116 | } |
| 117 | |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 118 | hdr.magic = PCAP_MAGIC; |
| 119 | hdr.version_major = 2; |
| 120 | hdr.version_minor = 4; |
| 121 | hdr.thiszone = 0; |
| 122 | hdr.sigfigs = 0; |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 123 | hdr.snaplen = len; |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 124 | hdr.linktype = 1; |
| 125 | |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 126 | if (write(fd, &hdr, sizeof(hdr)) < sizeof(hdr)) { |
Markus Armbruster | 1ecda02 | 2010-02-18 17:25:24 +0100 | [diff] [blame] | 127 | error_report("-net dump write error: %s", strerror(errno)); |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 128 | close(fd); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 129 | return -1; |
| 130 | } |
| 131 | |
Stefan Hajnoczi | ab5f3f8 | 2012-07-24 16:35:08 +0100 | [diff] [blame] | 132 | nc = qemu_new_net_client(&net_dump_info, peer, device, name); |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 133 | |
| 134 | snprintf(nc->info_str, sizeof(nc->info_str), |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 135 | "dump to %s (len=%d)", filename, len); |
Mark McLoughlin | 731d585 | 2009-11-25 18:49:09 +0000 | [diff] [blame] | 136 | |
| 137 | s = DO_UPCAST(DumpState, nc, nc); |
| 138 | |
| 139 | s->fd = fd; |
| 140 | s->pcap_caplen = len; |
| 141 | |
Hervé Poussineau | 0fa2991 | 2011-11-30 21:35:38 +0100 | [diff] [blame] | 142 | qemu_get_timedate(&tm, 0); |
| 143 | s->start_ts = mktime(&tm); |
| 144 | |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 145 | return 0; |
| 146 | } |
| 147 | |
Laszlo Ersek | 1a0c095 | 2012-07-17 16:17:21 +0200 | [diff] [blame] | 148 | int net_init_dump(const NetClientOptions *opts, const char *name, |
Stefan Hajnoczi | 4e68f7a | 2012-07-24 16:35:13 +0100 | [diff] [blame] | 149 | NetClientState *peer) |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 150 | { |
| 151 | int len; |
| 152 | const char *file; |
| 153 | char def_file[128]; |
Laszlo Ersek | 848040d | 2012-07-17 16:17:15 +0200 | [diff] [blame] | 154 | const NetdevDumpOptions *dump; |
| 155 | |
| 156 | assert(opts->kind == NET_CLIENT_OPTIONS_KIND_DUMP); |
| 157 | dump = opts->dump; |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 158 | |
Stefan Hajnoczi | d33d93b | 2012-07-24 16:35:05 +0100 | [diff] [blame] | 159 | assert(peer); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 160 | |
Laszlo Ersek | 848040d | 2012-07-17 16:17:15 +0200 | [diff] [blame] | 161 | if (dump->has_file) { |
| 162 | file = dump->file; |
| 163 | } else { |
Stefan Hajnoczi | d33d93b | 2012-07-24 16:35:05 +0100 | [diff] [blame] | 164 | int id; |
| 165 | int ret; |
| 166 | |
| 167 | ret = net_hub_id_for_client(peer, &id); |
| 168 | assert(ret == 0); /* peer must be on a hub */ |
| 169 | |
| 170 | snprintf(def_file, sizeof(def_file), "qemu-vlan%d.pcap", id); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 171 | file = def_file; |
| 172 | } |
| 173 | |
Laszlo Ersek | 848040d | 2012-07-17 16:17:15 +0200 | [diff] [blame] | 174 | if (dump->has_len) { |
| 175 | if (dump->len > INT_MAX) { |
| 176 | error_report("invalid length: %"PRIu64, dump->len); |
| 177 | return -1; |
| 178 | } |
| 179 | len = dump->len; |
| 180 | } else { |
| 181 | len = 65536; |
| 182 | } |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 183 | |
Stefan Hajnoczi | d33d93b | 2012-07-24 16:35:05 +0100 | [diff] [blame] | 184 | return net_dump_init(peer, "dump", name, file, len); |
Mark McLoughlin | 1abecf7 | 2009-11-25 18:48:57 +0000 | [diff] [blame] | 185 | } |