1 /* 2 * Block protocol for I/O error injection 3 * 4 * Copyright (C) 2016-2017 Red Hat, Inc. 5 * Copyright (c) 2010 Kevin Wolf <kwolf@redhat.com> 6 * 7 * Permission is hereby granted, free of charge, to any person obtaining a copy 8 * of this software and associated documentation files (the "Software"), to deal 9 * in the Software without restriction, including without limitation the rights 10 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 11 * copies of the Software, and to permit persons to whom the Software is 12 * furnished to do so, subject to the following conditions: 13 * 14 * The above copyright notice and this permission notice shall be included in 15 * all copies or substantial portions of the Software. 16 * 17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 23 * THE SOFTWARE. 24 */ 25 26 #include "qemu/osdep.h" 27 #include "qapi/error.h" 28 #include "qemu/cutils.h" 29 #include "qemu/config-file.h" 30 #include "block/block_int.h" 31 #include "block/qdict.h" 32 #include "qemu/module.h" 33 #include "qemu/option.h" 34 #include "qapi/qapi-visit-block-core.h" 35 #include "qapi/qmp/qdict.h" 36 #include "qapi/qmp/qlist.h" 37 #include "qapi/qmp/qstring.h" 38 #include "qapi/qobject-input-visitor.h" 39 #include "sysemu/qtest.h" 40 41 /* All APIs are thread-safe */ 42 43 typedef struct BDRVBlkdebugState { 44 /* IN: initialized in blkdebug_open() and never changed */ 45 uint64_t align; 46 uint64_t max_transfer; 47 uint64_t opt_write_zero; 48 uint64_t max_write_zero; 49 uint64_t opt_discard; 50 uint64_t max_discard; 51 char *config_file; /* For blkdebug_refresh_filename() */ 52 /* initialized in blkdebug_parse_perms() */ 53 uint64_t take_child_perms; 54 uint64_t unshare_child_perms; 55 56 /* State. Protected by lock */ 57 int state; 58 QLIST_HEAD(, BlkdebugRule) rules[BLKDBG__MAX]; 59 QSIMPLEQ_HEAD(, BlkdebugRule) active_rules; 60 QLIST_HEAD(, BlkdebugSuspendedReq) suspended_reqs; 61 QemuMutex lock; 62 } BDRVBlkdebugState; 63 64 typedef struct BlkdebugAIOCB { 65 BlockAIOCB common; 66 int ret; 67 } BlkdebugAIOCB; 68 69 typedef struct BlkdebugSuspendedReq { 70 /* IN: initialized in suspend_request() */ 71 Coroutine *co; 72 char *tag; 73 74 /* List entry protected BDRVBlkdebugState's lock */ 75 QLIST_ENTRY(BlkdebugSuspendedReq) next; 76 } BlkdebugSuspendedReq; 77 78 enum { 79 ACTION_INJECT_ERROR, 80 ACTION_SET_STATE, 81 ACTION_SUSPEND, 82 ACTION__MAX, 83 }; 84 85 typedef struct BlkdebugRule { 86 /* IN: initialized in add_rule() or blkdebug_debug_breakpoint() */ 87 BlkdebugEvent event; 88 int action; 89 int state; 90 union { 91 struct { 92 uint64_t iotype_mask; 93 int error; 94 int immediately; 95 int once; 96 int64_t offset; 97 } inject; 98 struct { 99 int new_state; 100 } set_state; 101 struct { 102 char *tag; 103 } suspend; 104 } options; 105 106 /* List entries protected BDRVBlkdebugState's lock */ 107 QLIST_ENTRY(BlkdebugRule) next; 108 QSIMPLEQ_ENTRY(BlkdebugRule) active_next; 109 } BlkdebugRule; 110 111 QEMU_BUILD_BUG_MSG(BLKDEBUG_IO_TYPE__MAX > 64, 112 "BlkdebugIOType mask does not fit into an uint64_t"); 113 114 static QemuOptsList inject_error_opts = { 115 .name = "inject-error", 116 .head = QTAILQ_HEAD_INITIALIZER(inject_error_opts.head), 117 .desc = { 118 { 119 .name = "event", 120 .type = QEMU_OPT_STRING, 121 }, 122 { 123 .name = "state", 124 .type = QEMU_OPT_NUMBER, 125 }, 126 { 127 .name = "iotype", 128 .type = QEMU_OPT_STRING, 129 }, 130 { 131 .name = "errno", 132 .type = QEMU_OPT_NUMBER, 133 }, 134 { 135 .name = "sector", 136 .type = QEMU_OPT_NUMBER, 137 }, 138 { 139 .name = "once", 140 .type = QEMU_OPT_BOOL, 141 }, 142 { 143 .name = "immediately", 144 .type = QEMU_OPT_BOOL, 145 }, 146 { /* end of list */ } 147 }, 148 }; 149 150 static QemuOptsList set_state_opts = { 151 .name = "set-state", 152 .head = QTAILQ_HEAD_INITIALIZER(set_state_opts.head), 153 .desc = { 154 { 155 .name = "event", 156 .type = QEMU_OPT_STRING, 157 }, 158 { 159 .name = "state", 160 .type = QEMU_OPT_NUMBER, 161 }, 162 { 163 .name = "new_state", 164 .type = QEMU_OPT_NUMBER, 165 }, 166 { /* end of list */ } 167 }, 168 }; 169 170 static QemuOptsList *config_groups[] = { 171 &inject_error_opts, 172 &set_state_opts, 173 NULL 174 }; 175 176 struct add_rule_data { 177 BDRVBlkdebugState *s; 178 int action; 179 }; 180 181 static int add_rule(void *opaque, QemuOpts *opts, Error **errp) 182 { 183 struct add_rule_data *d = opaque; 184 BDRVBlkdebugState *s = d->s; 185 const char *event_name; 186 int event; 187 struct BlkdebugRule *rule; 188 int64_t sector; 189 BlkdebugIOType iotype; 190 Error *local_error = NULL; 191 192 /* Find the right event for the rule */ 193 event_name = qemu_opt_get(opts, "event"); 194 if (!event_name) { 195 error_setg(errp, "Missing event name for rule"); 196 return -1; 197 } 198 event = qapi_enum_parse(&BlkdebugEvent_lookup, event_name, -1, errp); 199 if (event < 0) { 200 return -1; 201 } 202 203 /* Set attributes common for all actions */ 204 rule = g_malloc0(sizeof(*rule)); 205 *rule = (struct BlkdebugRule) { 206 .event = event, 207 .action = d->action, 208 .state = qemu_opt_get_number(opts, "state", 0), 209 }; 210 211 /* Parse action-specific options */ 212 switch (d->action) { 213 case ACTION_INJECT_ERROR: 214 rule->options.inject.error = qemu_opt_get_number(opts, "errno", EIO); 215 rule->options.inject.once = qemu_opt_get_bool(opts, "once", 0); 216 rule->options.inject.immediately = 217 qemu_opt_get_bool(opts, "immediately", 0); 218 sector = qemu_opt_get_number(opts, "sector", -1); 219 rule->options.inject.offset = 220 sector == -1 ? -1 : sector * BDRV_SECTOR_SIZE; 221 222 iotype = qapi_enum_parse(&BlkdebugIOType_lookup, 223 qemu_opt_get(opts, "iotype"), 224 BLKDEBUG_IO_TYPE__MAX, &local_error); 225 if (local_error) { 226 error_propagate(errp, local_error); 227 g_free(rule); 228 return -1; 229 } 230 if (iotype != BLKDEBUG_IO_TYPE__MAX) { 231 rule->options.inject.iotype_mask = (1ull << iotype); 232 } else { 233 /* Apply the default */ 234 rule->options.inject.iotype_mask = 235 (1ull << BLKDEBUG_IO_TYPE_READ) 236 | (1ull << BLKDEBUG_IO_TYPE_WRITE) 237 | (1ull << BLKDEBUG_IO_TYPE_WRITE_ZEROES) 238 | (1ull << BLKDEBUG_IO_TYPE_DISCARD) 239 | (1ull << BLKDEBUG_IO_TYPE_FLUSH); 240 } 241 242 break; 243 244 case ACTION_SET_STATE: 245 rule->options.set_state.new_state = 246 qemu_opt_get_number(opts, "new_state", 0); 247 break; 248 249 case ACTION_SUSPEND: 250 rule->options.suspend.tag = 251 g_strdup(qemu_opt_get(opts, "tag")); 252 break; 253 }; 254 255 /* Add the rule */ 256 qemu_mutex_lock(&s->lock); 257 QLIST_INSERT_HEAD(&s->rules[event], rule, next); 258 qemu_mutex_unlock(&s->lock); 259 260 return 0; 261 } 262 263 /* Called with lock held or from .bdrv_close */ 264 static void remove_rule(BlkdebugRule *rule) 265 { 266 switch (rule->action) { 267 case ACTION_INJECT_ERROR: 268 case ACTION_SET_STATE: 269 break; 270 case ACTION_SUSPEND: 271 g_free(rule->options.suspend.tag); 272 break; 273 } 274 275 QLIST_REMOVE(rule, next); 276 g_free(rule); 277 } 278 279 static int read_config(BDRVBlkdebugState *s, const char *filename, 280 QDict *options, Error **errp) 281 { 282 FILE *f = NULL; 283 int ret; 284 struct add_rule_data d; 285 Error *local_err = NULL; 286 287 if (filename) { 288 f = fopen(filename, "r"); 289 if (f == NULL) { 290 error_setg_errno(errp, errno, "Could not read blkdebug config file"); 291 return -errno; 292 } 293 294 ret = qemu_config_parse(f, config_groups, filename, errp); 295 if (ret < 0) { 296 goto fail; 297 } 298 } 299 300 qemu_config_parse_qdict(options, config_groups, &local_err); 301 if (local_err) { 302 error_propagate(errp, local_err); 303 ret = -EINVAL; 304 goto fail; 305 } 306 307 d.s = s; 308 d.action = ACTION_INJECT_ERROR; 309 qemu_opts_foreach(&inject_error_opts, add_rule, &d, &local_err); 310 if (local_err) { 311 error_propagate(errp, local_err); 312 ret = -EINVAL; 313 goto fail; 314 } 315 316 d.action = ACTION_SET_STATE; 317 qemu_opts_foreach(&set_state_opts, add_rule, &d, &local_err); 318 if (local_err) { 319 error_propagate(errp, local_err); 320 ret = -EINVAL; 321 goto fail; 322 } 323 324 ret = 0; 325 fail: 326 qemu_opts_reset(&inject_error_opts); 327 qemu_opts_reset(&set_state_opts); 328 if (f) { 329 fclose(f); 330 } 331 return ret; 332 } 333 334 /* Valid blkdebug filenames look like blkdebug:path/to/config:path/to/image */ 335 static void blkdebug_parse_filename(const char *filename, QDict *options, 336 Error **errp) 337 { 338 const char *c; 339 340 /* Parse the blkdebug: prefix */ 341 if (!strstart(filename, "blkdebug:", &filename)) { 342 /* There was no prefix; therefore, all options have to be already 343 present in the QDict (except for the filename) */ 344 qdict_put_str(options, "x-image", filename); 345 return; 346 } 347 348 /* Parse config file path */ 349 c = strchr(filename, ':'); 350 if (c == NULL) { 351 error_setg(errp, "blkdebug requires both config file and image path"); 352 return; 353 } 354 355 if (c != filename) { 356 QString *config_path; 357 config_path = qstring_from_substr(filename, 0, c - filename); 358 qdict_put(options, "config", config_path); 359 } 360 361 /* TODO Allow multi-level nesting and set file.filename here */ 362 filename = c + 1; 363 qdict_put_str(options, "x-image", filename); 364 } 365 366 static int blkdebug_parse_perm_list(uint64_t *dest, QDict *options, 367 const char *prefix, Error **errp) 368 { 369 int ret = 0; 370 QDict *subqdict = NULL; 371 QObject *crumpled_subqdict = NULL; 372 Visitor *v = NULL; 373 BlockPermissionList *perm_list = NULL, *element; 374 375 *dest = 0; 376 377 qdict_extract_subqdict(options, &subqdict, prefix); 378 if (!qdict_size(subqdict)) { 379 goto out; 380 } 381 382 crumpled_subqdict = qdict_crumple(subqdict, errp); 383 if (!crumpled_subqdict) { 384 ret = -EINVAL; 385 goto out; 386 } 387 388 v = qobject_input_visitor_new(crumpled_subqdict); 389 if (!visit_type_BlockPermissionList(v, NULL, &perm_list, errp)) { 390 ret = -EINVAL; 391 goto out; 392 } 393 394 for (element = perm_list; element; element = element->next) { 395 *dest |= bdrv_qapi_perm_to_blk_perm(element->value); 396 } 397 398 out: 399 qapi_free_BlockPermissionList(perm_list); 400 visit_free(v); 401 qobject_unref(subqdict); 402 qobject_unref(crumpled_subqdict); 403 return ret; 404 } 405 406 static int blkdebug_parse_perms(BDRVBlkdebugState *s, QDict *options, 407 Error **errp) 408 { 409 int ret; 410 411 ret = blkdebug_parse_perm_list(&s->take_child_perms, options, 412 "take-child-perms.", errp); 413 if (ret < 0) { 414 return ret; 415 } 416 417 ret = blkdebug_parse_perm_list(&s->unshare_child_perms, options, 418 "unshare-child-perms.", errp); 419 if (ret < 0) { 420 return ret; 421 } 422 423 return 0; 424 } 425 426 static QemuOptsList runtime_opts = { 427 .name = "blkdebug", 428 .head = QTAILQ_HEAD_INITIALIZER(runtime_opts.head), 429 .desc = { 430 { 431 .name = "config", 432 .type = QEMU_OPT_STRING, 433 .help = "Path to the configuration file", 434 }, 435 { 436 .name = "x-image", 437 .type = QEMU_OPT_STRING, 438 .help = "[internal use only, will be removed]", 439 }, 440 { 441 .name = "align", 442 .type = QEMU_OPT_SIZE, 443 .help = "Required alignment in bytes", 444 }, 445 { 446 .name = "max-transfer", 447 .type = QEMU_OPT_SIZE, 448 .help = "Maximum transfer size in bytes", 449 }, 450 { 451 .name = "opt-write-zero", 452 .type = QEMU_OPT_SIZE, 453 .help = "Optimum write zero alignment in bytes", 454 }, 455 { 456 .name = "max-write-zero", 457 .type = QEMU_OPT_SIZE, 458 .help = "Maximum write zero size in bytes", 459 }, 460 { 461 .name = "opt-discard", 462 .type = QEMU_OPT_SIZE, 463 .help = "Optimum discard alignment in bytes", 464 }, 465 { 466 .name = "max-discard", 467 .type = QEMU_OPT_SIZE, 468 .help = "Maximum discard size in bytes", 469 }, 470 { /* end of list */ } 471 }, 472 }; 473 474 static int blkdebug_open(BlockDriverState *bs, QDict *options, int flags, 475 Error **errp) 476 { 477 BDRVBlkdebugState *s = bs->opaque; 478 QemuOpts *opts; 479 int ret; 480 uint64_t align; 481 482 qemu_mutex_init(&s->lock); 483 opts = qemu_opts_create(&runtime_opts, NULL, 0, &error_abort); 484 if (!qemu_opts_absorb_qdict(opts, options, errp)) { 485 ret = -EINVAL; 486 goto out; 487 } 488 489 /* Read rules from config file or command line options */ 490 s->config_file = g_strdup(qemu_opt_get(opts, "config")); 491 ret = read_config(s, s->config_file, options, errp); 492 if (ret) { 493 goto out; 494 } 495 496 /* Set initial state */ 497 s->state = 1; 498 499 /* Parse permissions modifiers before opening the image file */ 500 ret = blkdebug_parse_perms(s, options, errp); 501 if (ret < 0) { 502 goto out; 503 } 504 505 /* Open the image file */ 506 bs->file = bdrv_open_child(qemu_opt_get(opts, "x-image"), options, "image", 507 bs, &child_of_bds, 508 BDRV_CHILD_FILTERED | BDRV_CHILD_PRIMARY, 509 false, errp); 510 if (!bs->file) { 511 ret = -EINVAL; 512 goto out; 513 } 514 515 bs->supported_write_flags = BDRV_REQ_WRITE_UNCHANGED | 516 (BDRV_REQ_FUA & bs->file->bs->supported_write_flags); 517 bs->supported_zero_flags = BDRV_REQ_WRITE_UNCHANGED | 518 ((BDRV_REQ_FUA | BDRV_REQ_MAY_UNMAP | BDRV_REQ_NO_FALLBACK) & 519 bs->file->bs->supported_zero_flags); 520 ret = -EINVAL; 521 522 /* Set alignment overrides */ 523 s->align = qemu_opt_get_size(opts, "align", 0); 524 if (s->align && (s->align >= INT_MAX || !is_power_of_2(s->align))) { 525 error_setg(errp, "Cannot meet constraints with align %" PRIu64, 526 s->align); 527 goto out; 528 } 529 align = MAX(s->align, bs->file->bs->bl.request_alignment); 530 531 s->max_transfer = qemu_opt_get_size(opts, "max-transfer", 0); 532 if (s->max_transfer && 533 (s->max_transfer >= INT_MAX || 534 !QEMU_IS_ALIGNED(s->max_transfer, align))) { 535 error_setg(errp, "Cannot meet constraints with max-transfer %" PRIu64, 536 s->max_transfer); 537 goto out; 538 } 539 540 s->opt_write_zero = qemu_opt_get_size(opts, "opt-write-zero", 0); 541 if (s->opt_write_zero && 542 (s->opt_write_zero >= INT_MAX || 543 !QEMU_IS_ALIGNED(s->opt_write_zero, align))) { 544 error_setg(errp, "Cannot meet constraints with opt-write-zero %" PRIu64, 545 s->opt_write_zero); 546 goto out; 547 } 548 549 s->max_write_zero = qemu_opt_get_size(opts, "max-write-zero", 0); 550 if (s->max_write_zero && 551 (s->max_write_zero >= INT_MAX || 552 !QEMU_IS_ALIGNED(s->max_write_zero, 553 MAX(s->opt_write_zero, align)))) { 554 error_setg(errp, "Cannot meet constraints with max-write-zero %" PRIu64, 555 s->max_write_zero); 556 goto out; 557 } 558 559 s->opt_discard = qemu_opt_get_size(opts, "opt-discard", 0); 560 if (s->opt_discard && 561 (s->opt_discard >= INT_MAX || 562 !QEMU_IS_ALIGNED(s->opt_discard, align))) { 563 error_setg(errp, "Cannot meet constraints with opt-discard %" PRIu64, 564 s->opt_discard); 565 goto out; 566 } 567 568 s->max_discard = qemu_opt_get_size(opts, "max-discard", 0); 569 if (s->max_discard && 570 (s->max_discard >= INT_MAX || 571 !QEMU_IS_ALIGNED(s->max_discard, 572 MAX(s->opt_discard, align)))) { 573 error_setg(errp, "Cannot meet constraints with max-discard %" PRIu64, 574 s->max_discard); 575 goto out; 576 } 577 578 bdrv_debug_event(bs, BLKDBG_NONE); 579 580 ret = 0; 581 out: 582 if (ret < 0) { 583 qemu_mutex_destroy(&s->lock); 584 g_free(s->config_file); 585 } 586 qemu_opts_del(opts); 587 return ret; 588 } 589 590 static int rule_check(BlockDriverState *bs, uint64_t offset, uint64_t bytes, 591 BlkdebugIOType iotype) 592 { 593 BDRVBlkdebugState *s = bs->opaque; 594 BlkdebugRule *rule = NULL; 595 int error; 596 bool immediately; 597 598 qemu_mutex_lock(&s->lock); 599 QSIMPLEQ_FOREACH(rule, &s->active_rules, active_next) { 600 uint64_t inject_offset = rule->options.inject.offset; 601 602 if ((inject_offset == -1 || 603 (bytes && inject_offset >= offset && 604 inject_offset < offset + bytes)) && 605 (rule->options.inject.iotype_mask & (1ull << iotype))) 606 { 607 break; 608 } 609 } 610 611 if (!rule || !rule->options.inject.error) { 612 qemu_mutex_unlock(&s->lock); 613 return 0; 614 } 615 616 immediately = rule->options.inject.immediately; 617 error = rule->options.inject.error; 618 619 if (rule->options.inject.once) { 620 QSIMPLEQ_REMOVE(&s->active_rules, rule, BlkdebugRule, active_next); 621 remove_rule(rule); 622 } 623 624 qemu_mutex_unlock(&s->lock); 625 if (!immediately) { 626 aio_co_schedule(qemu_get_current_aio_context(), qemu_coroutine_self()); 627 qemu_coroutine_yield(); 628 } 629 630 return -error; 631 } 632 633 static int coroutine_fn 634 blkdebug_co_preadv(BlockDriverState *bs, uint64_t offset, uint64_t bytes, 635 QEMUIOVector *qiov, int flags) 636 { 637 int err; 638 639 /* Sanity check block layer guarantees */ 640 assert(QEMU_IS_ALIGNED(offset, bs->bl.request_alignment)); 641 assert(QEMU_IS_ALIGNED(bytes, bs->bl.request_alignment)); 642 if (bs->bl.max_transfer) { 643 assert(bytes <= bs->bl.max_transfer); 644 } 645 646 err = rule_check(bs, offset, bytes, BLKDEBUG_IO_TYPE_READ); 647 if (err) { 648 return err; 649 } 650 651 return bdrv_co_preadv(bs->file, offset, bytes, qiov, flags); 652 } 653 654 static int coroutine_fn 655 blkdebug_co_pwritev(BlockDriverState *bs, uint64_t offset, uint64_t bytes, 656 QEMUIOVector *qiov, int flags) 657 { 658 int err; 659 660 /* Sanity check block layer guarantees */ 661 assert(QEMU_IS_ALIGNED(offset, bs->bl.request_alignment)); 662 assert(QEMU_IS_ALIGNED(bytes, bs->bl.request_alignment)); 663 if (bs->bl.max_transfer) { 664 assert(bytes <= bs->bl.max_transfer); 665 } 666 667 err = rule_check(bs, offset, bytes, BLKDEBUG_IO_TYPE_WRITE); 668 if (err) { 669 return err; 670 } 671 672 return bdrv_co_pwritev(bs->file, offset, bytes, qiov, flags); 673 } 674 675 static int blkdebug_co_flush(BlockDriverState *bs) 676 { 677 int err = rule_check(bs, 0, 0, BLKDEBUG_IO_TYPE_FLUSH); 678 679 if (err) { 680 return err; 681 } 682 683 return bdrv_co_flush(bs->file->bs); 684 } 685 686 static int coroutine_fn blkdebug_co_pwrite_zeroes(BlockDriverState *bs, 687 int64_t offset, int bytes, 688 BdrvRequestFlags flags) 689 { 690 uint32_t align = MAX(bs->bl.request_alignment, 691 bs->bl.pwrite_zeroes_alignment); 692 int err; 693 694 /* Only pass through requests that are larger than requested 695 * preferred alignment (so that we test the fallback to writes on 696 * unaligned portions), and check that the block layer never hands 697 * us anything unaligned that crosses an alignment boundary. */ 698 if (bytes < align) { 699 assert(QEMU_IS_ALIGNED(offset, align) || 700 QEMU_IS_ALIGNED(offset + bytes, align) || 701 DIV_ROUND_UP(offset, align) == 702 DIV_ROUND_UP(offset + bytes, align)); 703 return -ENOTSUP; 704 } 705 assert(QEMU_IS_ALIGNED(offset, align)); 706 assert(QEMU_IS_ALIGNED(bytes, align)); 707 if (bs->bl.max_pwrite_zeroes) { 708 assert(bytes <= bs->bl.max_pwrite_zeroes); 709 } 710 711 err = rule_check(bs, offset, bytes, BLKDEBUG_IO_TYPE_WRITE_ZEROES); 712 if (err) { 713 return err; 714 } 715 716 return bdrv_co_pwrite_zeroes(bs->file, offset, bytes, flags); 717 } 718 719 static int coroutine_fn blkdebug_co_pdiscard(BlockDriverState *bs, 720 int64_t offset, int bytes) 721 { 722 uint32_t align = bs->bl.pdiscard_alignment; 723 int err; 724 725 /* Only pass through requests that are larger than requested 726 * minimum alignment, and ensure that unaligned requests do not 727 * cross optimum discard boundaries. */ 728 if (bytes < bs->bl.request_alignment) { 729 assert(QEMU_IS_ALIGNED(offset, align) || 730 QEMU_IS_ALIGNED(offset + bytes, align) || 731 DIV_ROUND_UP(offset, align) == 732 DIV_ROUND_UP(offset + bytes, align)); 733 return -ENOTSUP; 734 } 735 assert(QEMU_IS_ALIGNED(offset, bs->bl.request_alignment)); 736 assert(QEMU_IS_ALIGNED(bytes, bs->bl.request_alignment)); 737 if (align && bytes >= align) { 738 assert(QEMU_IS_ALIGNED(offset, align)); 739 assert(QEMU_IS_ALIGNED(bytes, align)); 740 } 741 if (bs->bl.max_pdiscard) { 742 assert(bytes <= bs->bl.max_pdiscard); 743 } 744 745 err = rule_check(bs, offset, bytes, BLKDEBUG_IO_TYPE_DISCARD); 746 if (err) { 747 return err; 748 } 749 750 return bdrv_co_pdiscard(bs->file, offset, bytes); 751 } 752 753 static int coroutine_fn blkdebug_co_block_status(BlockDriverState *bs, 754 bool want_zero, 755 int64_t offset, 756 int64_t bytes, 757 int64_t *pnum, 758 int64_t *map, 759 BlockDriverState **file) 760 { 761 int err; 762 763 assert(QEMU_IS_ALIGNED(offset | bytes, bs->bl.request_alignment)); 764 765 err = rule_check(bs, offset, bytes, BLKDEBUG_IO_TYPE_BLOCK_STATUS); 766 if (err) { 767 return err; 768 } 769 770 assert(bs->file && bs->file->bs); 771 *pnum = bytes; 772 *map = offset; 773 *file = bs->file->bs; 774 return BDRV_BLOCK_RAW | BDRV_BLOCK_OFFSET_VALID; 775 } 776 777 static void blkdebug_close(BlockDriverState *bs) 778 { 779 BDRVBlkdebugState *s = bs->opaque; 780 BlkdebugRule *rule, *next; 781 int i; 782 783 for (i = 0; i < BLKDBG__MAX; i++) { 784 QLIST_FOREACH_SAFE(rule, &s->rules[i], next, next) { 785 remove_rule(rule); 786 } 787 } 788 789 g_free(s->config_file); 790 qemu_mutex_destroy(&s->lock); 791 } 792 793 /* Called with lock held. */ 794 static void suspend_request(BlockDriverState *bs, BlkdebugRule *rule) 795 { 796 BDRVBlkdebugState *s = bs->opaque; 797 BlkdebugSuspendedReq *r; 798 799 r = g_new(BlkdebugSuspendedReq, 1); 800 801 r->co = qemu_coroutine_self(); 802 r->tag = g_strdup(rule->options.suspend.tag); 803 804 remove_rule(rule); 805 QLIST_INSERT_HEAD(&s->suspended_reqs, r, next); 806 807 if (!qtest_enabled()) { 808 printf("blkdebug: Suspended request '%s'\n", r->tag); 809 } 810 } 811 812 /* Called with lock held. */ 813 static void process_rule(BlockDriverState *bs, struct BlkdebugRule *rule, 814 int *action_count, int *new_state) 815 { 816 BDRVBlkdebugState *s = bs->opaque; 817 818 /* Only process rules for the current state */ 819 if (rule->state && rule->state != s->state) { 820 return; 821 } 822 823 /* Take the action */ 824 action_count[rule->action]++; 825 switch (rule->action) { 826 case ACTION_INJECT_ERROR: 827 if (action_count[ACTION_INJECT_ERROR] == 1) { 828 QSIMPLEQ_INIT(&s->active_rules); 829 } 830 QSIMPLEQ_INSERT_HEAD(&s->active_rules, rule, active_next); 831 break; 832 833 case ACTION_SET_STATE: 834 *new_state = rule->options.set_state.new_state; 835 break; 836 837 case ACTION_SUSPEND: 838 suspend_request(bs, rule); 839 break; 840 } 841 } 842 843 static void blkdebug_debug_event(BlockDriverState *bs, BlkdebugEvent event) 844 { 845 BDRVBlkdebugState *s = bs->opaque; 846 struct BlkdebugRule *rule, *next; 847 int new_state; 848 int actions_count[ACTION__MAX] = { 0 }; 849 850 assert((int)event >= 0 && event < BLKDBG__MAX); 851 852 WITH_QEMU_LOCK_GUARD(&s->lock) { 853 new_state = s->state; 854 QLIST_FOREACH_SAFE(rule, &s->rules[event], next, next) { 855 process_rule(bs, rule, actions_count, &new_state); 856 } 857 s->state = new_state; 858 } 859 860 while (actions_count[ACTION_SUSPEND] > 0) { 861 qemu_coroutine_yield(); 862 actions_count[ACTION_SUSPEND]--; 863 } 864 } 865 866 static int blkdebug_debug_breakpoint(BlockDriverState *bs, const char *event, 867 const char *tag) 868 { 869 BDRVBlkdebugState *s = bs->opaque; 870 struct BlkdebugRule *rule; 871 int blkdebug_event; 872 873 blkdebug_event = qapi_enum_parse(&BlkdebugEvent_lookup, event, -1, NULL); 874 if (blkdebug_event < 0) { 875 return -ENOENT; 876 } 877 878 rule = g_malloc(sizeof(*rule)); 879 *rule = (struct BlkdebugRule) { 880 .event = blkdebug_event, 881 .action = ACTION_SUSPEND, 882 .state = 0, 883 .options.suspend.tag = g_strdup(tag), 884 }; 885 886 qemu_mutex_lock(&s->lock); 887 QLIST_INSERT_HEAD(&s->rules[blkdebug_event], rule, next); 888 qemu_mutex_unlock(&s->lock); 889 890 return 0; 891 } 892 893 /* Called with lock held. May temporarily release lock. */ 894 static int resume_req_by_tag(BDRVBlkdebugState *s, const char *tag, bool all) 895 { 896 BlkdebugSuspendedReq *r; 897 898 retry: 899 /* 900 * No need for _SAFE, since a different coroutine can remove another node 901 * (not the current one) in this list, and when the current one is removed 902 * the iteration starts back from beginning anyways. 903 */ 904 QLIST_FOREACH(r, &s->suspended_reqs, next) { 905 if (!strcmp(r->tag, tag)) { 906 Coroutine *co = r->co; 907 908 if (!qtest_enabled()) { 909 printf("blkdebug: Resuming request '%s'\n", r->tag); 910 } 911 912 QLIST_REMOVE(r, next); 913 g_free(r->tag); 914 g_free(r); 915 916 qemu_mutex_unlock(&s->lock); 917 qemu_coroutine_enter(co); 918 qemu_mutex_lock(&s->lock); 919 920 if (all) { 921 goto retry; 922 } 923 return 0; 924 } 925 } 926 return -ENOENT; 927 } 928 929 static int blkdebug_debug_resume(BlockDriverState *bs, const char *tag) 930 { 931 BDRVBlkdebugState *s = bs->opaque; 932 QEMU_LOCK_GUARD(&s->lock); 933 return resume_req_by_tag(s, tag, false); 934 } 935 936 static int blkdebug_debug_remove_breakpoint(BlockDriverState *bs, 937 const char *tag) 938 { 939 BDRVBlkdebugState *s = bs->opaque; 940 BlkdebugRule *rule, *next; 941 int i, ret = -ENOENT; 942 943 QEMU_LOCK_GUARD(&s->lock); 944 for (i = 0; i < BLKDBG__MAX; i++) { 945 QLIST_FOREACH_SAFE(rule, &s->rules[i], next, next) { 946 if (rule->action == ACTION_SUSPEND && 947 !strcmp(rule->options.suspend.tag, tag)) { 948 remove_rule(rule); 949 ret = 0; 950 } 951 } 952 } 953 if (resume_req_by_tag(s, tag, true) == 0) { 954 ret = 0; 955 } 956 return ret; 957 } 958 959 static bool blkdebug_debug_is_suspended(BlockDriverState *bs, const char *tag) 960 { 961 BDRVBlkdebugState *s = bs->opaque; 962 BlkdebugSuspendedReq *r; 963 964 QEMU_LOCK_GUARD(&s->lock); 965 QLIST_FOREACH(r, &s->suspended_reqs, next) { 966 if (!strcmp(r->tag, tag)) { 967 return true; 968 } 969 } 970 return false; 971 } 972 973 static int64_t blkdebug_getlength(BlockDriverState *bs) 974 { 975 return bdrv_getlength(bs->file->bs); 976 } 977 978 static void blkdebug_refresh_filename(BlockDriverState *bs) 979 { 980 BDRVBlkdebugState *s = bs->opaque; 981 const QDictEntry *e; 982 int ret; 983 984 if (!bs->file->bs->exact_filename[0]) { 985 return; 986 } 987 988 for (e = qdict_first(bs->full_open_options); e; 989 e = qdict_next(bs->full_open_options, e)) 990 { 991 /* Real child options are under "image", but "x-image" may 992 * contain a filename */ 993 if (strcmp(qdict_entry_key(e), "config") && 994 strcmp(qdict_entry_key(e), "image") && 995 strcmp(qdict_entry_key(e), "x-image") && 996 strcmp(qdict_entry_key(e), "driver")) 997 { 998 return; 999 } 1000 } 1001 1002 ret = snprintf(bs->exact_filename, sizeof(bs->exact_filename), 1003 "blkdebug:%s:%s", 1004 s->config_file ?: "", bs->file->bs->exact_filename); 1005 if (ret >= sizeof(bs->exact_filename)) { 1006 /* An overflow makes the filename unusable, so do not report any */ 1007 bs->exact_filename[0] = 0; 1008 } 1009 } 1010 1011 static void blkdebug_refresh_limits(BlockDriverState *bs, Error **errp) 1012 { 1013 BDRVBlkdebugState *s = bs->opaque; 1014 1015 if (s->align) { 1016 bs->bl.request_alignment = s->align; 1017 } 1018 if (s->max_transfer) { 1019 bs->bl.max_transfer = s->max_transfer; 1020 } 1021 if (s->opt_write_zero) { 1022 bs->bl.pwrite_zeroes_alignment = s->opt_write_zero; 1023 } 1024 if (s->max_write_zero) { 1025 bs->bl.max_pwrite_zeroes = s->max_write_zero; 1026 } 1027 if (s->opt_discard) { 1028 bs->bl.pdiscard_alignment = s->opt_discard; 1029 } 1030 if (s->max_discard) { 1031 bs->bl.max_pdiscard = s->max_discard; 1032 } 1033 } 1034 1035 static int blkdebug_reopen_prepare(BDRVReopenState *reopen_state, 1036 BlockReopenQueue *queue, Error **errp) 1037 { 1038 return 0; 1039 } 1040 1041 static void blkdebug_child_perm(BlockDriverState *bs, BdrvChild *c, 1042 BdrvChildRole role, 1043 BlockReopenQueue *reopen_queue, 1044 uint64_t perm, uint64_t shared, 1045 uint64_t *nperm, uint64_t *nshared) 1046 { 1047 BDRVBlkdebugState *s = bs->opaque; 1048 1049 bdrv_default_perms(bs, c, role, reopen_queue, 1050 perm, shared, nperm, nshared); 1051 1052 *nperm |= s->take_child_perms; 1053 *nshared &= ~s->unshare_child_perms; 1054 } 1055 1056 static const char *const blkdebug_strong_runtime_opts[] = { 1057 "config", 1058 "inject-error.", 1059 "set-state.", 1060 "align", 1061 "max-transfer", 1062 "opt-write-zero", 1063 "max-write-zero", 1064 "opt-discard", 1065 "max-discard", 1066 1067 NULL 1068 }; 1069 1070 static BlockDriver bdrv_blkdebug = { 1071 .format_name = "blkdebug", 1072 .protocol_name = "blkdebug", 1073 .instance_size = sizeof(BDRVBlkdebugState), 1074 .is_filter = true, 1075 1076 .bdrv_parse_filename = blkdebug_parse_filename, 1077 .bdrv_file_open = blkdebug_open, 1078 .bdrv_close = blkdebug_close, 1079 .bdrv_reopen_prepare = blkdebug_reopen_prepare, 1080 .bdrv_child_perm = blkdebug_child_perm, 1081 1082 .bdrv_getlength = blkdebug_getlength, 1083 .bdrv_refresh_filename = blkdebug_refresh_filename, 1084 .bdrv_refresh_limits = blkdebug_refresh_limits, 1085 1086 .bdrv_co_preadv = blkdebug_co_preadv, 1087 .bdrv_co_pwritev = blkdebug_co_pwritev, 1088 .bdrv_co_flush_to_disk = blkdebug_co_flush, 1089 .bdrv_co_pwrite_zeroes = blkdebug_co_pwrite_zeroes, 1090 .bdrv_co_pdiscard = blkdebug_co_pdiscard, 1091 .bdrv_co_block_status = blkdebug_co_block_status, 1092 1093 .bdrv_debug_event = blkdebug_debug_event, 1094 .bdrv_debug_breakpoint = blkdebug_debug_breakpoint, 1095 .bdrv_debug_remove_breakpoint 1096 = blkdebug_debug_remove_breakpoint, 1097 .bdrv_debug_resume = blkdebug_debug_resume, 1098 .bdrv_debug_is_suspended = blkdebug_debug_is_suspended, 1099 1100 .strong_runtime_opts = blkdebug_strong_runtime_opts, 1101 }; 1102 1103 static void bdrv_blkdebug_init(void) 1104 { 1105 bdrv_register(&bdrv_blkdebug); 1106 } 1107 1108 block_init(bdrv_blkdebug_init); 1109