savevm.c

   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 #include <unistd.h>
  25 #include <fcntl.h>
  26 #include <signal.h>
  27 #include <time.h>
  28 #include <errno.h>
  29 #include <sys/time.h>
  30 #include <zlib.h>
  31
  32 /* Needed early for CONFIG_BSD etc. */
  33 #include "config-host.h"
  34
  35 #ifndef _WIN32
  36 #include <sys/times.h>
  37 #include <sys/wait.h>
  38 #include <termios.h>
  39 #include <sys/mman.h>
  40 #include <sys/ioctl.h>
  41 #include <sys/resource.h>
  42 #include <sys/socket.h>
  43 #include <netinet/in.h>
  44 #include <net/if.h>
  45 #if defined(__NetBSD__)
  46 #include <net/if_tap.h>
  47 #endif
  48 #ifdef __linux__
  49 #include <linux/if_tun.h>
  50 #endif
  51 #include <arpa/inet.h>
  52 #include <dirent.h>
  53 #include <netdb.h>
  54 #include <sys/select.h>
  55 #ifdef CONFIG_BSD
  56 #include <sys/stat.h>
  57 #if defined(__FreeBSD__) || defined(__DragonFly__)
  58 #include <libutil.h>
  59 #else
  60 #include <util.h>
  61 #endif
  62 #elif defined (__GLIBC__) && defined (__FreeBSD_kernel__)
  63 #include <freebsd/stdlib.h>
  64 #else
  65 #ifdef __linux__
  66 #include <pty.h>
  67 #include <malloc.h>
  68 #include <linux/rtc.h>
  69 #endif
  70 #endif
  71 #endif
  72
  73 #ifdef _WIN32
  74 #include <windows.h>
  75 #include <malloc.h>
  76 #include <sys/timeb.h>
  77 #include <mmsystem.h>
  78 #define getopt_long_only getopt_long
  79 #define memalign(align, size) malloc(size)
  80 #endif
  81
  82 #include "qemu-common.h"
  83 #include "hw/hw.h"
  84 #include "net.h"
  85 #include "monitor.h"
  86 #include "sysemu.h"
  87 #include "qemu-timer.h"
  88 #include "qemu-char.h"
  89 #include "block.h"
  90 #include "audio/audio.h"
  91 #include "migration.h"
  92 #include "qemu_socket.h"
  93 #include "qemu-queue.h"
  94
  95 /* point to the block driver where the snapshots are managed */
  96 static BlockDriverState *bs_snapshots;
  97
  98 #define SELF_ANNOUNCE_ROUNDS 5
  99
 100 #ifndef ETH_P_RARP
 101 #define ETH_P_RARP 0x0835
 102 #endif
 103 #define ARP_HTYPE_ETH 0x0001
 104 #define ARP_PTYPE_IP 0x0800
 105 #define ARP_OP_REQUEST_REV 0x3
 106
 107 static int announce_self_create(uint8_t *buf,
 108                                 uint8_t *mac_addr)
 109 {
 110     /* Ethernet header. */
 111     memset(buf, 0xff, 6);         /* destination MAC addr */
 112     memcpy(buf + 6, mac_addr, 6); /* source MAC addr */
 113     *(uint16_t *)(buf + 12) = htons(ETH_P_RARP); /* ethertype */
 114
 115     /* RARP header. */
 116     *(uint16_t *)(buf + 14) = htons(ARP_HTYPE_ETH); /* hardware addr space */
 117     *(uint16_t *)(buf + 16) = htons(ARP_PTYPE_IP); /* protocol addr space */
 118     *(buf + 18) = 6; /* hardware addr length (ethernet) */
 119     *(buf + 19) = 4; /* protocol addr length (IPv4) */
 120     *(uint16_t *)(buf + 20) = htons(ARP_OP_REQUEST_REV); /* opcode */
 121     memcpy(buf + 22, mac_addr, 6); /* source hw addr */
 122     memset(buf + 28, 0x00, 4);     /* source protocol addr */
 123     memcpy(buf + 32, mac_addr, 6); /* target hw addr */
 124     memset(buf + 38, 0x00, 4);     /* target protocol addr */
 125
 126     /* Padding to get up to 60 bytes (ethernet min packet size, minus FCS). */
 127     memset(buf + 42, 0x00, 18);
 128
 129     return 60; /* len (FCS will be added by hardware) */
 130 }
 131
 132 static void qemu_announce_self_once(void *opaque)
 133 {
 134     int i, len;
 135     VLANState *vlan;
 136     VLANClientState *vc;
 137     uint8_t buf[60];
 138     static int count = SELF_ANNOUNCE_ROUNDS;
 139     QEMUTimer *timer = *(QEMUTimer **)opaque;
 140
 141     for (i = 0; i < MAX_NICS; i++) {
 142         if (!nd_table[i].used)
 143             continue;
 144         len = announce_self_create(buf, nd_table[i].macaddr);
 145         vlan = nd_table[i].vlan;
 146         QTAILQ_FOREACH(vc, &vlan->clients, next) {
 147             vc->receive(vc, buf, len);
 148         }
 149     }
 150     if (--count) {
 151         /* delay 50ms, 150ms, 250ms, ... */
 152         qemu_mod_timer(timer, qemu_get_clock(rt_clock) +
 153                        50 + (SELF_ANNOUNCE_ROUNDS - count - 1) * 100);
 154     } else {
 155             qemu_del_timer(timer);
 156             qemu_free_timer(timer);
 157     }
 158 }
 159
 160 void qemu_announce_self(void)
 161 {
 162         static QEMUTimer *timer;
 163         timer = qemu_new_timer(rt_clock, qemu_announce_self_once, &timer);
 164         qemu_announce_self_once(&timer);
 165 }
 166
 167 /***********************************************************/
 168 /* savevm/loadvm support */
 169
 170 #define IO_BUF_SIZE 32768
 171
 172 struct QEMUFile {
 173     QEMUFilePutBufferFunc *put_buffer;
 174     QEMUFileGetBufferFunc *get_buffer;
 175     QEMUFileCloseFunc *close;
 176     QEMUFileRateLimit *rate_limit;
 177     QEMUFileSetRateLimit *set_rate_limit;
 178     void *opaque;
 179     int is_write;
 180
 181     int64_t buf_offset; /* start of buffer when writing, end of buffer
 182                            when reading */
 183     int buf_index;
 184     int buf_size; /* 0 when writing */
 185     uint8_t buf[IO_BUF_SIZE];
 186
 187     int has_error;
 188 };
 189
 190 typedef struct QEMUFileStdio
 191 {
 192     FILE *stdio_file;
 193     QEMUFile *file;
 194 } QEMUFileStdio;
 195
 196 typedef struct QEMUFileSocket
 197 {
 198     int fd;
 199     QEMUFile *file;
 200 } QEMUFileSocket;
 201
 202 static int socket_get_buffer(void *opaque, uint8_t *buf, int64_t pos, int size)
 203 {
 204     QEMUFileSocket *s = opaque;
 205     ssize_t len;
 206
 207     do {
 208         len = recv(s->fd, (void *)buf, size, 0);
 209     } while (len == -1 && socket_error() == EINTR);
 210
 211     if (len == -1)
 212         len = -socket_error();
 213
 214     return len;
 215 }
 216
 217 static int socket_close(void *opaque)
 218 {
 219     QEMUFileSocket *s = opaque;
 220     qemu_free(s);
 221     return 0;
 222 }
 223
 224 static int stdio_put_buffer(void *opaque, const uint8_t *buf, int64_t pos, int size)
 225 {
 226     QEMUFileStdio *s = opaque;
 227     return fwrite(buf, 1, size, s->stdio_file);
 228 }
 229
 230 static int stdio_get_buffer(void *opaque, uint8_t *buf, int64_t pos, int size)
 231 {
 232     QEMUFileStdio *s = opaque;
 233     FILE *fp = s->stdio_file;
 234     int bytes;
 235
 236     do {
 237         clearerr(fp);
 238         bytes = fread(buf, 1, size, fp);
 239     } while ((bytes == 0) && ferror(fp) && (errno == EINTR));
 240     return bytes;
 241 }
 242
 243 static int stdio_pclose(void *opaque)
 244 {
 245     QEMUFileStdio *s = opaque;
 246     pclose(s->stdio_file);
 247     qemu_free(s);
 248     return 0;
 249 }
 250
 251 static int stdio_fclose(void *opaque)
 252 {
 253     QEMUFileStdio *s = opaque;
 254     fclose(s->stdio_file);
 255     qemu_free(s);
 256     return 0;
 257 }
 258
 259 QEMUFile *qemu_popen(FILE *stdio_file, const char *mode)
 260 {
 261     QEMUFileStdio *s;
 262
 263     if (stdio_file == NULL || mode == NULL || (mode[0] != 'r' && mode[0] != 'w') || mode[1] != 0) {
 264         fprintf(stderr, "qemu_popen: Argument validity check failed\n");
 265         return NULL;
 266     }
 267
 268     s = qemu_mallocz(sizeof(QEMUFileStdio));
 269
 270     s->stdio_file = stdio_file;
 271
 272     if(mode[0] == 'r') {
 273         s->file = qemu_fopen_ops(s, NULL, stdio_get_buffer, stdio_pclose, NULL, NULL);
 274     } else {
 275         s->file = qemu_fopen_ops(s, stdio_put_buffer, NULL, stdio_pclose, NULL, NULL);
 276     }
 277     return s->file;
 278 }
 279
 280 QEMUFile *qemu_popen_cmd(const char *command, const char *mode)
 281 {
 282     FILE *popen_file;
 283
 284     popen_file = popen(command, mode);
 285     if(popen_file == NULL) {
 286         return NULL;
 287     }
 288
 289     return qemu_popen(popen_file, mode);
 290 }
 291
 292 int qemu_stdio_fd(QEMUFile *f)
 293 {
 294     QEMUFileStdio *p;
 295     int fd;
 296
 297     p = (QEMUFileStdio *)f->opaque;
 298     fd = fileno(p->stdio_file);
 299
 300     return fd;
 301 }
 302
 303 QEMUFile *qemu_fdopen(int fd, const char *mode)
 304 {
 305     QEMUFileStdio *s;
 306
 307     if (mode == NULL ||
 308         (mode[0] != 'r' && mode[0] != 'w') ||
 309         mode[1] != 'b' || mode[2] != 0) {
 310         fprintf(stderr, "qemu_fdopen: Argument validity check failed\n");
 311         return NULL;
 312     }
 313
 314     s = qemu_mallocz(sizeof(QEMUFileStdio));
 315     s->stdio_file = fdopen(fd, mode);
 316     if (!s->stdio_file)
 317         goto fail;
 318
 319     if(mode[0] == 'r') {
 320         s->file = qemu_fopen_ops(s, NULL, stdio_get_buffer, stdio_fclose, NULL, NULL);
 321     } else {
 322         s->file = qemu_fopen_ops(s, stdio_put_buffer, NULL, stdio_fclose, NULL, NULL);
 323     }
 324     return s->file;
 325
 326 fail:
 327     qemu_free(s);
 328     return NULL;
 329 }
 330
 331 QEMUFile *qemu_fopen_socket(int fd)
 332 {
 333     QEMUFileSocket *s = qemu_mallocz(sizeof(QEMUFileSocket));
 334
 335     s->fd = fd;
 336     s->file = qemu_fopen_ops(s, NULL, socket_get_buffer, socket_close, NULL, NULL);
 337     return s->file;
 338 }
 339
 340 static int file_put_buffer(void *opaque, const uint8_t *buf,
 341                             int64_t pos, int size)
 342 {
 343     QEMUFileStdio *s = opaque;
 344     fseek(s->stdio_file, pos, SEEK_SET);
 345     fwrite(buf, 1, size, s->stdio_file);
 346     return size;
 347 }
 348
 349 static int file_get_buffer(void *opaque, uint8_t *buf, int64_t pos, int size)
 350 {
 351     QEMUFileStdio *s = opaque;
 352     fseek(s->stdio_file, pos, SEEK_SET);
 353     return fread(buf, 1, size, s->stdio_file);
 354 }
 355
 356 QEMUFile *qemu_fopen(const char *filename, const char *mode)
 357 {
 358     QEMUFileStdio *s;
 359
 360     if (mode == NULL ||
 361         (mode[0] != 'r' && mode[0] != 'w') ||
 362         mode[1] != 'b' || mode[2] != 0) {
 363         fprintf(stderr, "qemu_fdopen: Argument validity check failed\n");
 364         return NULL;
 365     }
 366
 367     s = qemu_mallocz(sizeof(QEMUFileStdio));
 368
 369     s->stdio_file = fopen(filename, mode);
 370     if (!s->stdio_file)
 371         goto fail;
 372
 373     if(mode[0] == 'w') {
 374         s->file = qemu_fopen_ops(s, file_put_buffer, NULL, stdio_fclose, NULL, NULL);
 375     } else {
 376         s->file = qemu_fopen_ops(s, NULL, file_get_buffer, stdio_fclose, NULL, NULL);
 377     }
 378     return s->file;
 379 fail:
 380     qemu_free(s);
 381     return NULL;
 382 }
 383
 384 static int block_put_buffer(void *opaque, const uint8_t *buf,
 385                            int64_t pos, int size)
 386 {
 387     bdrv_save_vmstate(opaque, buf, pos, size);
 388     return size;
 389 }
 390
 391 static int block_get_buffer(void *opaque, uint8_t *buf, int64_t pos, int size)
 392 {
 393     return bdrv_load_vmstate(opaque, buf, pos, size);
 394 }
 395
 396 static int bdrv_fclose(void *opaque)
 397 {
 398     return 0;
 399 }
 400
 401 static QEMUFile *qemu_fopen_bdrv(BlockDriverState *bs, int is_writable)
 402 {
 403     if (is_writable)
 404         return qemu_fopen_ops(bs, block_put_buffer, NULL, bdrv_fclose, NULL, NULL);
 405     return qemu_fopen_ops(bs, NULL, block_get_buffer, bdrv_fclose, NULL, NULL);
 406 }
 407
 408 QEMUFile *qemu_fopen_ops(void *opaque, QEMUFilePutBufferFunc *put_buffer,
 409                          QEMUFileGetBufferFunc *get_buffer,
 410                          QEMUFileCloseFunc *close,
 411                          QEMUFileRateLimit *rate_limit,
 412                          QEMUFileSetRateLimit *set_rate_limit)
 413 {
 414     QEMUFile *f;
 415
 416     f = qemu_mallocz(sizeof(QEMUFile));
 417
 418     f->opaque = opaque;
 419     f->put_buffer = put_buffer;
 420     f->get_buffer = get_buffer;
 421     f->close = close;
 422     f->rate_limit = rate_limit;
 423     f->set_rate_limit = set_rate_limit;
 424     f->is_write = 0;
 425
 426     return f;
 427 }
 428
 429 int qemu_file_has_error(QEMUFile *f)
 430 {
 431     return f->has_error;
 432 }
 433
 434 void qemu_file_set_error(QEMUFile *f)
 435 {
 436     f->has_error = 1;
 437 }
 438
 439 void qemu_fflush(QEMUFile *f)
 440 {
 441     if (!f->put_buffer)
 442         return;
 443
 444     if (f->is_write && f->buf_index > 0) {
 445         int len;
 446
 447         len = f->put_buffer(f->opaque, f->buf, f->buf_offset, f->buf_index);
 448         if (len > 0)
 449             f->buf_offset += f->buf_index;
 450         else
 451             f->has_error = 1;
 452         f->buf_index = 0;
 453     }
 454 }
 455
 456 static void qemu_fill_buffer(QEMUFile *f)
 457 {
 458     int len;
 459
 460     if (!f->get_buffer)
 461         return;
 462
 463     if (f->is_write)
 464         abort();
 465
 466     len = f->get_buffer(f->opaque, f->buf, f->buf_offset, IO_BUF_SIZE);
 467     if (len > 0) {
 468         f->buf_index = 0;
 469         f->buf_size = len;
 470         f->buf_offset += len;
 471     } else if (len != -EAGAIN)
 472         f->has_error = 1;
 473 }
 474
 475 int qemu_fclose(QEMUFile *f)
 476 {
 477     int ret = 0;
 478     qemu_fflush(f);
 479     if (f->close)
 480         ret = f->close(f->opaque);
 481     qemu_free(f);
 482     return ret;
 483 }
 484
 485 void qemu_file_put_notify(QEMUFile *f)
 486 {
 487     f->put_buffer(f->opaque, NULL, 0, 0);
 488 }
 489
 490 void qemu_put_buffer(QEMUFile *f, const uint8_t *buf, int size)
 491 {
 492     int l;
 493
 494     if (!f->has_error && f->is_write == 0 && f->buf_index > 0) {
 495         fprintf(stderr,
 496                 "Attempted to write to buffer while read buffer is not empty\n");
 497         abort();
 498     }
 499
 500     while (!f->has_error && size > 0) {
 501         l = IO_BUF_SIZE - f->buf_index;
 502         if (l > size)
 503             l = size;
 504         memcpy(f->buf + f->buf_index, buf, l);
 505         f->is_write = 1;
 506         f->buf_index += l;
 507         buf += l;
 508         size -= l;
 509         if (f->buf_index >= IO_BUF_SIZE)
 510             qemu_fflush(f);
 511     }
 512 }
 513
 514 void qemu_put_byte(QEMUFile *f, int v)
 515 {
 516     if (!f->has_error && f->is_write == 0 && f->buf_index > 0) {
 517         fprintf(stderr,
 518                 "Attempted to write to buffer while read buffer is not empty\n");
 519         abort();
 520     }
 521
 522     f->buf[f->buf_index++] = v;
 523     f->is_write = 1;
 524     if (f->buf_index >= IO_BUF_SIZE)
 525         qemu_fflush(f);
 526 }
 527
 528 int qemu_get_buffer(QEMUFile *f, uint8_t *buf, int size1)
 529 {
 530     int size, l;
 531
 532     if (f->is_write)
 533         abort();
 534
 535     size = size1;
 536     while (size > 0) {
 537         l = f->buf_size - f->buf_index;
 538         if (l == 0) {
 539             qemu_fill_buffer(f);
 540             l = f->buf_size - f->buf_index;
 541             if (l == 0)
 542                 break;
 543         }
 544         if (l > size)
 545             l = size;
 546         memcpy(buf, f->buf + f->buf_index, l);
 547         f->buf_index += l;
 548         buf += l;
 549         size -= l;
 550     }
 551     return size1 - size;
 552 }
 553
 554 int qemu_get_byte(QEMUFile *f)
 555 {
 556     if (f->is_write)
 557         abort();
 558
 559     if (f->buf_index >= f->buf_size) {
 560         qemu_fill_buffer(f);
 561         if (f->buf_index >= f->buf_size)
 562             return 0;
 563     }
 564     return f->buf[f->buf_index++];
 565 }
 566
 567 int64_t qemu_ftell(QEMUFile *f)
 568 {
 569     return f->buf_offset - f->buf_size + f->buf_index;
 570 }
 571
 572 int64_t qemu_fseek(QEMUFile *f, int64_t pos, int whence)
 573 {
 574     if (whence == SEEK_SET) {
 575         /* nothing to do */
 576     } else if (whence == SEEK_CUR) {
 577         pos += qemu_ftell(f);
 578     } else {
 579         /* SEEK_END not supported */
 580         return -1;
 581     }
 582     if (f->put_buffer) {
 583         qemu_fflush(f);
 584         f->buf_offset = pos;
 585     } else {
 586         f->buf_offset = pos;
 587         f->buf_index = 0;
 588         f->buf_size = 0;
 589     }
 590     return pos;
 591 }
 592
 593 int qemu_file_rate_limit(QEMUFile *f)
 594 {
 595     if (f->rate_limit)
 596         return f->rate_limit(f->opaque);
 597
 598     return 0;
 599 }
 600
 601 size_t qemu_file_set_rate_limit(QEMUFile *f, size_t new_rate)
 602 {
 603     /* any failed or completed migration keeps its state to allow probing of
 604      * migration data, but has no associated file anymore */
 605     if (f && f->set_rate_limit)
 606         return f->set_rate_limit(f->opaque, new_rate);
 607
 608     return 0;
 609 }
 610
 611 void qemu_put_be16(QEMUFile *f, unsigned int v)
 612 {
 613     qemu_put_byte(f, v >> 8);
 614     qemu_put_byte(f, v);
 615 }
 616
 617 void qemu_put_be32(QEMUFile *f, unsigned int v)
 618 {
 619     qemu_put_byte(f, v >> 24);
 620     qemu_put_byte(f, v >> 16);
 621     qemu_put_byte(f, v >> 8);
 622     qemu_put_byte(f, v);
 623 }
 624
 625 void qemu_put_be64(QEMUFile *f, uint64_t v)
 626 {
 627     qemu_put_be32(f, v >> 32);
 628     qemu_put_be32(f, v);
 629 }
 630
 631 unsigned int qemu_get_be16(QEMUFile *f)
 632 {
 633     unsigned int v;
 634     v = qemu_get_byte(f) << 8;
 635     v |= qemu_get_byte(f);
 636     return v;
 637 }
 638
 639 unsigned int qemu_get_be32(QEMUFile *f)
 640 {
 641     unsigned int v;
 642     v = qemu_get_byte(f) << 24;
 643     v |= qemu_get_byte(f) << 16;
 644     v |= qemu_get_byte(f) << 8;
 645     v |= qemu_get_byte(f);
 646     return v;
 647 }
 648
 649 uint64_t qemu_get_be64(QEMUFile *f)
 650 {
 651     uint64_t v;
 652     v = (uint64_t)qemu_get_be32(f) << 32;
 653     v |= qemu_get_be32(f);
 654     return v;
 655 }
 656
 657 /* 8 bit int */
 658
 659 static int get_int8(QEMUFile *f, void *pv, size_t size)
 660 {
 661     int8_t *v = pv;
 662     qemu_get_s8s(f, v);
 663     return 0;
 664 }
 665
 666 static void put_int8(QEMUFile *f, void *pv, size_t size)
 667 {
 668     int8_t *v = pv;
 669     qemu_put_s8s(f, v);
 670 }
 671
 672 const VMStateInfo vmstate_info_int8 = {
 673     .name = "int8",
 674     .get  = get_int8,
 675     .put  = put_int8,
 676 };
 677
 678 /* 16 bit int */
 679
 680 static int get_int16(QEMUFile *f, void *pv, size_t size)
 681 {
 682     int16_t *v = pv;
 683     qemu_get_sbe16s(f, v);
 684     return 0;
 685 }
 686
 687 static void put_int16(QEMUFile *f, void *pv, size_t size)
 688 {
 689     int16_t *v = pv;
 690     qemu_put_sbe16s(f, v);
 691 }
 692
 693 const VMStateInfo vmstate_info_int16 = {
 694     .name = "int16",
 695     .get  = get_int16,
 696     .put  = put_int16,
 697 };
 698
 699 /* 32 bit int */
 700
 701 static int get_int32(QEMUFile *f, void *pv, size_t size)
 702 {
 703     int32_t *v = pv;
 704     qemu_get_sbe32s(f, v);
 705     return 0;
 706 }
 707
 708 static void put_int32(QEMUFile *f, void *pv, size_t size)
 709 {
 710     int32_t *v = pv;
 711     qemu_put_sbe32s(f, v);
 712 }
 713
 714 const VMStateInfo vmstate_info_int32 = {
 715     .name = "int32",
 716     .get  = get_int32,
 717     .put  = put_int32,
 718 };
 719
 720 /* 32 bit int. See that the received value is the same than the one
 721    in the field */
 722
 723 static int get_int32_equal(QEMUFile *f, void *pv, size_t size)
 724 {
 725     int32_t *v = pv;
 726     int32_t v2;
 727     qemu_get_sbe32s(f, &v2);
 728
 729     if (*v == v2)
 730         return 0;
 731     return -EINVAL;
 732 }
 733
 734 const VMStateInfo vmstate_info_int32_equal = {
 735     .name = "int32 equal",
 736     .get  = get_int32_equal,
 737     .put  = put_int32,
 738 };
 739
 740 /* 32 bit int. See that the received value is the less or the same
 741    than the one in the field */
 742
 743 static int get_int32_le(QEMUFile *f, void *pv, size_t size)
 744 {
 745     int32_t *old = pv;
 746     int32_t new;
 747     qemu_get_sbe32s(f, &new);
 748
 749     if (*old <= new)
 750         return 0;
 751     return -EINVAL;
 752 }
 753
 754 const VMStateInfo vmstate_info_int32_le = {
 755     .name = "int32 equal",
 756     .get  = get_int32_le,
 757     .put  = put_int32,
 758 };
 759
 760 /* 64 bit int */
 761
 762 static int get_int64(QEMUFile *f, void *pv, size_t size)
 763 {
 764     int64_t *v = pv;
 765     qemu_get_sbe64s(f, v);
 766     return 0;
 767 }
 768
 769 static void put_int64(QEMUFile *f, void *pv, size_t size)
 770 {
 771     int64_t *v = pv;
 772     qemu_put_sbe64s(f, v);
 773 }
 774
 775 const VMStateInfo vmstate_info_int64 = {
 776     .name = "int64",
 777     .get  = get_int64,
 778     .put  = put_int64,
 779 };
 780
 781 /* 8 bit unsigned int */
 782
 783 static int get_uint8(QEMUFile *f, void *pv, size_t size)
 784 {
 785     uint8_t *v = pv;
 786     qemu_get_8s(f, v);
 787     return 0;
 788 }
 789
 790 static void put_uint8(QEMUFile *f, void *pv, size_t size)
 791 {
 792     uint8_t *v = pv;
 793     qemu_put_8s(f, v);
 794 }
 795
 796 const VMStateInfo vmstate_info_uint8 = {
 797     .name = "uint8",
 798     .get  = get_uint8,
 799     .put  = put_uint8,
 800 };
 801
 802 /* 16 bit unsigned int */
 803
 804 static int get_uint16(QEMUFile *f, void *pv, size_t size)
 805 {
 806     uint16_t *v = pv;
 807     qemu_get_be16s(f, v);
 808     return 0;
 809 }
 810
 811 static void put_uint16(QEMUFile *f, void *pv, size_t size)
 812 {
 813     uint16_t *v = pv;
 814     qemu_put_be16s(f, v);
 815 }
 816
 817 const VMStateInfo vmstate_info_uint16 = {
 818     .name = "uint16",
 819     .get  = get_uint16,
 820     .put  = put_uint16,
 821 };
 822
 823 /* 32 bit unsigned int */
 824
 825 static int get_uint32(QEMUFile *f, void *pv, size_t size)
 826 {
 827     uint32_t *v = pv;
 828     qemu_get_be32s(f, v);
 829     return 0;
 830 }
 831
 832 static void put_uint32(QEMUFile *f, void *pv, size_t size)
 833 {
 834     uint32_t *v = pv;
 835     qemu_put_be32s(f, v);
 836 }
 837
 838 const VMStateInfo vmstate_info_uint32 = {
 839     .name = "uint32",
 840     .get  = get_uint32,
 841     .put  = put_uint32,
 842 };
 843
 844 /* 64 bit unsigned int */
 845
 846 static int get_uint64(QEMUFile *f, void *pv, size_t size)
 847 {
 848     uint64_t *v = pv;
 849     qemu_get_be64s(f, v);
 850     return 0;
 851 }
 852
 853 static void put_uint64(QEMUFile *f, void *pv, size_t size)
 854 {
 855     uint64_t *v = pv;
 856     qemu_put_be64s(f, v);
 857 }
 858
 859 const VMStateInfo vmstate_info_uint64 = {
 860     .name = "uint64",
 861     .get  = get_uint64,
 862     .put  = put_uint64,
 863 };
 864
 865 /* 8 bit int. See that the received value is the same than the one
 866    in the field */
 867
 868 static int get_uint8_equal(QEMUFile *f, void *pv, size_t size)
 869 {
 870     uint8_t *v = pv;
 871     uint8_t v2;
 872     qemu_get_8s(f, &v2);
 873
 874     if (*v == v2)
 875         return 0;
 876     return -EINVAL;
 877 }
 878
 879 const VMStateInfo vmstate_info_uint8_equal = {
 880     .name = "uint8 equal",
 881     .get  = get_uint8_equal,
 882     .put  = put_uint8,
 883 };
 884
 885 /* 16 bit unsigned int int. See that the received value is the same than the one
 886    in the field */
 887
 888 static int get_uint16_equal(QEMUFile *f, void *pv, size_t size)
 889 {
 890     uint16_t *v = pv;
 891     uint16_t v2;
 892     qemu_get_be16s(f, &v2);
 893
 894     if (*v == v2)
 895         return 0;
 896     return -EINVAL;
 897 }
 898
 899 const VMStateInfo vmstate_info_uint16_equal = {
 900     .name = "uint16 equal",
 901     .get  = get_uint16_equal,
 902     .put  = put_uint16,
 903 };
 904
 905 /* timers  */
 906
 907 static int get_timer(QEMUFile *f, void *pv, size_t size)
 908 {
 909     QEMUTimer *v = pv;
 910     qemu_get_timer(f, v);
 911     return 0;
 912 }
 913
 914 static void put_timer(QEMUFile *f, void *pv, size_t size)
 915 {
 916     QEMUTimer *v = pv;
 917     qemu_put_timer(f, v);
 918 }
 919
 920 const VMStateInfo vmstate_info_timer = {
 921     .name = "timer",
 922     .get  = get_timer,
 923     .put  = put_timer,
 924 };
 925
 926 /* uint8_t buffers */
 927
 928 static int get_buffer(QEMUFile *f, void *pv, size_t size)
 929 {
 930     uint8_t *v = pv;
 931     qemu_get_buffer(f, v, size);
 932     return 0;
 933 }
 934
 935 static void put_buffer(QEMUFile *f, void *pv, size_t size)
 936 {
 937     uint8_t *v = pv;
 938     qemu_put_buffer(f, v, size);
 939 }
 940
 941 const VMStateInfo vmstate_info_buffer = {
 942     .name = "buffer",
 943     .get  = get_buffer,
 944     .put  = put_buffer,
 945 };
 946
 947 /* unused buffers: space that was used for some fields that are
 948    not usefull anymore */
 949
 950 static int get_unused_buffer(QEMUFile *f, void *pv, size_t size)
 951 {
 952     qemu_fseek(f, size, SEEK_CUR);
 953     return 0;
 954 }
 955
 956 static void put_unused_buffer(QEMUFile *f, void *pv, size_t size)
 957 {
 958     qemu_fseek(f, size, SEEK_CUR);
 959 }
 960
 961 const VMStateInfo vmstate_info_unused_buffer = {
 962     .name = "unused_buffer",
 963     .get  = get_unused_buffer,
 964     .put  = put_unused_buffer,
 965 };
 966
 967 typedef struct SaveStateEntry {
 968     QTAILQ_ENTRY(SaveStateEntry) entry;
 969     char idstr[256];
 970     int instance_id;
 971     int version_id;
 972     int section_id;
 973     SaveLiveStateHandler *save_live_state;
 974     SaveStateHandler *save_state;
 975     LoadStateHandler *load_state;
 976     const VMStateDescription *vmsd;
 977     void *opaque;
 978 } SaveStateEntry;
 979
 980 static QTAILQ_HEAD(savevm_handlers, SaveStateEntry) savevm_handlers =
 981     QTAILQ_HEAD_INITIALIZER(savevm_handlers);
 982 static int global_section_id;
 983
 984 static int calculate_new_instance_id(const char *idstr)
 985 {
 986     SaveStateEntry *se;
 987     int instance_id = 0;
 988
 989     QTAILQ_FOREACH(se, &savevm_handlers, entry) {
 990         if (strcmp(idstr, se->idstr) == 0
 991             && instance_id <= se->instance_id) {
 992             instance_id = se->instance_id + 1;
 993         }
 994     }
 995     return instance_id;
 996 }
 997
 998 /* TODO: Individual devices generally have very little idea about the rest
 999    of the system, so instance_id should be removed/replaced.
1000    Meanwhile pass -1 as instance_id if you do not already have a clearly
1001    distinguishing id for all instances of your device class. */
1002 int register_savevm_live(const char *idstr,
1003                          int instance_id,
1004                          int version_id,
1005                          SaveLiveStateHandler *save_live_state,
1006                          SaveStateHandler *save_state,
1007                          LoadStateHandler *load_state,
1008                          void *opaque)
1009 {
1010     SaveStateEntry *se;
1011
1012     se = qemu_malloc(sizeof(SaveStateEntry));
1013     pstrcpy(se->idstr, sizeof(se->idstr), idstr);
1014     se->version_id = version_id;
1015     se->section_id = global_section_id++;
1016     se->save_live_state = save_live_state;
1017     se->save_state = save_state;
1018     se->load_state = load_state;
1019     se->opaque = opaque;
1020     se->vmsd = NULL;
1021
1022     if (instance_id == -1) {
1023         se->instance_id = calculate_new_instance_id(idstr);
1024     } else {
1025         se->instance_id = instance_id;
1026     }
1027     /* add at the end of list */
1028     QTAILQ_INSERT_TAIL(&savevm_handlers, se, entry);
1029     return 0;
1030 }
1031
1032 int register_savevm(const char *idstr,
1033                     int instance_id,
1034                     int version_id,
1035                     SaveStateHandler *save_state,
1036                     LoadStateHandler *load_state,
1037                     void *opaque)
1038 {
1039     return register_savevm_live(idstr, instance_id, version_id,
1040                                 NULL, save_state, load_state, opaque);
1041 }
1042
1043 void unregister_savevm(const char *idstr, void *opaque)
1044 {
1045     SaveStateEntry *se, *new_se;
1046
1047     QTAILQ_FOREACH_SAFE(se, &savevm_handlers, entry, new_se) {
1048         if (strcmp(se->idstr, idstr) == 0 && se->opaque == opaque) {
1049             QTAILQ_REMOVE(&savevm_handlers, se, entry);
1050             qemu_free(se);
1051         }
1052     }
1053 }
1054
1055 int vmstate_register(int instance_id, const VMStateDescription *vmsd,
1056                      void *opaque)
1057 {
1058     SaveStateEntry *se;
1059
1060     se = qemu_malloc(sizeof(SaveStateEntry));
1061     pstrcpy(se->idstr, sizeof(se->idstr), vmsd->name);
1062     se->version_id = vmsd->version_id;
1063     se->section_id = global_section_id++;
1064     se->save_live_state = NULL;
1065     se->save_state = NULL;
1066     se->load_state = NULL;
1067     se->opaque = opaque;
1068     se->vmsd = vmsd;
1069
1070     if (instance_id == -1) {
1071         se->instance_id = calculate_new_instance_id(vmsd->name);
1072     } else {
1073         se->instance_id = instance_id;
1074     }
1075     /* add at the end of list */
1076     QTAILQ_INSERT_TAIL(&savevm_handlers, se, entry);
1077     return 0;
1078 }
1079
1080 void vmstate_unregister(const VMStateDescription *vmsd, void *opaque)
1081 {
1082     SaveStateEntry *se, *new_se;
1083
1084     QTAILQ_FOREACH_SAFE(se, &savevm_handlers, entry, new_se) {
1085         if (se->vmsd == vmsd && se->opaque == opaque) {
1086             QTAILQ_REMOVE(&savevm_handlers, se, entry);
1087             qemu_free(se);
1088         }
1089     }
1090 }
1091
1092 int vmstate_load_state(QEMUFile *f, const VMStateDescription *vmsd,
1093                        void *opaque, int version_id)
1094 {
1095     VMStateField *field = vmsd->fields;
1096
1097     if (version_id > vmsd->version_id) {
1098         return -EINVAL;
1099     }
1100     if (version_id < vmsd->minimum_version_id_old) {
1101         return -EINVAL;
1102     }
1103     if  (version_id < vmsd->minimum_version_id) {
1104         return vmsd->load_state_old(f, opaque, version_id);
1105     }
1106     if (vmsd->pre_load) {
1107         int ret = vmsd->pre_load(opaque);
1108         if (ret)
1109             return ret;
1110     }
1111     while(field->name) {
1112         if ((field->field_exists &&
1113              field->field_exists(opaque, version_id)) ||
1114             (!field->field_exists &&
1115              field->version_id <= version_id)) {
1116             void *base_addr = opaque + field->offset;
1117             int ret, i, n_elems = 1;
1118
1119             if (field->flags & VMS_ARRAY) {
1120                 n_elems = field->num;
1121             } else if (field->flags & VMS_VARRAY_INT32) {
1122                 n_elems = *(int32_t *)(opaque+field->num_offset);
1123             } else if (field->flags & VMS_VARRAY_UINT16) {
1124                 n_elems = *(uint16_t *)(opaque+field->num_offset);
1125             }
1126             if (field->flags & VMS_POINTER) {
1127                 base_addr = *(void **)base_addr;
1128             }
1129             for (i = 0; i < n_elems; i++) {
1130                 void *addr = base_addr + field->size * i;
1131
1132                 if (field->flags & VMS_ARRAY_OF_POINTER) {
1133                     addr = *(void **)addr;
1134                 }
1135                 if (field->flags & VMS_STRUCT) {
1136                     ret = vmstate_load_state(f, field->vmsd, addr, field->vmsd->version_id);
1137                 } else {
1138                     ret = field->info->get(f, addr, field->size);
1139
1140                 }
1141                 if (ret < 0) {
1142                     return ret;
1143                 }
1144             }
1145         }
1146         field++;
1147     }
1148     if (vmsd->post_load) {
1149         return vmsd->post_load(opaque, version_id);
1150     }
1151     return 0;
1152 }
1153
1154 void vmstate_save_state(QEMUFile *f, const VMStateDescription *vmsd,
1155                         void *opaque)
1156 {
1157     VMStateField *field = vmsd->fields;
1158
1159     if (vmsd->pre_save) {
1160         vmsd->pre_save(opaque);
1161     }
1162     while(field->name) {
1163         if (!field->field_exists ||
1164             field->field_exists(opaque, vmsd->version_id)) {
1165             void *base_addr = opaque + field->offset;
1166             int i, n_elems = 1;
1167
1168             if (field->flags & VMS_ARRAY) {
1169                 n_elems = field->num;
1170             } else if (field->flags & VMS_VARRAY_INT32) {
1171                 n_elems = *(int32_t *)(opaque+field->num_offset);
1172             } else if (field->flags & VMS_VARRAY_UINT16) {
1173                 n_elems = *(uint16_t *)(opaque+field->num_offset);
1174             }
1175             if (field->flags & VMS_POINTER) {
1176                 base_addr = *(void **)base_addr;
1177             }
1178             for (i = 0; i < n_elems; i++) {
1179                 void *addr = base_addr + field->size * i;
1180
1181                 if (field->flags & VMS_STRUCT) {
1182                     vmstate_save_state(f, field->vmsd, addr);
1183                 } else {
1184                     field->info->put(f, addr, field->size);
1185                 }
1186             }
1187         }
1188         field++;
1189     }
1190     if (vmsd->post_save) {
1191         vmsd->post_save(opaque);
1192     }
1193 }
1194
1195 static int vmstate_load(QEMUFile *f, SaveStateEntry *se, int version_id)
1196 {
1197     if (!se->vmsd) {         /* Old style */
1198         return se->load_state(f, se->opaque, version_id);
1199     }
1200     return vmstate_load_state(f, se->vmsd, se->opaque, version_id);
1201 }
1202
1203 static void vmstate_save(QEMUFile *f, SaveStateEntry *se)
1204 {
1205     if (!se->vmsd) {         /* Old style */
1206         se->save_state(f, se->opaque);
1207         return;
1208     }
1209     vmstate_save_state(f,se->vmsd, se->opaque);
1210 }
1211
1212 #define QEMU_VM_FILE_MAGIC           0x5145564d
1213 #define QEMU_VM_FILE_VERSION_COMPAT  0x00000002
1214 #define QEMU_VM_FILE_VERSION         0x00000003
1215
1216 #define QEMU_VM_EOF                  0x00
1217 #define QEMU_VM_SECTION_START        0x01
1218 #define QEMU_VM_SECTION_PART         0x02
1219 #define QEMU_VM_SECTION_END          0x03
1220 #define QEMU_VM_SECTION_FULL         0x04
1221
1222 int qemu_savevm_state_begin(QEMUFile *f)
1223 {
1224     SaveStateEntry *se;
1225
1226     qemu_put_be32(f, QEMU_VM_FILE_MAGIC);
1227     qemu_put_be32(f, QEMU_VM_FILE_VERSION);
1228
1229     QTAILQ_FOREACH(se, &savevm_handlers, entry) {
1230         int len;
1231
1232         if (se->save_live_state == NULL)
1233             continue;
1234
1235         /* Section type */
1236         qemu_put_byte(f, QEMU_VM_SECTION_START);
1237         qemu_put_be32(f, se->section_id);
1238
1239         /* ID string */
1240         len = strlen(se->idstr);
1241         qemu_put_byte(f, len);
1242         qemu_put_buffer(f, (uint8_t *)se->idstr, len);
1243
1244         qemu_put_be32(f, se->instance_id);
1245         qemu_put_be32(f, se->version_id);
1246
1247         se->save_live_state(f, QEMU_VM_SECTION_START, se->opaque);
1248     }
1249
1250     if (qemu_file_has_error(f))
1251         return -EIO;
1252
1253     return 0;
1254 }
1255
1256 int qemu_savevm_state_iterate(QEMUFile *f)
1257 {
1258     SaveStateEntry *se;
1259     int ret = 1;
1260
1261     QTAILQ_FOREACH(se, &savevm_handlers, entry) {
1262         if (se->save_live_state == NULL)
1263             continue;
1264
1265         /* Section type */
1266         qemu_put_byte(f, QEMU_VM_SECTION_PART);
1267         qemu_put_be32(f, se->section_id);
1268
1269         ret &= !!se->save_live_state(f, QEMU_VM_SECTION_PART, se->opaque);
1270     }
1271
1272     if (ret)
1273         return 1;
1274
1275     if (qemu_file_has_error(f))
1276         return -EIO;
1277
1278     return 0;
1279 }
1280
1281 int qemu_savevm_state_complete(QEMUFile *f)
1282 {
1283     SaveStateEntry *se;
1284
1285     QTAILQ_FOREACH(se, &savevm_handlers, entry) {
1286         if (se->save_live_state == NULL)
1287             continue;
1288
1289         /* Section type */
1290         qemu_put_byte(f, QEMU_VM_SECTION_END);
1291         qemu_put_be32(f, se->section_id);
1292
1293         se->save_live_state(f, QEMU_VM_SECTION_END, se->opaque);
1294     }
1295
1296     QTAILQ_FOREACH(se, &savevm_handlers, entry) {
1297         int len;
1298
1299         if (se->save_state == NULL && se->vmsd == NULL)
1300             continue;
1301
1302         /* Section type */
1303         qemu_put_byte(f, QEMU_VM_SECTION_FULL);
1304         qemu_put_be32(f, se->section_id);
1305
1306         /* ID string */
1307         len = strlen(se->idstr);
1308         qemu_put_byte(f, len);
1309         qemu_put_buffer(f, (uint8_t *)se->idstr, len);
1310
1311         qemu_put_be32(f, se->instance_id);
1312         qemu_put_be32(f, se->version_id);
1313
1314         vmstate_save(f, se);
1315     }
1316
1317     qemu_put_byte(f, QEMU_VM_EOF);
1318
1319     if (qemu_file_has_error(f))
1320         return -EIO;
1321
1322     return 0;
1323 }
1324
1325 int qemu_savevm_state(QEMUFile *f)
1326 {
1327     int saved_vm_running;
1328     int ret;
1329
1330     saved_vm_running = vm_running;
1331     vm_stop(0);
1332
1333     bdrv_flush_all();
1334
1335     ret = qemu_savevm_state_begin(f);
1336     if (ret < 0)
1337         goto out;
1338
1339     do {
1340         ret = qemu_savevm_state_iterate(f);
1341         if (ret < 0)
1342             goto out;
1343     } while (ret == 0);
1344
1345     ret = qemu_savevm_state_complete(f);
1346
1347 out:
1348     if (qemu_file_has_error(f))
1349         ret = -EIO;
1350
1351     if (!ret && saved_vm_running)
1352         vm_start();
1353
1354     return ret;
1355 }
1356
1357 static SaveStateEntry *find_se(const char *idstr, int instance_id)
1358 {
1359     SaveStateEntry *se;
1360
1361     QTAILQ_FOREACH(se, &savevm_handlers, entry) {
1362         if (!strcmp(se->idstr, idstr) &&
1363             instance_id == se->instance_id)
1364             return se;
1365     }
1366     return NULL;
1367 }
1368
1369 typedef struct LoadStateEntry {
1370     QLIST_ENTRY(LoadStateEntry) entry;
1371     SaveStateEntry *se;
1372     int section_id;
1373     int version_id;
1374 } LoadStateEntry;
1375
1376 int qemu_loadvm_state(QEMUFile *f)
1377 {
1378     QLIST_HEAD(, LoadStateEntry) loadvm_handlers =
1379         QLIST_HEAD_INITIALIZER(loadvm_handlers);
1380     LoadStateEntry *le, *new_le;
1381     uint8_t section_type;
1382     unsigned int v;
1383     int ret;
1384
1385     v = qemu_get_be32(f);
1386     if (v != QEMU_VM_FILE_MAGIC)
1387         return -EINVAL;
1388
1389     v = qemu_get_be32(f);
1390     if (v == QEMU_VM_FILE_VERSION_COMPAT) {
1391         fprintf(stderr, "SaveVM v2 format is obsolete and don't work anymore\n");
1392         return -ENOTSUP;
1393     }
1394     if (v != QEMU_VM_FILE_VERSION)
1395         return -ENOTSUP;
1396
1397     while ((section_type = qemu_get_byte(f)) != QEMU_VM_EOF) {
1398         uint32_t instance_id, version_id, section_id;
1399         SaveStateEntry *se;
1400         char idstr[257];
1401         int len;
1402
1403         switch (section_type) {
1404         case QEMU_VM_SECTION_START:
1405         case QEMU_VM_SECTION_FULL:
1406             /* Read section start */
1407             section_id = qemu_get_be32(f);
1408             len = qemu_get_byte(f);
1409             qemu_get_buffer(f, (uint8_t *)idstr, len);
1410             idstr[len] = 0;
1411             instance_id = qemu_get_be32(f);
1412             version_id = qemu_get_be32(f);
1413
1414             /* Find savevm section */
1415             se = find_se(idstr, instance_id);
1416             if (se == NULL) {
1417                 fprintf(stderr, "Unknown savevm section or instance '%s' %d\n", idstr, instance_id);
1418                 ret = -EINVAL;
1419                 goto out;
1420             }
1421
1422             /* Validate version */
1423             if (version_id > se->version_id) {
1424                 fprintf(stderr, "savevm: unsupported version %d for '%s' v%d\n",
1425                         version_id, idstr, se->version_id);
1426                 ret = -EINVAL;
1427                 goto out;
1428             }
1429
1430             /* Add entry */
1431             le = qemu_mallocz(sizeof(*le));
1432
1433             le->se = se;
1434             le->section_id = section_id;
1435             le->version_id = version_id;
1436             QLIST_INSERT_HEAD(&loadvm_handlers, le, entry);
1437
1438             ret = vmstate_load(f, le->se, le->version_id);
1439             if (ret < 0) {
1440                 fprintf(stderr, "qemu: warning: error while loading state for instance 0x%x of device '%s'\n",
1441                         instance_id, idstr);
1442                 goto out;
1443             }
1444             break;
1445         case QEMU_VM_SECTION_PART:
1446         case QEMU_VM_SECTION_END:
1447             section_id = qemu_get_be32(f);
1448
1449             QLIST_FOREACH(le, &loadvm_handlers, entry) {
1450                 if (le->section_id == section_id) {
1451                     break;
1452                 }
1453             }
1454             if (le == NULL) {
1455                 fprintf(stderr, "Unknown savevm section %d\n", section_id);
1456                 ret = -EINVAL;
1457                 goto out;
1458             }
1459
1460             ret = vmstate_load(f, le->se, le->version_id);
1461             if (ret < 0) {
1462                 fprintf(stderr, "qemu: warning: error while loading state section id %d\n",
1463                         section_id);
1464                 goto out;
1465             }
1466             break;
1467         default:
1468             fprintf(stderr, "Unknown savevm section type %d\n", section_type);
1469             ret = -EINVAL;
1470             goto out;
1471         }
1472     }
1473
1474     ret = 0;
1475
1476 out:
1477     QLIST_FOREACH_SAFE(le, &loadvm_handlers, entry, new_le) {
1478         QLIST_REMOVE(le, entry);
1479         qemu_free(le);
1480     }
1481
1482     if (qemu_file_has_error(f))
1483         ret = -EIO;
1484
1485     return ret;
1486 }
1487
1488 /* device can contain snapshots */
1489 static int bdrv_can_snapshot(BlockDriverState *bs)
1490 {
1491     return (bs &&
1492             !bdrv_is_removable(bs) &&
1493             !bdrv_is_read_only(bs));
1494 }
1495
1496 /* device must be snapshots in order to have a reliable snapshot */
1497 static int bdrv_has_snapshot(BlockDriverState *bs)
1498 {
1499     return (bs &&
1500             !bdrv_is_removable(bs) &&
1501             !bdrv_is_read_only(bs));
1502 }
1503
1504 static BlockDriverState *get_bs_snapshots(void)
1505 {
1506     BlockDriverState *bs;
1507     DriveInfo *dinfo;
1508
1509     if (bs_snapshots)
1510         return bs_snapshots;
1511     QTAILQ_FOREACH(dinfo, &drives, next) {
1512         bs = dinfo->bdrv;
1513         if (bdrv_can_snapshot(bs))
1514             goto ok;
1515     }
1516     return NULL;
1517  ok:
1518     bs_snapshots = bs;
1519     return bs;
1520 }
1521
1522 static int bdrv_snapshot_find(BlockDriverState *bs, QEMUSnapshotInfo *sn_info,
1523                               const char *name)
1524 {
1525     QEMUSnapshotInfo *sn_tab, *sn;
1526     int nb_sns, i, ret;
1527
1528     ret = -ENOENT;
1529     nb_sns = bdrv_snapshot_list(bs, &sn_tab);
1530     if (nb_sns < 0)
1531         return ret;
1532     for(i = 0; i < nb_sns; i++) {
1533         sn = &sn_tab[i];
1534         if (!strcmp(sn->id_str, name) || !strcmp(sn->name, name)) {
1535             *sn_info = *sn;
1536             ret = 0;
1537             break;
1538         }
1539     }
1540     qemu_free(sn_tab);
1541     return ret;
1542 }
1543
1544 void do_savevm(Monitor *mon, const QDict *qdict)
1545 {
1546     DriveInfo *dinfo;
1547     BlockDriverState *bs, *bs1;
1548     QEMUSnapshotInfo sn1, *sn = &sn1, old_sn1, *old_sn = &old_sn1;
1549     int must_delete, ret;
1550     QEMUFile *f;
1551     int saved_vm_running;
1552     uint32_t vm_state_size;
1553 #ifdef _WIN32
1554     struct _timeb tb;
1555 #else
1556     struct timeval tv;
1557 #endif
1558     const char *name = qdict_get_try_str(qdict, "name");
1559
1560     bs = get_bs_snapshots();
1561     if (!bs) {
1562         monitor_printf(mon, "No block device can accept snapshots\n");
1563         return;
1564     }
1565
1566     /* ??? Should this occur after vm_stop?  */
1567     qemu_aio_flush();
1568
1569     saved_vm_running = vm_running;
1570     vm_stop(0);
1571
1572     must_delete = 0;
1573     if (name) {
1574         ret = bdrv_snapshot_find(bs, old_sn, name);
1575         if (ret >= 0) {
1576             must_delete = 1;
1577         }
1578     }
1579     memset(sn, 0, sizeof(*sn));
1580     if (must_delete) {
1581         pstrcpy(sn->name, sizeof(sn->name), old_sn->name);
1582         pstrcpy(sn->id_str, sizeof(sn->id_str), old_sn->id_str);
1583     } else {
1584         if (name)
1585             pstrcpy(sn->name, sizeof(sn->name), name);
1586     }
1587
1588     /* fill auxiliary fields */
1589 #ifdef _WIN32
1590     _ftime(&tb);
1591     sn->date_sec = tb.time;
1592     sn->date_nsec = tb.millitm * 1000000;
1593 #else
1594     gettimeofday(&tv, NULL);
1595     sn->date_sec = tv.tv_sec;
1596     sn->date_nsec = tv.tv_usec * 1000;
1597 #endif
1598     sn->vm_clock_nsec = qemu_get_clock(vm_clock);
1599
1600     /* save the VM state */
1601     f = qemu_fopen_bdrv(bs, 1);
1602     if (!f) {
1603         monitor_printf(mon, "Could not open VM state file\n");
1604         goto the_end;
1605     }
1606     ret = qemu_savevm_state(f);
1607     vm_state_size = qemu_ftell(f);
1608     qemu_fclose(f);
1609     if (ret < 0) {
1610         monitor_printf(mon, "Error %d while writing VM\n", ret);
1611         goto the_end;
1612     }
1613
1614     /* create the snapshots */
1615
1616     QTAILQ_FOREACH(dinfo, &drives, next) {
1617         bs1 = dinfo->bdrv;
1618         if (bdrv_has_snapshot(bs1)) {
1619             if (must_delete) {
1620                 ret = bdrv_snapshot_delete(bs1, old_sn->id_str);
1621                 if (ret < 0) {
1622                     monitor_printf(mon,
1623                                    "Error while deleting snapshot on '%s'\n",
1624                                    bdrv_get_device_name(bs1));
1625                 }
1626             }
1627             /* Write VM state size only to the image that contains the state */
1628             sn->vm_state_size = (bs == bs1 ? vm_state_size : 0);
1629             ret = bdrv_snapshot_create(bs1, sn);
1630             if (ret < 0) {
1631                 monitor_printf(mon, "Error while creating snapshot on '%s'\n",
1632                                bdrv_get_device_name(bs1));
1633             }
1634         }
1635     }
1636
1637  the_end:
1638     if (saved_vm_running)
1639         vm_start();
1640 }
1641
1642 int load_vmstate(Monitor *mon, const char *name)
1643 {
1644     DriveInfo *dinfo;
1645     BlockDriverState *bs, *bs1;
1646     QEMUSnapshotInfo sn;
1647     QEMUFile *f;
1648     int ret;
1649
1650     bs = get_bs_snapshots();
1651     if (!bs) {
1652         monitor_printf(mon, "No block device supports snapshots\n");
1653         return -EINVAL;
1654     }
1655
1656     /* Flush all IO requests so they don't interfere with the new state.  */
1657     qemu_aio_flush();
1658
1659     QTAILQ_FOREACH(dinfo, &drives, next) {
1660         bs1 = dinfo->bdrv;
1661         if (bdrv_has_snapshot(bs1)) {
1662             ret = bdrv_snapshot_goto(bs1, name);
1663             if (ret < 0) {
1664                 if (bs != bs1)
1665                     monitor_printf(mon, "Warning: ");
1666                 switch(ret) {
1667                 case -ENOTSUP:
1668                     monitor_printf(mon,
1669                                    "Snapshots not supported on device '%s'\n",
1670                                    bdrv_get_device_name(bs1));
1671                     break;
1672                 case -ENOENT:
1673                     monitor_printf(mon, "Could not find snapshot '%s' on "
1674                                    "device '%s'\n",
1675                                    name, bdrv_get_device_name(bs1));
1676                     break;
1677                 default:
1678                     monitor_printf(mon, "Error %d while activating snapshot on"
1679                                    " '%s'\n", ret, bdrv_get_device_name(bs1));
1680                     break;
1681                 }
1682                 /* fatal on snapshot block device */
1683                 if (bs == bs1)
1684                     return 0;
1685             }
1686         }
1687     }
1688
1689     /* Don't even try to load empty VM states */
1690     ret = bdrv_snapshot_find(bs, &sn, name);
1691     if ((ret >= 0) && (sn.vm_state_size == 0))
1692         return -EINVAL;
1693
1694     /* restore the VM state */
1695     f = qemu_fopen_bdrv(bs, 0);
1696     if (!f) {
1697         monitor_printf(mon, "Could not open VM state file\n");
1698         return -EINVAL;
1699     }
1700     ret = qemu_loadvm_state(f);
1701     qemu_fclose(f);
1702     if (ret < 0) {
1703         monitor_printf(mon, "Error %d while loading VM state\n", ret);
1704         return ret;
1705     }
1706     return 0;
1707 }
1708
1709 void do_delvm(Monitor *mon, const QDict *qdict)
1710 {
1711     DriveInfo *dinfo;
1712     BlockDriverState *bs, *bs1;
1713     int ret;
1714     const char *name = qdict_get_str(qdict, "name");
1715
1716     bs = get_bs_snapshots();
1717     if (!bs) {
1718         monitor_printf(mon, "No block device supports snapshots\n");
1719         return;
1720     }
1721
1722     QTAILQ_FOREACH(dinfo, &drives, next) {
1723         bs1 = dinfo->bdrv;
1724         if (bdrv_has_snapshot(bs1)) {
1725             ret = bdrv_snapshot_delete(bs1, name);
1726             if (ret < 0) {
1727                 if (ret == -ENOTSUP)
1728                     monitor_printf(mon,
1729                                    "Snapshots not supported on device '%s'\n",
1730                                    bdrv_get_device_name(bs1));
1731                 else
1732                     monitor_printf(mon, "Error %d while deleting snapshot on "
1733                                    "'%s'\n", ret, bdrv_get_device_name(bs1));
1734             }
1735         }
1736     }
1737 }
1738
1739 void do_info_snapshots(Monitor *mon)
1740 {
1741     DriveInfo *dinfo;
1742     BlockDriverState *bs, *bs1;
1743     QEMUSnapshotInfo *sn_tab, *sn;
1744     int nb_sns, i;
1745     char buf[256];
1746
1747     bs = get_bs_snapshots();
1748     if (!bs) {
1749         monitor_printf(mon, "No available block device supports snapshots\n");
1750         return;
1751     }
1752     monitor_printf(mon, "Snapshot devices:");
1753     QTAILQ_FOREACH(dinfo, &drives, next) {
1754         bs1 = dinfo->bdrv;
1755         if (bdrv_has_snapshot(bs1)) {
1756             if (bs == bs1)
1757                 monitor_printf(mon, " %s", bdrv_get_device_name(bs1));
1758         }
1759     }
1760     monitor_printf(mon, "\n");
1761
1762     nb_sns = bdrv_snapshot_list(bs, &sn_tab);
1763     if (nb_sns < 0) {
1764         monitor_printf(mon, "bdrv_snapshot_list: error %d\n", nb_sns);
1765         return;
1766     }
1767     monitor_printf(mon, "Snapshot list (from %s):\n",
1768                    bdrv_get_device_name(bs));
1769     monitor_printf(mon, "%s\n", bdrv_snapshot_dump(buf, sizeof(buf), NULL));
1770     for(i = 0; i < nb_sns; i++) {
1771         sn = &sn_tab[i];
1772         monitor_printf(mon, "%s\n", bdrv_snapshot_dump(buf, sizeof(buf), sn));
1773     }
1774     qemu_free(sn_tab);
1775 }