block/raw-posix.c

   1 /*
   2  * Block driver for RAW files (posix)
   3  *
   4  * Copyright (c) 2006 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 "qemu-common.h"
  25 #include "qemu/timer.h"
  26 #include "qemu/log.h"
  27 #include "block/block_int.h"
  28 #include "qemu/module.h"
  29 #include "trace.h"
  30 #include "block/thread-pool.h"
  31 #include "qemu/iov.h"
  32 #include "raw-aio.h"
  33
  34 #if defined(__APPLE__) && (__MACH__)
  35 #include <paths.h>
  36 #include <sys/param.h>
  37 #include <IOKit/IOKitLib.h>
  38 #include <IOKit/IOBSD.h>
  39 #include <IOKit/storage/IOMediaBSDClient.h>
  40 #include <IOKit/storage/IOMedia.h>
  41 #include <IOKit/storage/IOCDMedia.h>
  42 //#include <IOKit/storage/IOCDTypes.h>
  43 #include <CoreFoundation/CoreFoundation.h>
  44 #endif
  45
  46 #ifdef __sun__
  47 #define _POSIX_PTHREAD_SEMANTICS 1
  48 #include <sys/dkio.h>
  49 #endif
  50 #ifdef __linux__
  51 #include <sys/types.h>
  52 #include <sys/stat.h>
  53 #include <sys/ioctl.h>
  54 #include <sys/param.h>
  55 #include <linux/cdrom.h>
  56 #include <linux/fd.h>
  57 #include <linux/fs.h>
  58 #endif
  59 #ifdef CONFIG_FIEMAP
  60 #include <linux/fiemap.h>
  61 #endif
  62 #ifdef CONFIG_FALLOCATE_PUNCH_HOLE
  63 #include <linux/falloc.h>
  64 #endif
  65 #if defined (__FreeBSD__) || defined(__FreeBSD_kernel__)
  66 #include <sys/disk.h>
  67 #include <sys/cdio.h>
  68 #endif
  69
  70 #ifdef __OpenBSD__
  71 #include <sys/ioctl.h>
  72 #include <sys/disklabel.h>
  73 #include <sys/dkio.h>
  74 #endif
  75
  76 #ifdef __NetBSD__
  77 #include <sys/ioctl.h>
  78 #include <sys/disklabel.h>
  79 #include <sys/dkio.h>
  80 #include <sys/disk.h>
  81 #endif
  82
  83 #ifdef __DragonFly__
  84 #include <sys/ioctl.h>
  85 #include <sys/diskslice.h>
  86 #endif
  87
  88 #ifdef CONFIG_XFS
  89 #include <xfs/xfs.h>
  90 #endif
  91
  92 //#define DEBUG_FLOPPY
  93
  94 //#define DEBUG_BLOCK
  95 #if defined(DEBUG_BLOCK)
  96 #define DEBUG_BLOCK_PRINT(formatCstr, ...) do { if (qemu_log_enabled()) \
  97     { qemu_log(formatCstr, ## __VA_ARGS__); qemu_log_flush(); } } while (0)
  98 #else
  99 #define DEBUG_BLOCK_PRINT(formatCstr, ...)
 100 #endif
 101
 102 /* OS X does not have O_DSYNC */
 103 #ifndef O_DSYNC
 104 #ifdef O_SYNC
 105 #define O_DSYNC O_SYNC
 106 #elif defined(O_FSYNC)
 107 #define O_DSYNC O_FSYNC
 108 #endif
 109 #endif
 110
 111 /* Approximate O_DIRECT with O_DSYNC if O_DIRECT isn't available */
 112 #ifndef O_DIRECT
 113 #define O_DIRECT O_DSYNC
 114 #endif
 115
 116 #define FTYPE_FILE   0
 117 #define FTYPE_CD     1
 118 #define FTYPE_FD     2
 119
 120 /* if the FD is not accessed during that time (in ns), we try to
 121    reopen it to see if the disk has been changed */
 122 #define FD_OPEN_TIMEOUT (1000000000)
 123
 124 #define MAX_BLOCKSIZE   4096
 125
 126 typedef struct BDRVRawState {
 127     int fd;
 128     int type;
 129     int open_flags;
 130 #if defined(__linux__)
 131     /* linux floppy specific */
 132     int64_t fd_open_time;
 133     int64_t fd_error_time;
 134     int fd_got_error;
 135     int fd_media_changed;
 136 #endif
 137 #ifdef CONFIG_LINUX_AIO
 138     int use_aio;
 139     void *aio_ctx;
 140 #endif
 141 #ifdef CONFIG_XFS
 142     bool is_xfs : 1;
 143 #endif
 144     bool has_discard : 1;
 145 } BDRVRawState;
 146
 147 typedef struct BDRVRawReopenState {
 148     int fd;
 149     int open_flags;
 150 #ifdef CONFIG_LINUX_AIO
 151     int use_aio;
 152 #endif
 153 } BDRVRawReopenState;
 154
 155 static int fd_open(BlockDriverState *bs);
 156 static int64_t raw_getlength(BlockDriverState *bs);
 157
 158 typedef struct RawPosixAIOData {
 159     BlockDriverState *bs;
 160     int aio_fildes;
 161     union {
 162         struct iovec *aio_iov;
 163         void *aio_ioctl_buf;
 164     };
 165     int aio_niov;
 166     uint64_t aio_nbytes;
 167 #define aio_ioctl_cmd   aio_nbytes /* for QEMU_AIO_IOCTL */
 168     off_t aio_offset;
 169     int aio_type;
 170 } RawPosixAIOData;
 171
 172 #if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
 173 static int cdrom_reopen(BlockDriverState *bs);
 174 #endif
 175
 176 #if defined(__NetBSD__)
 177 static int raw_normalize_devicepath(const char **filename)
 178 {
 179     static char namebuf[PATH_MAX];
 180     const char *dp, *fname;
 181     struct stat sb;
 182
 183     fname = *filename;
 184     dp = strrchr(fname, '/');
 185     if (lstat(fname, &sb) < 0) {
 186         fprintf(stderr, "%s: stat failed: %s\n",
 187             fname, strerror(errno));
 188         return -errno;
 189     }
 190
 191     if (!S_ISBLK(sb.st_mode)) {
 192         return 0;
 193     }
 194
 195     if (dp == NULL) {
 196         snprintf(namebuf, PATH_MAX, "r%s", fname);
 197     } else {
 198         snprintf(namebuf, PATH_MAX, "%.*s/r%s",
 199             (int)(dp - fname), fname, dp + 1);
 200     }
 201     fprintf(stderr, "%s is a block device", fname);
 202     *filename = namebuf;
 203     fprintf(stderr, ", using %s\n", *filename);
 204
 205     return 0;
 206 }
 207 #else
 208 static int raw_normalize_devicepath(const char **filename)
 209 {
 210     return 0;
 211 }
 212 #endif
 213
 214 static void raw_parse_flags(int bdrv_flags, int *open_flags)
 215 {
 216     assert(open_flags != NULL);
 217
 218     *open_flags |= O_BINARY;
 219     *open_flags &= ~O_ACCMODE;
 220     if (bdrv_flags & BDRV_O_RDWR) {
 221         *open_flags |= O_RDWR;
 222     } else {
 223         *open_flags |= O_RDONLY;
 224     }
 225
 226     /* Use O_DSYNC for write-through caching, no flags for write-back caching,
 227      * and O_DIRECT for no caching. */
 228     if ((bdrv_flags & BDRV_O_NOCACHE)) {
 229         *open_flags |= O_DIRECT;
 230     }
 231 }
 232
 233 #ifdef CONFIG_LINUX_AIO
 234 static int raw_set_aio(void **aio_ctx, int *use_aio, int bdrv_flags)
 235 {
 236     int ret = -1;
 237     assert(aio_ctx != NULL);
 238     assert(use_aio != NULL);
 239     /*
 240      * Currently Linux do AIO only for files opened with O_DIRECT
 241      * specified so check NOCACHE flag too
 242      */
 243     if ((bdrv_flags & (BDRV_O_NOCACHE|BDRV_O_NATIVE_AIO)) ==
 244                       (BDRV_O_NOCACHE|BDRV_O_NATIVE_AIO)) {
 245
 246         /* if non-NULL, laio_init() has already been run */
 247         if (*aio_ctx == NULL) {
 248             *aio_ctx = laio_init();
 249             if (!*aio_ctx) {
 250                 goto error;
 251             }
 252         }
 253         *use_aio = 1;
 254     } else {
 255         *use_aio = 0;
 256     }
 257
 258     ret = 0;
 259
 260 error:
 261     return ret;
 262 }
 263 #endif
 264
 265 static int raw_open_common(BlockDriverState *bs, const char *filename,
 266                            int bdrv_flags, int open_flags)
 267 {
 268     BDRVRawState *s = bs->opaque;
 269     int fd, ret;
 270
 271     ret = raw_normalize_devicepath(&filename);
 272     if (ret != 0) {
 273         return ret;
 274     }
 275
 276     s->open_flags = open_flags;
 277     raw_parse_flags(bdrv_flags, &s->open_flags);
 278
 279     s->fd = -1;
 280     fd = qemu_open(filename, s->open_flags, 0644);
 281     if (fd < 0) {
 282         ret = -errno;
 283         if (ret == -EROFS)
 284             ret = -EACCES;
 285         return ret;
 286     }
 287     s->fd = fd;
 288
 289 #ifdef CONFIG_LINUX_AIO
 290     if (raw_set_aio(&s->aio_ctx, &s->use_aio, bdrv_flags)) {
 291         qemu_close(fd);
 292         return -errno;
 293     }
 294 #endif
 295
 296     s->has_discard = 1;
 297 #ifdef CONFIG_XFS
 298     if (platform_test_xfs_fd(s->fd)) {
 299         s->is_xfs = 1;
 300     }
 301 #endif
 302
 303     return 0;
 304 }
 305
 306 static int raw_open(BlockDriverState *bs, const char *filename, int flags)
 307 {
 308     BDRVRawState *s = bs->opaque;
 309
 310     s->type = FTYPE_FILE;
 311     return raw_open_common(bs, filename, flags, 0);
 312 }
 313
 314 static int raw_reopen_prepare(BDRVReopenState *state,
 315                               BlockReopenQueue *queue, Error **errp)
 316 {
 317     BDRVRawState *s;
 318     BDRVRawReopenState *raw_s;
 319     int ret = 0;
 320
 321     assert(state != NULL);
 322     assert(state->bs != NULL);
 323
 324     s = state->bs->opaque;
 325
 326     state->opaque = g_malloc0(sizeof(BDRVRawReopenState));
 327     raw_s = state->opaque;
 328
 329 #ifdef CONFIG_LINUX_AIO
 330     raw_s->use_aio = s->use_aio;
 331
 332     /* we can use s->aio_ctx instead of a copy, because the use_aio flag is
 333      * valid in the 'false' condition even if aio_ctx is set, and raw_set_aio()
 334      * won't override aio_ctx if aio_ctx is non-NULL */
 335     if (raw_set_aio(&s->aio_ctx, &raw_s->use_aio, state->flags)) {
 336         return -1;
 337     }
 338 #endif
 339
 340     if (s->type == FTYPE_FD || s->type == FTYPE_CD) {
 341         raw_s->open_flags |= O_NONBLOCK;
 342     }
 343
 344     raw_parse_flags(state->flags, &raw_s->open_flags);
 345
 346     raw_s->fd = -1;
 347
 348     int fcntl_flags = O_APPEND | O_NONBLOCK;
 349 #ifdef O_NOATIME
 350     fcntl_flags |= O_NOATIME;
 351 #endif
 352
 353 #ifdef O_ASYNC
 354     /* Not all operating systems have O_ASYNC, and those that don't
 355      * will not let us track the state into raw_s->open_flags (typically
 356      * you achieve the same effect with an ioctl, for example I_SETSIG
 357      * on Solaris). But we do not use O_ASYNC, so that's fine.
 358      */
 359     assert((s->open_flags & O_ASYNC) == 0);
 360 #endif
 361
 362     if ((raw_s->open_flags & ~fcntl_flags) == (s->open_flags & ~fcntl_flags)) {
 363         /* dup the original fd */
 364         /* TODO: use qemu fcntl wrapper */
 365 #ifdef F_DUPFD_CLOEXEC
 366         raw_s->fd = fcntl(s->fd, F_DUPFD_CLOEXEC, 0);
 367 #else
 368         raw_s->fd = dup(s->fd);
 369         if (raw_s->fd != -1) {
 370             qemu_set_cloexec(raw_s->fd);
 371         }
 372 #endif
 373         if (raw_s->fd >= 0) {
 374             ret = fcntl_setfl(raw_s->fd, raw_s->open_flags);
 375             if (ret) {
 376                 qemu_close(raw_s->fd);
 377                 raw_s->fd = -1;
 378             }
 379         }
 380     }
 381
 382     /* If we cannot use fcntl, or fcntl failed, fall back to qemu_open() */
 383     if (raw_s->fd == -1) {
 384         assert(!(raw_s->open_flags & O_CREAT));
 385         raw_s->fd = qemu_open(state->bs->filename, raw_s->open_flags);
 386         if (raw_s->fd == -1) {
 387             ret = -1;
 388         }
 389     }
 390     return ret;
 391 }
 392
 393
 394 static void raw_reopen_commit(BDRVReopenState *state)
 395 {
 396     BDRVRawReopenState *raw_s = state->opaque;
 397     BDRVRawState *s = state->bs->opaque;
 398
 399     s->open_flags = raw_s->open_flags;
 400
 401     qemu_close(s->fd);
 402     s->fd = raw_s->fd;
 403 #ifdef CONFIG_LINUX_AIO
 404     s->use_aio = raw_s->use_aio;
 405 #endif
 406
 407     g_free(state->opaque);
 408     state->opaque = NULL;
 409 }
 410
 411
 412 static void raw_reopen_abort(BDRVReopenState *state)
 413 {
 414     BDRVRawReopenState *raw_s = state->opaque;
 415
 416      /* nothing to do if NULL, we didn't get far enough */
 417     if (raw_s == NULL) {
 418         return;
 419     }
 420
 421     if (raw_s->fd >= 0) {
 422         qemu_close(raw_s->fd);
 423         raw_s->fd = -1;
 424     }
 425     g_free(state->opaque);
 426     state->opaque = NULL;
 427 }
 428
 429
 430 /* XXX: use host sector size if necessary with:
 431 #ifdef DIOCGSECTORSIZE
 432         {
 433             unsigned int sectorsize = 512;
 434             if (!ioctl(fd, DIOCGSECTORSIZE, &sectorsize) &&
 435                 sectorsize > bufsize)
 436                 bufsize = sectorsize;
 437         }
 438 #endif
 439 #ifdef CONFIG_COCOA
 440         uint32_t blockSize = 512;
 441         if ( !ioctl( fd, DKIOCGETBLOCKSIZE, &blockSize ) && blockSize > bufsize) {
 442             bufsize = blockSize;
 443         }
 444 #endif
 445 */
 446
 447 static ssize_t handle_aiocb_ioctl(RawPosixAIOData *aiocb)
 448 {
 449     int ret;
 450
 451     ret = ioctl(aiocb->aio_fildes, aiocb->aio_ioctl_cmd, aiocb->aio_ioctl_buf);
 452     if (ret == -1) {
 453         return -errno;
 454     }
 455
 456     return 0;
 457 }
 458
 459 static ssize_t handle_aiocb_flush(RawPosixAIOData *aiocb)
 460 {
 461     int ret;
 462
 463     ret = qemu_fdatasync(aiocb->aio_fildes);
 464     if (ret == -1) {
 465         return -errno;
 466     }
 467     return 0;
 468 }
 469
 470 #ifdef CONFIG_PREADV
 471
 472 static bool preadv_present = true;
 473
 474 static ssize_t
 475 qemu_preadv(int fd, const struct iovec *iov, int nr_iov, off_t offset)
 476 {
 477     return preadv(fd, iov, nr_iov, offset);
 478 }
 479
 480 static ssize_t
 481 qemu_pwritev(int fd, const struct iovec *iov, int nr_iov, off_t offset)
 482 {
 483     return pwritev(fd, iov, nr_iov, offset);
 484 }
 485
 486 #else
 487
 488 static bool preadv_present = false;
 489
 490 static ssize_t
 491 qemu_preadv(int fd, const struct iovec *iov, int nr_iov, off_t offset)
 492 {
 493     return -ENOSYS;
 494 }
 495
 496 static ssize_t
 497 qemu_pwritev(int fd, const struct iovec *iov, int nr_iov, off_t offset)
 498 {
 499     return -ENOSYS;
 500 }
 501
 502 #endif
 503
 504 static ssize_t handle_aiocb_rw_vector(RawPosixAIOData *aiocb)
 505 {
 506     ssize_t len;
 507
 508     do {
 509         if (aiocb->aio_type & QEMU_AIO_WRITE)
 510             len = qemu_pwritev(aiocb->aio_fildes,
 511                                aiocb->aio_iov,
 512                                aiocb->aio_niov,
 513                                aiocb->aio_offset);
 514          else
 515             len = qemu_preadv(aiocb->aio_fildes,
 516                               aiocb->aio_iov,
 517                               aiocb->aio_niov,
 518                               aiocb->aio_offset);
 519     } while (len == -1 && errno == EINTR);
 520
 521     if (len == -1) {
 522         return -errno;
 523     }
 524     return len;
 525 }
 526
 527 /*
 528  * Read/writes the data to/from a given linear buffer.
 529  *
 530  * Returns the number of bytes handles or -errno in case of an error. Short
 531  * reads are only returned if the end of the file is reached.
 532  */
 533 static ssize_t handle_aiocb_rw_linear(RawPosixAIOData *aiocb, char *buf)
 534 {
 535     ssize_t offset = 0;
 536     ssize_t len;
 537
 538     while (offset < aiocb->aio_nbytes) {
 539         if (aiocb->aio_type & QEMU_AIO_WRITE) {
 540             len = pwrite(aiocb->aio_fildes,
 541                          (const char *)buf + offset,
 542                          aiocb->aio_nbytes - offset,
 543                          aiocb->aio_offset + offset);
 544         } else {
 545             len = pread(aiocb->aio_fildes,
 546                         buf + offset,
 547                         aiocb->aio_nbytes - offset,
 548                         aiocb->aio_offset + offset);
 549         }
 550         if (len == -1 && errno == EINTR) {
 551             continue;
 552         } else if (len == -1) {
 553             offset = -errno;
 554             break;
 555         } else if (len == 0) {
 556             break;
 557         }
 558         offset += len;
 559     }
 560
 561     return offset;
 562 }
 563
 564 static ssize_t handle_aiocb_rw(RawPosixAIOData *aiocb)
 565 {
 566     ssize_t nbytes;
 567     char *buf;
 568
 569     if (!(aiocb->aio_type & QEMU_AIO_MISALIGNED)) {
 570         /*
 571          * If there is just a single buffer, and it is properly aligned
 572          * we can just use plain pread/pwrite without any problems.
 573          */
 574         if (aiocb->aio_niov == 1) {
 575              return handle_aiocb_rw_linear(aiocb, aiocb->aio_iov->iov_base);
 576         }
 577         /*
 578          * We have more than one iovec, and all are properly aligned.
 579          *
 580          * Try preadv/pwritev first and fall back to linearizing the
 581          * buffer if it's not supported.
 582          */
 583         if (preadv_present) {
 584             nbytes = handle_aiocb_rw_vector(aiocb);
 585             if (nbytes == aiocb->aio_nbytes ||
 586                 (nbytes < 0 && nbytes != -ENOSYS)) {
 587                 return nbytes;
 588             }
 589             preadv_present = false;
 590         }
 591
 592         /*
 593          * XXX(hch): short read/write.  no easy way to handle the reminder
 594          * using these interfaces.  For now retry using plain
 595          * pread/pwrite?
 596          */
 597     }
 598
 599     /*
 600      * Ok, we have to do it the hard way, copy all segments into
 601      * a single aligned buffer.
 602      */
 603     buf = qemu_blockalign(aiocb->bs, aiocb->aio_nbytes);
 604     if (aiocb->aio_type & QEMU_AIO_WRITE) {
 605         char *p = buf;
 606         int i;
 607
 608         for (i = 0; i < aiocb->aio_niov; ++i) {
 609             memcpy(p, aiocb->aio_iov[i].iov_base, aiocb->aio_iov[i].iov_len);
 610             p += aiocb->aio_iov[i].iov_len;
 611         }
 612     }
 613
 614     nbytes = handle_aiocb_rw_linear(aiocb, buf);
 615     if (!(aiocb->aio_type & QEMU_AIO_WRITE)) {
 616         char *p = buf;
 617         size_t count = aiocb->aio_nbytes, copy;
 618         int i;
 619
 620         for (i = 0; i < aiocb->aio_niov && count; ++i) {
 621             copy = count;
 622             if (copy > aiocb->aio_iov[i].iov_len) {
 623                 copy = aiocb->aio_iov[i].iov_len;
 624             }
 625             memcpy(aiocb->aio_iov[i].iov_base, p, copy);
 626             p     += copy;
 627             count -= copy;
 628         }
 629     }
 630     qemu_vfree(buf);
 631
 632     return nbytes;
 633 }
 634
 635 #ifdef CONFIG_XFS
 636 static int xfs_discard(BDRVRawState *s, int64_t offset, uint64_t bytes)
 637 {
 638     struct xfs_flock64 fl;
 639
 640     memset(&fl, 0, sizeof(fl));
 641     fl.l_whence = SEEK_SET;
 642     fl.l_start = offset;
 643     fl.l_len = bytes;
 644
 645     if (xfsctl(NULL, s->fd, XFS_IOC_UNRESVSP64, &fl) < 0) {
 646         DEBUG_BLOCK_PRINT("cannot punch hole (%s)\n", strerror(errno));
 647         return -errno;
 648     }
 649
 650     return 0;
 651 }
 652 #endif
 653
 654 static ssize_t handle_aiocb_discard(RawPosixAIOData *aiocb)
 655 {
 656     int ret = -EOPNOTSUPP;
 657     BDRVRawState *s = aiocb->bs->opaque;
 658
 659     if (s->has_discard == 0) {
 660         return 0;
 661     }
 662
 663     if (aiocb->aio_type & QEMU_AIO_BLKDEV) {
 664 #ifdef BLKDISCARD
 665         do {
 666             uint64_t range[2] = { aiocb->aio_offset, aiocb->aio_nbytes };
 667             if (ioctl(aiocb->aio_fildes, BLKDISCARD, range) == 0) {
 668                 return 0;
 669             }
 670         } while (errno == EINTR);
 671
 672         ret = -errno;
 673 #endif
 674     } else {
 675 #ifdef CONFIG_XFS
 676         if (s->is_xfs) {
 677             return xfs_discard(s, aiocb->aio_offset, aiocb->aio_nbytes);
 678         }
 679 #endif
 680
 681 #ifdef CONFIG_FALLOCATE_PUNCH_HOLE
 682         do {
 683             if (fallocate(s->fd, FALLOC_FL_PUNCH_HOLE | FALLOC_FL_KEEP_SIZE,
 684                           aiocb->aio_offset, aiocb->aio_nbytes) == 0) {
 685                 return 0;
 686             }
 687         } while (errno == EINTR);
 688
 689         ret = -errno;
 690 #endif
 691     }
 692
 693     if (ret == -ENODEV || ret == -ENOSYS || ret == -EOPNOTSUPP ||
 694         ret == -ENOTTY) {
 695         s->has_discard = 0;
 696         ret = 0;
 697     }
 698     return ret;
 699 }
 700
 701 static int aio_worker(void *arg)
 702 {
 703     RawPosixAIOData *aiocb = arg;
 704     ssize_t ret = 0;
 705
 706     switch (aiocb->aio_type & QEMU_AIO_TYPE_MASK) {
 707     case QEMU_AIO_READ:
 708         ret = handle_aiocb_rw(aiocb);
 709         if (ret >= 0 && ret < aiocb->aio_nbytes && aiocb->bs->growable) {
 710             iov_memset(aiocb->aio_iov, aiocb->aio_niov, ret,
 711                       0, aiocb->aio_nbytes - ret);
 712
 713             ret = aiocb->aio_nbytes;
 714         }
 715         if (ret == aiocb->aio_nbytes) {
 716             ret = 0;
 717         } else if (ret >= 0 && ret < aiocb->aio_nbytes) {
 718             ret = -EINVAL;
 719         }
 720         break;
 721     case QEMU_AIO_WRITE:
 722         ret = handle_aiocb_rw(aiocb);
 723         if (ret == aiocb->aio_nbytes) {
 724             ret = 0;
 725         } else if (ret >= 0 && ret < aiocb->aio_nbytes) {
 726             ret = -EINVAL;
 727         }
 728         break;
 729     case QEMU_AIO_FLUSH:
 730         ret = handle_aiocb_flush(aiocb);
 731         break;
 732     case QEMU_AIO_IOCTL:
 733         ret = handle_aiocb_ioctl(aiocb);
 734         break;
 735     case QEMU_AIO_DISCARD:
 736         ret = handle_aiocb_discard(aiocb);
 737         break;
 738     default:
 739         fprintf(stderr, "invalid aio request (0x%x)\n", aiocb->aio_type);
 740         ret = -EINVAL;
 741         break;
 742     }
 743
 744     g_slice_free(RawPosixAIOData, aiocb);
 745     return ret;
 746 }
 747
 748 static BlockDriverAIOCB *paio_submit(BlockDriverState *bs, int fd,
 749         int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
 750         BlockDriverCompletionFunc *cb, void *opaque, int type)
 751 {
 752     RawPosixAIOData *acb = g_slice_new(RawPosixAIOData);
 753
 754     acb->bs = bs;
 755     acb->aio_type = type;
 756     acb->aio_fildes = fd;
 757
 758     if (qiov) {
 759         acb->aio_iov = qiov->iov;
 760         acb->aio_niov = qiov->niov;
 761     }
 762     acb->aio_nbytes = nb_sectors * 512;
 763     acb->aio_offset = sector_num * 512;
 764
 765     trace_paio_submit(acb, opaque, sector_num, nb_sectors, type);
 766     return thread_pool_submit_aio(aio_worker, acb, cb, opaque);
 767 }
 768
 769 static BlockDriverAIOCB *raw_aio_submit(BlockDriverState *bs,
 770         int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
 771         BlockDriverCompletionFunc *cb, void *opaque, int type)
 772 {
 773     BDRVRawState *s = bs->opaque;
 774
 775     if (fd_open(bs) < 0)
 776         return NULL;
 777
 778     /*
 779      * If O_DIRECT is used the buffer needs to be aligned on a sector
 780      * boundary.  Check if this is the case or tell the low-level
 781      * driver that it needs to copy the buffer.
 782      */
 783     if ((bs->open_flags & BDRV_O_NOCACHE)) {
 784         if (!bdrv_qiov_is_aligned(bs, qiov)) {
 785             type |= QEMU_AIO_MISALIGNED;
 786 #ifdef CONFIG_LINUX_AIO
 787         } else if (s->use_aio) {
 788             return laio_submit(bs, s->aio_ctx, s->fd, sector_num, qiov,
 789                                nb_sectors, cb, opaque, type);
 790 #endif
 791         }
 792     }
 793
 794     return paio_submit(bs, s->fd, sector_num, qiov, nb_sectors,
 795                        cb, opaque, type);
 796 }
 797
 798 static BlockDriverAIOCB *raw_aio_readv(BlockDriverState *bs,
 799         int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
 800         BlockDriverCompletionFunc *cb, void *opaque)
 801 {
 802     return raw_aio_submit(bs, sector_num, qiov, nb_sectors,
 803                           cb, opaque, QEMU_AIO_READ);
 804 }
 805
 806 static BlockDriverAIOCB *raw_aio_writev(BlockDriverState *bs,
 807         int64_t sector_num, QEMUIOVector *qiov, int nb_sectors,
 808         BlockDriverCompletionFunc *cb, void *opaque)
 809 {
 810     return raw_aio_submit(bs, sector_num, qiov, nb_sectors,
 811                           cb, opaque, QEMU_AIO_WRITE);
 812 }
 813
 814 static BlockDriverAIOCB *raw_aio_flush(BlockDriverState *bs,
 815         BlockDriverCompletionFunc *cb, void *opaque)
 816 {
 817     BDRVRawState *s = bs->opaque;
 818
 819     if (fd_open(bs) < 0)
 820         return NULL;
 821
 822     return paio_submit(bs, s->fd, 0, NULL, 0, cb, opaque, QEMU_AIO_FLUSH);
 823 }
 824
 825 static void raw_close(BlockDriverState *bs)
 826 {
 827     BDRVRawState *s = bs->opaque;
 828     if (s->fd >= 0) {
 829         qemu_close(s->fd);
 830         s->fd = -1;
 831     }
 832 }
 833
 834 static int raw_truncate(BlockDriverState *bs, int64_t offset)
 835 {
 836     BDRVRawState *s = bs->opaque;
 837     struct stat st;
 838
 839     if (fstat(s->fd, &st)) {
 840         return -errno;
 841     }
 842
 843     if (S_ISREG(st.st_mode)) {
 844         if (ftruncate(s->fd, offset) < 0) {
 845             return -errno;
 846         }
 847     } else if (S_ISCHR(st.st_mode) || S_ISBLK(st.st_mode)) {
 848        if (offset > raw_getlength(bs)) {
 849            return -EINVAL;
 850        }
 851     } else {
 852         return -ENOTSUP;
 853     }
 854
 855     return 0;
 856 }
 857
 858 #ifdef __OpenBSD__
 859 static int64_t raw_getlength(BlockDriverState *bs)
 860 {
 861     BDRVRawState *s = bs->opaque;
 862     int fd = s->fd;
 863     struct stat st;
 864
 865     if (fstat(fd, &st))
 866         return -1;
 867     if (S_ISCHR(st.st_mode) || S_ISBLK(st.st_mode)) {
 868         struct disklabel dl;
 869
 870         if (ioctl(fd, DIOCGDINFO, &dl))
 871             return -1;
 872         return (uint64_t)dl.d_secsize *
 873             dl.d_partitions[DISKPART(st.st_rdev)].p_size;
 874     } else
 875         return st.st_size;
 876 }
 877 #elif defined(__NetBSD__)
 878 static int64_t raw_getlength(BlockDriverState *bs)
 879 {
 880     BDRVRawState *s = bs->opaque;
 881     int fd = s->fd;
 882     struct stat st;
 883
 884     if (fstat(fd, &st))
 885         return -1;
 886     if (S_ISCHR(st.st_mode) || S_ISBLK(st.st_mode)) {
 887         struct dkwedge_info dkw;
 888
 889         if (ioctl(fd, DIOCGWEDGEINFO, &dkw) != -1) {
 890             return dkw.dkw_size * 512;
 891         } else {
 892             struct disklabel dl;
 893
 894             if (ioctl(fd, DIOCGDINFO, &dl))
 895                 return -1;
 896             return (uint64_t)dl.d_secsize *
 897                 dl.d_partitions[DISKPART(st.st_rdev)].p_size;
 898         }
 899     } else
 900         return st.st_size;
 901 }
 902 #elif defined(__sun__)
 903 static int64_t raw_getlength(BlockDriverState *bs)
 904 {
 905     BDRVRawState *s = bs->opaque;
 906     struct dk_minfo minfo;
 907     int ret;
 908
 909     ret = fd_open(bs);
 910     if (ret < 0) {
 911         return ret;
 912     }
 913
 914     /*
 915      * Use the DKIOCGMEDIAINFO ioctl to read the size.
 916      */
 917     ret = ioctl(s->fd, DKIOCGMEDIAINFO, &minfo);
 918     if (ret != -1) {
 919         return minfo.dki_lbsize * minfo.dki_capacity;
 920     }
 921
 922     /*
 923      * There are reports that lseek on some devices fails, but
 924      * irc discussion said that contingency on contingency was overkill.
 925      */
 926     return lseek(s->fd, 0, SEEK_END);
 927 }
 928 #elif defined(CONFIG_BSD)
 929 static int64_t raw_getlength(BlockDriverState *bs)
 930 {
 931     BDRVRawState *s = bs->opaque;
 932     int fd = s->fd;
 933     int64_t size;
 934     struct stat sb;
 935 #if defined (__FreeBSD__) || defined(__FreeBSD_kernel__)
 936     int reopened = 0;
 937 #endif
 938     int ret;
 939
 940     ret = fd_open(bs);
 941     if (ret < 0)
 942         return ret;
 943
 944 #if defined (__FreeBSD__) || defined(__FreeBSD_kernel__)
 945 again:
 946 #endif
 947     if (!fstat(fd, &sb) && (S_IFCHR & sb.st_mode)) {
 948 #ifdef DIOCGMEDIASIZE
 949         if (ioctl(fd, DIOCGMEDIASIZE, (off_t *)&size))
 950 #elif defined(DIOCGPART)
 951         {
 952                 struct partinfo pi;
 953                 if (ioctl(fd, DIOCGPART, &pi) == 0)
 954                         size = pi.media_size;
 955                 else
 956                         size = 0;
 957         }
 958         if (size == 0)
 959 #endif
 960 #if defined(__APPLE__) && defined(__MACH__)
 961         size = LONG_LONG_MAX;
 962 #else
 963         size = lseek(fd, 0LL, SEEK_END);
 964 #endif
 965 #if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
 966         switch(s->type) {
 967         case FTYPE_CD:
 968             /* XXX FreeBSD acd returns UINT_MAX sectors for an empty drive */
 969             if (size == 2048LL * (unsigned)-1)
 970                 size = 0;
 971             /* XXX no disc?  maybe we need to reopen... */
 972             if (size <= 0 && !reopened && cdrom_reopen(bs) >= 0) {
 973                 reopened = 1;
 974                 goto again;
 975             }
 976         }
 977 #endif
 978     } else {
 979         size = lseek(fd, 0, SEEK_END);
 980     }
 981     return size;
 982 }
 983 #else
 984 static int64_t raw_getlength(BlockDriverState *bs)
 985 {
 986     BDRVRawState *s = bs->opaque;
 987     int ret;
 988
 989     ret = fd_open(bs);
 990     if (ret < 0) {
 991         return ret;
 992     }
 993
 994     return lseek(s->fd, 0, SEEK_END);
 995 }
 996 #endif
 997
 998 static int64_t raw_get_allocated_file_size(BlockDriverState *bs)
 999 {
1000     struct stat st;
1001     BDRVRawState *s = bs->opaque;
1002
1003     if (fstat(s->fd, &st) < 0) {
1004         return -errno;
1005     }
1006     return (int64_t)st.st_blocks * 512;
1007 }
1008
1009 static int raw_create(const char *filename, QEMUOptionParameter *options)
1010 {
1011     int fd;
1012     int result = 0;
1013     int64_t total_size = 0;
1014
1015     /* Read out options */
1016     while (options && options->name) {
1017         if (!strcmp(options->name, BLOCK_OPT_SIZE)) {
1018             total_size = options->value.n / BDRV_SECTOR_SIZE;
1019         }
1020         options++;
1021     }
1022
1023     fd = qemu_open(filename, O_WRONLY | O_CREAT | O_TRUNC | O_BINARY,
1024                    0644);
1025     if (fd < 0) {
1026         result = -errno;
1027     } else {
1028         if (ftruncate(fd, total_size * BDRV_SECTOR_SIZE) != 0) {
1029             result = -errno;
1030         }
1031         if (qemu_close(fd) != 0) {
1032             result = -errno;
1033         }
1034     }
1035     return result;
1036 }
1037
1038 /*
1039  * Returns true iff the specified sector is present in the disk image. Drivers
1040  * not implementing the functionality are assumed to not support backing files,
1041  * hence all their sectors are reported as allocated.
1042  *
1043  * If 'sector_num' is beyond the end of the disk image the return value is 0
1044  * and 'pnum' is set to 0.
1045  *
1046  * 'pnum' is set to the number of sectors (including and immediately following
1047  * the specified sector) that are known to be in the same
1048  * allocated/unallocated state.
1049  *
1050  * 'nb_sectors' is the max value 'pnum' should be set to.  If nb_sectors goes
1051  * beyond the end of the disk image it will be clamped.
1052  */
1053 static int coroutine_fn raw_co_is_allocated(BlockDriverState *bs,
1054                                             int64_t sector_num,
1055                                             int nb_sectors, int *pnum)
1056 {
1057     off_t start, data, hole;
1058     int ret;
1059
1060     ret = fd_open(bs);
1061     if (ret < 0) {
1062         return ret;
1063     }
1064
1065     start = sector_num * BDRV_SECTOR_SIZE;
1066
1067 #ifdef CONFIG_FIEMAP
1068
1069     BDRVRawState *s = bs->opaque;
1070     struct {
1071         struct fiemap fm;
1072         struct fiemap_extent fe;
1073     } f;
1074
1075     f.fm.fm_start = start;
1076     f.fm.fm_length = (int64_t)nb_sectors * BDRV_SECTOR_SIZE;
1077     f.fm.fm_flags = 0;
1078     f.fm.fm_extent_count = 1;
1079     f.fm.fm_reserved = 0;
1080     if (ioctl(s->fd, FS_IOC_FIEMAP, &f) == -1) {
1081         /* Assume everything is allocated.  */
1082         *pnum = nb_sectors;
1083         return 1;
1084     }
1085
1086     if (f.fm.fm_mapped_extents == 0) {
1087         /* No extents found, data is beyond f.fm.fm_start + f.fm.fm_length.
1088          * f.fm.fm_start + f.fm.fm_length must be clamped to the file size!
1089          */
1090         off_t length = lseek(s->fd, 0, SEEK_END);
1091         hole = f.fm.fm_start;
1092         data = MIN(f.fm.fm_start + f.fm.fm_length, length);
1093     } else {
1094         data = f.fe.fe_logical;
1095         hole = f.fe.fe_logical + f.fe.fe_length;
1096     }
1097
1098 #elif defined SEEK_HOLE && defined SEEK_DATA
1099
1100     BDRVRawState *s = bs->opaque;
1101
1102     hole = lseek(s->fd, start, SEEK_HOLE);
1103     if (hole == -1) {
1104         /* -ENXIO indicates that sector_num was past the end of the file.
1105          * There is a virtual hole there.  */
1106         assert(errno != -ENXIO);
1107
1108         /* Most likely EINVAL.  Assume everything is allocated.  */
1109         *pnum = nb_sectors;
1110         return 1;
1111     }
1112
1113     if (hole > start) {
1114         data = start;
1115     } else {
1116         /* On a hole.  We need another syscall to find its end.  */
1117         data = lseek(s->fd, start, SEEK_DATA);
1118         if (data == -1) {
1119             data = lseek(s->fd, 0, SEEK_END);
1120         }
1121     }
1122 #else
1123     *pnum = nb_sectors;
1124     return 1;
1125 #endif
1126
1127     if (data <= start) {
1128         /* On a data extent, compute sectors to the end of the extent.  */
1129         *pnum = MIN(nb_sectors, (hole - start) / BDRV_SECTOR_SIZE);
1130         return 1;
1131     } else {
1132         /* On a hole, compute sectors to the beginning of the next extent.  */
1133         *pnum = MIN(nb_sectors, (data - start) / BDRV_SECTOR_SIZE);
1134         return 0;
1135     }
1136 }
1137
1138 static coroutine_fn BlockDriverAIOCB *raw_aio_discard(BlockDriverState *bs,
1139     int64_t sector_num, int nb_sectors,
1140     BlockDriverCompletionFunc *cb, void *opaque)
1141 {
1142     BDRVRawState *s = bs->opaque;
1143
1144     return paio_submit(bs, s->fd, sector_num, NULL, nb_sectors,
1145                        cb, opaque, QEMU_AIO_DISCARD);
1146 }
1147
1148 static QEMUOptionParameter raw_create_options[] = {
1149     {
1150         .name = BLOCK_OPT_SIZE,
1151         .type = OPT_SIZE,
1152         .help = "Virtual disk size"
1153     },
1154     { NULL }
1155 };
1156
1157 static BlockDriver bdrv_file = {
1158     .format_name = "file",
1159     .protocol_name = "file",
1160     .instance_size = sizeof(BDRVRawState),
1161     .bdrv_probe = NULL, /* no probe for protocols */
1162     .bdrv_file_open = raw_open,
1163     .bdrv_reopen_prepare = raw_reopen_prepare,
1164     .bdrv_reopen_commit = raw_reopen_commit,
1165     .bdrv_reopen_abort = raw_reopen_abort,
1166     .bdrv_close = raw_close,
1167     .bdrv_create = raw_create,
1168     .bdrv_co_is_allocated = raw_co_is_allocated,
1169
1170     .bdrv_aio_readv = raw_aio_readv,
1171     .bdrv_aio_writev = raw_aio_writev,
1172     .bdrv_aio_flush = raw_aio_flush,
1173     .bdrv_aio_discard = raw_aio_discard,
1174
1175     .bdrv_truncate = raw_truncate,
1176     .bdrv_getlength = raw_getlength,
1177     .bdrv_get_allocated_file_size
1178                         = raw_get_allocated_file_size,
1179
1180     .create_options = raw_create_options,
1181 };
1182
1183 /***********************************************/
1184 /* host device */
1185
1186 #if defined(__APPLE__) && defined(__MACH__)
1187 static kern_return_t FindEjectableCDMedia( io_iterator_t *mediaIterator );
1188 static kern_return_t GetBSDPath( io_iterator_t mediaIterator, char *bsdPath, CFIndex maxPathSize );
1189
1190 kern_return_t FindEjectableCDMedia( io_iterator_t *mediaIterator )
1191 {
1192     kern_return_t       kernResult;
1193     mach_port_t     masterPort;
1194     CFMutableDictionaryRef  classesToMatch;
1195
1196     kernResult = IOMasterPort( MACH_PORT_NULL, &masterPort );
1197     if ( KERN_SUCCESS != kernResult ) {
1198         printf( "IOMasterPort returned %d\n", kernResult );
1199     }
1200
1201     classesToMatch = IOServiceMatching( kIOCDMediaClass );
1202     if ( classesToMatch == NULL ) {
1203         printf( "IOServiceMatching returned a NULL dictionary.\n" );
1204     } else {
1205     CFDictionarySetValue( classesToMatch, CFSTR( kIOMediaEjectableKey ), kCFBooleanTrue );
1206     }
1207     kernResult = IOServiceGetMatchingServices( masterPort, classesToMatch, mediaIterator );
1208     if ( KERN_SUCCESS != kernResult )
1209     {
1210         printf( "IOServiceGetMatchingServices returned %d\n", kernResult );
1211     }
1212
1213     return kernResult;
1214 }
1215
1216 kern_return_t GetBSDPath( io_iterator_t mediaIterator, char *bsdPath, CFIndex maxPathSize )
1217 {
1218     io_object_t     nextMedia;
1219     kern_return_t   kernResult = KERN_FAILURE;
1220     *bsdPath = '\0';
1221     nextMedia = IOIteratorNext( mediaIterator );
1222     if ( nextMedia )
1223     {
1224         CFTypeRef   bsdPathAsCFString;
1225     bsdPathAsCFString = IORegistryEntryCreateCFProperty( nextMedia, CFSTR( kIOBSDNameKey ), kCFAllocatorDefault, 0 );
1226         if ( bsdPathAsCFString ) {
1227             size_t devPathLength;
1228             strcpy( bsdPath, _PATH_DEV );
1229             strcat( bsdPath, "r" );
1230             devPathLength = strlen( bsdPath );
1231             if ( CFStringGetCString( bsdPathAsCFString, bsdPath + devPathLength, maxPathSize - devPathLength, kCFStringEncodingASCII ) ) {
1232                 kernResult = KERN_SUCCESS;
1233             }
1234             CFRelease( bsdPathAsCFString );
1235         }
1236         IOObjectRelease( nextMedia );
1237     }
1238
1239     return kernResult;
1240 }
1241
1242 #endif
1243
1244 static int hdev_probe_device(const char *filename)
1245 {
1246     struct stat st;
1247
1248     /* allow a dedicated CD-ROM driver to match with a higher priority */
1249     if (strstart(filename, "/dev/cdrom", NULL))
1250         return 50;
1251
1252     if (stat(filename, &st) >= 0 &&
1253             (S_ISCHR(st.st_mode) || S_ISBLK(st.st_mode))) {
1254         return 100;
1255     }
1256
1257     return 0;
1258 }
1259
1260 static int hdev_open(BlockDriverState *bs, const char *filename, int flags)
1261 {
1262     BDRVRawState *s = bs->opaque;
1263
1264 #if defined(__APPLE__) && defined(__MACH__)
1265     if (strstart(filename, "/dev/cdrom", NULL)) {
1266         kern_return_t kernResult;
1267         io_iterator_t mediaIterator;
1268         char bsdPath[ MAXPATHLEN ];
1269         int fd;
1270
1271         kernResult = FindEjectableCDMedia( &mediaIterator );
1272         kernResult = GetBSDPath( mediaIterator, bsdPath, sizeof( bsdPath ) );
1273
1274         if ( bsdPath[ 0 ] != '\0' ) {
1275             strcat(bsdPath,"s0");
1276             /* some CDs don't have a partition 0 */
1277             fd = qemu_open(bsdPath, O_RDONLY | O_BINARY | O_LARGEFILE);
1278             if (fd < 0) {
1279                 bsdPath[strlen(bsdPath)-1] = '1';
1280             } else {
1281                 qemu_close(fd);
1282             }
1283             filename = bsdPath;
1284         }
1285
1286         if ( mediaIterator )
1287             IOObjectRelease( mediaIterator );
1288     }
1289 #endif
1290
1291     s->type = FTYPE_FILE;
1292 #if defined(__linux__)
1293     {
1294         char resolved_path[ MAXPATHLEN ], *temp;
1295
1296         temp = realpath(filename, resolved_path);
1297         if (temp && strstart(temp, "/dev/sg", NULL)) {
1298             bs->sg = 1;
1299         }
1300     }
1301 #endif
1302
1303     return raw_open_common(bs, filename, flags, 0);
1304 }
1305
1306 #if defined(__linux__)
1307 /* Note: we do not have a reliable method to detect if the floppy is
1308    present. The current method is to try to open the floppy at every
1309    I/O and to keep it opened during a few hundreds of ms. */
1310 static int fd_open(BlockDriverState *bs)
1311 {
1312     BDRVRawState *s = bs->opaque;
1313     int last_media_present;
1314
1315     if (s->type != FTYPE_FD)
1316         return 0;
1317     last_media_present = (s->fd >= 0);
1318     if (s->fd >= 0 &&
1319         (get_clock() - s->fd_open_time) >= FD_OPEN_TIMEOUT) {
1320         qemu_close(s->fd);
1321         s->fd = -1;
1322 #ifdef DEBUG_FLOPPY
1323         printf("Floppy closed\n");
1324 #endif
1325     }
1326     if (s->fd < 0) {
1327         if (s->fd_got_error &&
1328             (get_clock() - s->fd_error_time) < FD_OPEN_TIMEOUT) {
1329 #ifdef DEBUG_FLOPPY
1330             printf("No floppy (open delayed)\n");
1331 #endif
1332             return -EIO;
1333         }
1334         s->fd = qemu_open(bs->filename, s->open_flags & ~O_NONBLOCK);
1335         if (s->fd < 0) {
1336             s->fd_error_time = get_clock();
1337             s->fd_got_error = 1;
1338             if (last_media_present)
1339                 s->fd_media_changed = 1;
1340 #ifdef DEBUG_FLOPPY
1341             printf("No floppy\n");
1342 #endif
1343             return -EIO;
1344         }
1345 #ifdef DEBUG_FLOPPY
1346         printf("Floppy opened\n");
1347 #endif
1348     }
1349     if (!last_media_present)
1350         s->fd_media_changed = 1;
1351     s->fd_open_time = get_clock();
1352     s->fd_got_error = 0;
1353     return 0;
1354 }
1355
1356 static int hdev_ioctl(BlockDriverState *bs, unsigned long int req, void *buf)
1357 {
1358     BDRVRawState *s = bs->opaque;
1359
1360     return ioctl(s->fd, req, buf);
1361 }
1362
1363 static BlockDriverAIOCB *hdev_aio_ioctl(BlockDriverState *bs,
1364         unsigned long int req, void *buf,
1365         BlockDriverCompletionFunc *cb, void *opaque)
1366 {
1367     BDRVRawState *s = bs->opaque;
1368     RawPosixAIOData *acb;
1369
1370     if (fd_open(bs) < 0)
1371         return NULL;
1372
1373     acb = g_slice_new(RawPosixAIOData);
1374     acb->bs = bs;
1375     acb->aio_type = QEMU_AIO_IOCTL;
1376     acb->aio_fildes = s->fd;
1377     acb->aio_offset = 0;
1378     acb->aio_ioctl_buf = buf;
1379     acb->aio_ioctl_cmd = req;
1380     return thread_pool_submit_aio(aio_worker, acb, cb, opaque);
1381 }
1382
1383 #elif defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
1384 static int fd_open(BlockDriverState *bs)
1385 {
1386     BDRVRawState *s = bs->opaque;
1387
1388     /* this is just to ensure s->fd is sane (its called by io ops) */
1389     if (s->fd >= 0)
1390         return 0;
1391     return -EIO;
1392 }
1393 #else /* !linux && !FreeBSD */
1394
1395 static int fd_open(BlockDriverState *bs)
1396 {
1397     return 0;
1398 }
1399
1400 #endif /* !linux && !FreeBSD */
1401
1402 static coroutine_fn BlockDriverAIOCB *hdev_aio_discard(BlockDriverState *bs,
1403     int64_t sector_num, int nb_sectors,
1404     BlockDriverCompletionFunc *cb, void *opaque)
1405 {
1406     BDRVRawState *s = bs->opaque;
1407
1408     if (fd_open(bs) < 0) {
1409         return NULL;
1410     }
1411     return paio_submit(bs, s->fd, sector_num, NULL, nb_sectors,
1412                        cb, opaque, QEMU_AIO_DISCARD|QEMU_AIO_BLKDEV);
1413 }
1414
1415 static int hdev_create(const char *filename, QEMUOptionParameter *options)
1416 {
1417     int fd;
1418     int ret = 0;
1419     struct stat stat_buf;
1420     int64_t total_size = 0;
1421
1422     /* Read out options */
1423     while (options && options->name) {
1424         if (!strcmp(options->name, "size")) {
1425             total_size = options->value.n / BDRV_SECTOR_SIZE;
1426         }
1427         options++;
1428     }
1429
1430     fd = qemu_open(filename, O_WRONLY | O_BINARY);
1431     if (fd < 0)
1432         return -errno;
1433
1434     if (fstat(fd, &stat_buf) < 0)
1435         ret = -errno;
1436     else if (!S_ISBLK(stat_buf.st_mode) && !S_ISCHR(stat_buf.st_mode))
1437         ret = -ENODEV;
1438     else if (lseek(fd, 0, SEEK_END) < total_size * BDRV_SECTOR_SIZE)
1439         ret = -ENOSPC;
1440
1441     qemu_close(fd);
1442     return ret;
1443 }
1444
1445 static int hdev_has_zero_init(BlockDriverState *bs)
1446 {
1447     return 0;
1448 }
1449
1450 static BlockDriver bdrv_host_device = {
1451     .format_name        = "host_device",
1452     .protocol_name        = "host_device",
1453     .instance_size      = sizeof(BDRVRawState),
1454     .bdrv_probe_device  = hdev_probe_device,
1455     .bdrv_file_open     = hdev_open,
1456     .bdrv_close         = raw_close,
1457     .bdrv_reopen_prepare = raw_reopen_prepare,
1458     .bdrv_reopen_commit  = raw_reopen_commit,
1459     .bdrv_reopen_abort   = raw_reopen_abort,
1460     .bdrv_create        = hdev_create,
1461     .create_options     = raw_create_options,
1462     .bdrv_has_zero_init = hdev_has_zero_init,
1463
1464     .bdrv_aio_readv     = raw_aio_readv,
1465     .bdrv_aio_writev    = raw_aio_writev,
1466     .bdrv_aio_flush     = raw_aio_flush,
1467     .bdrv_aio_discard   = hdev_aio_discard,
1468
1469     .bdrv_truncate      = raw_truncate,
1470     .bdrv_getlength     = raw_getlength,
1471     .bdrv_get_allocated_file_size
1472                         = raw_get_allocated_file_size,
1473
1474     /* generic scsi device */
1475 #ifdef __linux__
1476     .bdrv_ioctl         = hdev_ioctl,
1477     .bdrv_aio_ioctl     = hdev_aio_ioctl,
1478 #endif
1479 };
1480
1481 #ifdef __linux__
1482 static int floppy_open(BlockDriverState *bs, const char *filename, int flags)
1483 {
1484     BDRVRawState *s = bs->opaque;
1485     int ret;
1486
1487     s->type = FTYPE_FD;
1488
1489     /* open will not fail even if no floppy is inserted, so add O_NONBLOCK */
1490     ret = raw_open_common(bs, filename, flags, O_NONBLOCK);
1491     if (ret)
1492         return ret;
1493
1494     /* close fd so that we can reopen it as needed */
1495     qemu_close(s->fd);
1496     s->fd = -1;
1497     s->fd_media_changed = 1;
1498
1499     return 0;
1500 }
1501
1502 static int floppy_probe_device(const char *filename)
1503 {
1504     int fd, ret;
1505     int prio = 0;
1506     struct floppy_struct fdparam;
1507     struct stat st;
1508
1509     if (strstart(filename, "/dev/fd", NULL) &&
1510         !strstart(filename, "/dev/fdset/", NULL)) {
1511         prio = 50;
1512     }
1513
1514     fd = qemu_open(filename, O_RDONLY | O_NONBLOCK);
1515     if (fd < 0) {
1516         goto out;
1517     }
1518     ret = fstat(fd, &st);
1519     if (ret == -1 || !S_ISBLK(st.st_mode)) {
1520         goto outc;
1521     }
1522
1523     /* Attempt to detect via a floppy specific ioctl */
1524     ret = ioctl(fd, FDGETPRM, &fdparam);
1525     if (ret >= 0)
1526         prio = 100;
1527
1528 outc:
1529     qemu_close(fd);
1530 out:
1531     return prio;
1532 }
1533
1534
1535 static int floppy_is_inserted(BlockDriverState *bs)
1536 {
1537     return fd_open(bs) >= 0;
1538 }
1539
1540 static int floppy_media_changed(BlockDriverState *bs)
1541 {
1542     BDRVRawState *s = bs->opaque;
1543     int ret;
1544
1545     /*
1546      * XXX: we do not have a true media changed indication.
1547      * It does not work if the floppy is changed without trying to read it.
1548      */
1549     fd_open(bs);
1550     ret = s->fd_media_changed;
1551     s->fd_media_changed = 0;
1552 #ifdef DEBUG_FLOPPY
1553     printf("Floppy changed=%d\n", ret);
1554 #endif
1555     return ret;
1556 }
1557
1558 static void floppy_eject(BlockDriverState *bs, bool eject_flag)
1559 {
1560     BDRVRawState *s = bs->opaque;
1561     int fd;
1562
1563     if (s->fd >= 0) {
1564         qemu_close(s->fd);
1565         s->fd = -1;
1566     }
1567     fd = qemu_open(bs->filename, s->open_flags | O_NONBLOCK);
1568     if (fd >= 0) {
1569         if (ioctl(fd, FDEJECT, 0) < 0)
1570             perror("FDEJECT");
1571         qemu_close(fd);
1572     }
1573 }
1574
1575 static BlockDriver bdrv_host_floppy = {
1576     .format_name        = "host_floppy",
1577     .protocol_name      = "host_floppy",
1578     .instance_size      = sizeof(BDRVRawState),
1579     .bdrv_probe_device  = floppy_probe_device,
1580     .bdrv_file_open     = floppy_open,
1581     .bdrv_close         = raw_close,
1582     .bdrv_reopen_prepare = raw_reopen_prepare,
1583     .bdrv_reopen_commit  = raw_reopen_commit,
1584     .bdrv_reopen_abort   = raw_reopen_abort,
1585     .bdrv_create        = hdev_create,
1586     .create_options     = raw_create_options,
1587     .bdrv_has_zero_init = hdev_has_zero_init,
1588
1589     .bdrv_aio_readv     = raw_aio_readv,
1590     .bdrv_aio_writev    = raw_aio_writev,
1591     .bdrv_aio_flush     = raw_aio_flush,
1592
1593     .bdrv_truncate      = raw_truncate,
1594     .bdrv_getlength     = raw_getlength,
1595     .bdrv_get_allocated_file_size
1596                         = raw_get_allocated_file_size,
1597
1598     /* removable device support */
1599     .bdrv_is_inserted   = floppy_is_inserted,
1600     .bdrv_media_changed = floppy_media_changed,
1601     .bdrv_eject         = floppy_eject,
1602 };
1603
1604 static int cdrom_open(BlockDriverState *bs, const char *filename, int flags)
1605 {
1606     BDRVRawState *s = bs->opaque;
1607
1608     s->type = FTYPE_CD;
1609
1610     /* open will not fail even if no CD is inserted, so add O_NONBLOCK */
1611     return raw_open_common(bs, filename, flags, O_NONBLOCK);
1612 }
1613
1614 static int cdrom_probe_device(const char *filename)
1615 {
1616     int fd, ret;
1617     int prio = 0;
1618     struct stat st;
1619
1620     fd = qemu_open(filename, O_RDONLY | O_NONBLOCK);
1621     if (fd < 0) {
1622         goto out;
1623     }
1624     ret = fstat(fd, &st);
1625     if (ret == -1 || !S_ISBLK(st.st_mode)) {
1626         goto outc;
1627     }
1628
1629     /* Attempt to detect via a CDROM specific ioctl */
1630     ret = ioctl(fd, CDROM_DRIVE_STATUS, CDSL_CURRENT);
1631     if (ret >= 0)
1632         prio = 100;
1633
1634 outc:
1635     qemu_close(fd);
1636 out:
1637     return prio;
1638 }
1639
1640 static int cdrom_is_inserted(BlockDriverState *bs)
1641 {
1642     BDRVRawState *s = bs->opaque;
1643     int ret;
1644
1645     ret = ioctl(s->fd, CDROM_DRIVE_STATUS, CDSL_CURRENT);
1646     if (ret == CDS_DISC_OK)
1647         return 1;
1648     return 0;
1649 }
1650
1651 static void cdrom_eject(BlockDriverState *bs, bool eject_flag)
1652 {
1653     BDRVRawState *s = bs->opaque;
1654
1655     if (eject_flag) {
1656         if (ioctl(s->fd, CDROMEJECT, NULL) < 0)
1657             perror("CDROMEJECT");
1658     } else {
1659         if (ioctl(s->fd, CDROMCLOSETRAY, NULL) < 0)
1660             perror("CDROMEJECT");
1661     }
1662 }
1663
1664 static void cdrom_lock_medium(BlockDriverState *bs, bool locked)
1665 {
1666     BDRVRawState *s = bs->opaque;
1667
1668     if (ioctl(s->fd, CDROM_LOCKDOOR, locked) < 0) {
1669         /*
1670          * Note: an error can happen if the distribution automatically
1671          * mounts the CD-ROM
1672          */
1673         /* perror("CDROM_LOCKDOOR"); */
1674     }
1675 }
1676
1677 static BlockDriver bdrv_host_cdrom = {
1678     .format_name        = "host_cdrom",
1679     .protocol_name      = "host_cdrom",
1680     .instance_size      = sizeof(BDRVRawState),
1681     .bdrv_probe_device  = cdrom_probe_device,
1682     .bdrv_file_open     = cdrom_open,
1683     .bdrv_close         = raw_close,
1684     .bdrv_reopen_prepare = raw_reopen_prepare,
1685     .bdrv_reopen_commit  = raw_reopen_commit,
1686     .bdrv_reopen_abort   = raw_reopen_abort,
1687     .bdrv_create        = hdev_create,
1688     .create_options     = raw_create_options,
1689     .bdrv_has_zero_init = hdev_has_zero_init,
1690
1691     .bdrv_aio_readv     = raw_aio_readv,
1692     .bdrv_aio_writev    = raw_aio_writev,
1693     .bdrv_aio_flush     = raw_aio_flush,
1694
1695     .bdrv_truncate      = raw_truncate,
1696     .bdrv_getlength     = raw_getlength,
1697     .bdrv_get_allocated_file_size
1698                         = raw_get_allocated_file_size,
1699
1700     /* removable device support */
1701     .bdrv_is_inserted   = cdrom_is_inserted,
1702     .bdrv_eject         = cdrom_eject,
1703     .bdrv_lock_medium   = cdrom_lock_medium,
1704
1705     /* generic scsi device */
1706     .bdrv_ioctl         = hdev_ioctl,
1707     .bdrv_aio_ioctl     = hdev_aio_ioctl,
1708 };
1709 #endif /* __linux__ */
1710
1711 #if defined (__FreeBSD__) || defined(__FreeBSD_kernel__)
1712 static int cdrom_open(BlockDriverState *bs, const char *filename, int flags)
1713 {
1714     BDRVRawState *s = bs->opaque;
1715     int ret;
1716
1717     s->type = FTYPE_CD;
1718
1719     ret = raw_open_common(bs, filename, flags, 0);
1720     if (ret)
1721         return ret;
1722
1723     /* make sure the door isn't locked at this time */
1724     ioctl(s->fd, CDIOCALLOW);
1725     return 0;
1726 }
1727
1728 static int cdrom_probe_device(const char *filename)
1729 {
1730     if (strstart(filename, "/dev/cd", NULL) ||
1731             strstart(filename, "/dev/acd", NULL))
1732         return 100;
1733     return 0;
1734 }
1735
1736 static int cdrom_reopen(BlockDriverState *bs)
1737 {
1738     BDRVRawState *s = bs->opaque;
1739     int fd;
1740
1741     /*
1742      * Force reread of possibly changed/newly loaded disc,
1743      * FreeBSD seems to not notice sometimes...
1744      */
1745     if (s->fd >= 0)
1746         qemu_close(s->fd);
1747     fd = qemu_open(bs->filename, s->open_flags, 0644);
1748     if (fd < 0) {
1749         s->fd = -1;
1750         return -EIO;
1751     }
1752     s->fd = fd;
1753
1754     /* make sure the door isn't locked at this time */
1755     ioctl(s->fd, CDIOCALLOW);
1756     return 0;
1757 }
1758
1759 static int cdrom_is_inserted(BlockDriverState *bs)
1760 {
1761     return raw_getlength(bs) > 0;
1762 }
1763
1764 static void cdrom_eject(BlockDriverState *bs, bool eject_flag)
1765 {
1766     BDRVRawState *s = bs->opaque;
1767
1768     if (s->fd < 0)
1769         return;
1770
1771     (void) ioctl(s->fd, CDIOCALLOW);
1772
1773     if (eject_flag) {
1774         if (ioctl(s->fd, CDIOCEJECT) < 0)
1775             perror("CDIOCEJECT");
1776     } else {
1777         if (ioctl(s->fd, CDIOCCLOSE) < 0)
1778             perror("CDIOCCLOSE");
1779     }
1780
1781     cdrom_reopen(bs);
1782 }
1783
1784 static void cdrom_lock_medium(BlockDriverState *bs, bool locked)
1785 {
1786     BDRVRawState *s = bs->opaque;
1787
1788     if (s->fd < 0)
1789         return;
1790     if (ioctl(s->fd, (locked ? CDIOCPREVENT : CDIOCALLOW)) < 0) {
1791         /*
1792          * Note: an error can happen if the distribution automatically
1793          * mounts the CD-ROM
1794          */
1795         /* perror("CDROM_LOCKDOOR"); */
1796     }
1797 }
1798
1799 static BlockDriver bdrv_host_cdrom = {
1800     .format_name        = "host_cdrom",
1801     .protocol_name      = "host_cdrom",
1802     .instance_size      = sizeof(BDRVRawState),
1803     .bdrv_probe_device  = cdrom_probe_device,
1804     .bdrv_file_open     = cdrom_open,
1805     .bdrv_close         = raw_close,
1806     .bdrv_reopen_prepare = raw_reopen_prepare,
1807     .bdrv_reopen_commit  = raw_reopen_commit,
1808     .bdrv_reopen_abort   = raw_reopen_abort,
1809     .bdrv_create        = hdev_create,
1810     .create_options     = raw_create_options,
1811     .bdrv_has_zero_init = hdev_has_zero_init,
1812
1813     .bdrv_aio_readv     = raw_aio_readv,
1814     .bdrv_aio_writev    = raw_aio_writev,
1815     .bdrv_aio_flush     = raw_aio_flush,
1816
1817     .bdrv_truncate      = raw_truncate,
1818     .bdrv_getlength     = raw_getlength,
1819     .bdrv_get_allocated_file_size
1820                         = raw_get_allocated_file_size,
1821
1822     /* removable device support */
1823     .bdrv_is_inserted   = cdrom_is_inserted,
1824     .bdrv_eject         = cdrom_eject,
1825     .bdrv_lock_medium   = cdrom_lock_medium,
1826 };
1827 #endif /* __FreeBSD__ */
1828
1829 #ifdef CONFIG_LINUX_AIO
1830 /**
1831  * Return the file descriptor for Linux AIO
1832  *
1833  * This function is a layering violation and should be removed when it becomes
1834  * possible to call the block layer outside the global mutex.  It allows the
1835  * caller to hijack the file descriptor so I/O can be performed outside the
1836  * block layer.
1837  */
1838 int raw_get_aio_fd(BlockDriverState *bs)
1839 {
1840     BDRVRawState *s;
1841
1842     if (!bs->drv) {
1843         return -ENOMEDIUM;
1844     }
1845
1846     if (bs->drv == bdrv_find_format("raw")) {
1847         bs = bs->file;
1848     }
1849
1850     /* raw-posix has several protocols so just check for raw_aio_readv */
1851     if (bs->drv->bdrv_aio_readv != raw_aio_readv) {
1852         return -ENOTSUP;
1853     }
1854
1855     s = bs->opaque;
1856     if (!s->use_aio) {
1857         return -ENOTSUP;
1858     }
1859     return s->fd;
1860 }
1861 #endif /* CONFIG_LINUX_AIO */
1862
1863 static void bdrv_file_init(void)
1864 {
1865     /*
1866      * Register all the drivers.  Note that order is important, the driver
1867      * registered last will get probed first.
1868      */
1869     bdrv_register(&bdrv_file);
1870     bdrv_register(&bdrv_host_device);
1871 #ifdef __linux__
1872     bdrv_register(&bdrv_host_floppy);
1873     bdrv_register(&bdrv_host_cdrom);
1874 #endif
1875 #if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
1876     bdrv_register(&bdrv_host_cdrom);
1877 #endif
1878 }
1879
1880 block_init(bdrv_file_init);