ppc/xics: preserve P and Q bits for KVM IRQs
[qemu/ar7.git] / block / blkdebug.c
blob3c088934db1b21e320dae18c200d4859051d46ba
1 /*
2 * Block protocol for I/O error injection
4 * Copyright (c) 2010 Kevin Wolf <kwolf@redhat.com>
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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.
25 #include "qemu/osdep.h"
26 #include "qapi/error.h"
27 #include "qemu/cutils.h"
28 #include "qemu/config-file.h"
29 #include "block/block_int.h"
30 #include "qemu/module.h"
31 #include "qapi/qmp/qbool.h"
32 #include "qapi/qmp/qdict.h"
33 #include "qapi/qmp/qint.h"
34 #include "qapi/qmp/qstring.h"
35 #include "sysemu/qtest.h"
37 typedef struct BDRVBlkdebugState {
38 int state;
39 int new_state;
40 int align;
42 /* For blkdebug_refresh_filename() */
43 char *config_file;
45 QLIST_HEAD(, BlkdebugRule) rules[BLKDBG__MAX];
46 QSIMPLEQ_HEAD(, BlkdebugRule) active_rules;
47 QLIST_HEAD(, BlkdebugSuspendedReq) suspended_reqs;
48 } BDRVBlkdebugState;
50 typedef struct BlkdebugAIOCB {
51 BlockAIOCB common;
52 int ret;
53 } BlkdebugAIOCB;
55 typedef struct BlkdebugSuspendedReq {
56 Coroutine *co;
57 char *tag;
58 QLIST_ENTRY(BlkdebugSuspendedReq) next;
59 } BlkdebugSuspendedReq;
61 enum {
62 ACTION_INJECT_ERROR,
63 ACTION_SET_STATE,
64 ACTION_SUSPEND,
67 typedef struct BlkdebugRule {
68 BlkdebugEvent event;
69 int action;
70 int state;
71 union {
72 struct {
73 int error;
74 int immediately;
75 int once;
76 int64_t offset;
77 } inject;
78 struct {
79 int new_state;
80 } set_state;
81 struct {
82 char *tag;
83 } suspend;
84 } options;
85 QLIST_ENTRY(BlkdebugRule) next;
86 QSIMPLEQ_ENTRY(BlkdebugRule) active_next;
87 } BlkdebugRule;
89 static QemuOptsList inject_error_opts = {
90 .name = "inject-error",
91 .head = QTAILQ_HEAD_INITIALIZER(inject_error_opts.head),
92 .desc = {
94 .name = "event",
95 .type = QEMU_OPT_STRING,
98 .name = "state",
99 .type = QEMU_OPT_NUMBER,
102 .name = "errno",
103 .type = QEMU_OPT_NUMBER,
106 .name = "sector",
107 .type = QEMU_OPT_NUMBER,
110 .name = "once",
111 .type = QEMU_OPT_BOOL,
114 .name = "immediately",
115 .type = QEMU_OPT_BOOL,
117 { /* end of list */ }
121 static QemuOptsList set_state_opts = {
122 .name = "set-state",
123 .head = QTAILQ_HEAD_INITIALIZER(set_state_opts.head),
124 .desc = {
126 .name = "event",
127 .type = QEMU_OPT_STRING,
130 .name = "state",
131 .type = QEMU_OPT_NUMBER,
134 .name = "new_state",
135 .type = QEMU_OPT_NUMBER,
137 { /* end of list */ }
141 static QemuOptsList *config_groups[] = {
142 &inject_error_opts,
143 &set_state_opts,
144 NULL
147 static int get_event_by_name(const char *name, BlkdebugEvent *event)
149 int i;
151 for (i = 0; i < BLKDBG__MAX; i++) {
152 if (!strcmp(BlkdebugEvent_lookup[i], name)) {
153 *event = i;
154 return 0;
158 return -1;
161 struct add_rule_data {
162 BDRVBlkdebugState *s;
163 int action;
166 static int add_rule(void *opaque, QemuOpts *opts, Error **errp)
168 struct add_rule_data *d = opaque;
169 BDRVBlkdebugState *s = d->s;
170 const char* event_name;
171 BlkdebugEvent event;
172 struct BlkdebugRule *rule;
173 int64_t sector;
175 /* Find the right event for the rule */
176 event_name = qemu_opt_get(opts, "event");
177 if (!event_name) {
178 error_setg(errp, "Missing event name for rule");
179 return -1;
180 } else if (get_event_by_name(event_name, &event) < 0) {
181 error_setg(errp, "Invalid event name \"%s\"", event_name);
182 return -1;
185 /* Set attributes common for all actions */
186 rule = g_malloc0(sizeof(*rule));
187 *rule = (struct BlkdebugRule) {
188 .event = event,
189 .action = d->action,
190 .state = qemu_opt_get_number(opts, "state", 0),
193 /* Parse action-specific options */
194 switch (d->action) {
195 case ACTION_INJECT_ERROR:
196 rule->options.inject.error = qemu_opt_get_number(opts, "errno", EIO);
197 rule->options.inject.once = qemu_opt_get_bool(opts, "once", 0);
198 rule->options.inject.immediately =
199 qemu_opt_get_bool(opts, "immediately", 0);
200 sector = qemu_opt_get_number(opts, "sector", -1);
201 rule->options.inject.offset =
202 sector == -1 ? -1 : sector * BDRV_SECTOR_SIZE;
203 break;
205 case ACTION_SET_STATE:
206 rule->options.set_state.new_state =
207 qemu_opt_get_number(opts, "new_state", 0);
208 break;
210 case ACTION_SUSPEND:
211 rule->options.suspend.tag =
212 g_strdup(qemu_opt_get(opts, "tag"));
213 break;
216 /* Add the rule */
217 QLIST_INSERT_HEAD(&s->rules[event], rule, next);
219 return 0;
222 static void remove_rule(BlkdebugRule *rule)
224 switch (rule->action) {
225 case ACTION_INJECT_ERROR:
226 case ACTION_SET_STATE:
227 break;
228 case ACTION_SUSPEND:
229 g_free(rule->options.suspend.tag);
230 break;
233 QLIST_REMOVE(rule, next);
234 g_free(rule);
237 static int read_config(BDRVBlkdebugState *s, const char *filename,
238 QDict *options, Error **errp)
240 FILE *f = NULL;
241 int ret;
242 struct add_rule_data d;
243 Error *local_err = NULL;
245 if (filename) {
246 f = fopen(filename, "r");
247 if (f == NULL) {
248 error_setg_errno(errp, errno, "Could not read blkdebug config file");
249 return -errno;
252 ret = qemu_config_parse(f, config_groups, filename);
253 if (ret < 0) {
254 error_setg(errp, "Could not parse blkdebug config file");
255 ret = -EINVAL;
256 goto fail;
260 qemu_config_parse_qdict(options, config_groups, &local_err);
261 if (local_err) {
262 error_propagate(errp, local_err);
263 ret = -EINVAL;
264 goto fail;
267 d.s = s;
268 d.action = ACTION_INJECT_ERROR;
269 qemu_opts_foreach(&inject_error_opts, add_rule, &d, &local_err);
270 if (local_err) {
271 error_propagate(errp, local_err);
272 ret = -EINVAL;
273 goto fail;
276 d.action = ACTION_SET_STATE;
277 qemu_opts_foreach(&set_state_opts, add_rule, &d, &local_err);
278 if (local_err) {
279 error_propagate(errp, local_err);
280 ret = -EINVAL;
281 goto fail;
284 ret = 0;
285 fail:
286 qemu_opts_reset(&inject_error_opts);
287 qemu_opts_reset(&set_state_opts);
288 if (f) {
289 fclose(f);
291 return ret;
294 /* Valid blkdebug filenames look like blkdebug:path/to/config:path/to/image */
295 static void blkdebug_parse_filename(const char *filename, QDict *options,
296 Error **errp)
298 const char *c;
300 /* Parse the blkdebug: prefix */
301 if (!strstart(filename, "blkdebug:", &filename)) {
302 /* There was no prefix; therefore, all options have to be already
303 present in the QDict (except for the filename) */
304 qdict_put_str(options, "x-image", filename);
305 return;
308 /* Parse config file path */
309 c = strchr(filename, ':');
310 if (c == NULL) {
311 error_setg(errp, "blkdebug requires both config file and image path");
312 return;
315 if (c != filename) {
316 QString *config_path;
317 config_path = qstring_from_substr(filename, 0, c - filename - 1);
318 qdict_put(options, "config", config_path);
321 /* TODO Allow multi-level nesting and set file.filename here */
322 filename = c + 1;
323 qdict_put_str(options, "x-image", filename);
326 static QemuOptsList runtime_opts = {
327 .name = "blkdebug",
328 .head = QTAILQ_HEAD_INITIALIZER(runtime_opts.head),
329 .desc = {
331 .name = "config",
332 .type = QEMU_OPT_STRING,
333 .help = "Path to the configuration file",
336 .name = "x-image",
337 .type = QEMU_OPT_STRING,
338 .help = "[internal use only, will be removed]",
341 .name = "align",
342 .type = QEMU_OPT_SIZE,
343 .help = "Required alignment in bytes",
345 { /* end of list */ }
349 static int blkdebug_open(BlockDriverState *bs, QDict *options, int flags,
350 Error **errp)
352 BDRVBlkdebugState *s = bs->opaque;
353 QemuOpts *opts;
354 Error *local_err = NULL;
355 uint64_t align;
356 int ret;
358 opts = qemu_opts_create(&runtime_opts, NULL, 0, &error_abort);
359 qemu_opts_absorb_qdict(opts, options, &local_err);
360 if (local_err) {
361 error_propagate(errp, local_err);
362 ret = -EINVAL;
363 goto out;
366 /* Read rules from config file or command line options */
367 s->config_file = g_strdup(qemu_opt_get(opts, "config"));
368 ret = read_config(s, s->config_file, options, errp);
369 if (ret) {
370 goto out;
373 /* Set initial state */
374 s->state = 1;
376 /* Open the image file */
377 bs->file = bdrv_open_child(qemu_opt_get(opts, "x-image"), options, "image",
378 bs, &child_file, false, &local_err);
379 if (local_err) {
380 ret = -EINVAL;
381 error_propagate(errp, local_err);
382 goto out;
385 /* Set request alignment */
386 align = qemu_opt_get_size(opts, "align", 0);
387 if (align < INT_MAX && is_power_of_2(align)) {
388 s->align = align;
389 } else if (align) {
390 error_setg(errp, "Invalid alignment");
391 ret = -EINVAL;
392 goto out;
395 ret = 0;
396 goto out;
398 out:
399 if (ret < 0) {
400 g_free(s->config_file);
402 qemu_opts_del(opts);
403 return ret;
406 static int inject_error(BlockDriverState *bs, BlkdebugRule *rule)
408 BDRVBlkdebugState *s = bs->opaque;
409 int error = rule->options.inject.error;
410 bool immediately = rule->options.inject.immediately;
412 if (rule->options.inject.once) {
413 QSIMPLEQ_REMOVE(&s->active_rules, rule, BlkdebugRule, active_next);
414 remove_rule(rule);
417 if (!immediately) {
418 aio_co_schedule(qemu_get_current_aio_context(), qemu_coroutine_self());
419 qemu_coroutine_yield();
422 return -error;
425 static int coroutine_fn
426 blkdebug_co_preadv(BlockDriverState *bs, uint64_t offset, uint64_t bytes,
427 QEMUIOVector *qiov, int flags)
429 BDRVBlkdebugState *s = bs->opaque;
430 BlkdebugRule *rule = NULL;
432 QSIMPLEQ_FOREACH(rule, &s->active_rules, active_next) {
433 uint64_t inject_offset = rule->options.inject.offset;
435 if (inject_offset == -1 ||
436 (inject_offset >= offset && inject_offset < offset + bytes))
438 break;
442 if (rule && rule->options.inject.error) {
443 return inject_error(bs, rule);
446 return bdrv_co_preadv(bs->file, offset, bytes, qiov, flags);
449 static int coroutine_fn
450 blkdebug_co_pwritev(BlockDriverState *bs, uint64_t offset, uint64_t bytes,
451 QEMUIOVector *qiov, int flags)
453 BDRVBlkdebugState *s = bs->opaque;
454 BlkdebugRule *rule = NULL;
456 QSIMPLEQ_FOREACH(rule, &s->active_rules, active_next) {
457 uint64_t inject_offset = rule->options.inject.offset;
459 if (inject_offset == -1 ||
460 (inject_offset >= offset && inject_offset < offset + bytes))
462 break;
466 if (rule && rule->options.inject.error) {
467 return inject_error(bs, rule);
470 return bdrv_co_pwritev(bs->file, offset, bytes, qiov, flags);
473 static int blkdebug_co_flush(BlockDriverState *bs)
475 BDRVBlkdebugState *s = bs->opaque;
476 BlkdebugRule *rule = NULL;
478 QSIMPLEQ_FOREACH(rule, &s->active_rules, active_next) {
479 if (rule->options.inject.offset == -1) {
480 break;
484 if (rule && rule->options.inject.error) {
485 return inject_error(bs, rule);
488 return bdrv_co_flush(bs->file->bs);
492 static void blkdebug_close(BlockDriverState *bs)
494 BDRVBlkdebugState *s = bs->opaque;
495 BlkdebugRule *rule, *next;
496 int i;
498 for (i = 0; i < BLKDBG__MAX; i++) {
499 QLIST_FOREACH_SAFE(rule, &s->rules[i], next, next) {
500 remove_rule(rule);
504 g_free(s->config_file);
507 static void suspend_request(BlockDriverState *bs, BlkdebugRule *rule)
509 BDRVBlkdebugState *s = bs->opaque;
510 BlkdebugSuspendedReq r;
512 r = (BlkdebugSuspendedReq) {
513 .co = qemu_coroutine_self(),
514 .tag = g_strdup(rule->options.suspend.tag),
517 remove_rule(rule);
518 QLIST_INSERT_HEAD(&s->suspended_reqs, &r, next);
520 if (!qtest_enabled()) {
521 printf("blkdebug: Suspended request '%s'\n", r.tag);
523 qemu_coroutine_yield();
524 if (!qtest_enabled()) {
525 printf("blkdebug: Resuming request '%s'\n", r.tag);
528 QLIST_REMOVE(&r, next);
529 g_free(r.tag);
532 static bool process_rule(BlockDriverState *bs, struct BlkdebugRule *rule,
533 bool injected)
535 BDRVBlkdebugState *s = bs->opaque;
537 /* Only process rules for the current state */
538 if (rule->state && rule->state != s->state) {
539 return injected;
542 /* Take the action */
543 switch (rule->action) {
544 case ACTION_INJECT_ERROR:
545 if (!injected) {
546 QSIMPLEQ_INIT(&s->active_rules);
547 injected = true;
549 QSIMPLEQ_INSERT_HEAD(&s->active_rules, rule, active_next);
550 break;
552 case ACTION_SET_STATE:
553 s->new_state = rule->options.set_state.new_state;
554 break;
556 case ACTION_SUSPEND:
557 suspend_request(bs, rule);
558 break;
560 return injected;
563 static void blkdebug_debug_event(BlockDriverState *bs, BlkdebugEvent event)
565 BDRVBlkdebugState *s = bs->opaque;
566 struct BlkdebugRule *rule, *next;
567 bool injected;
569 assert((int)event >= 0 && event < BLKDBG__MAX);
571 injected = false;
572 s->new_state = s->state;
573 QLIST_FOREACH_SAFE(rule, &s->rules[event], next, next) {
574 injected = process_rule(bs, rule, injected);
576 s->state = s->new_state;
579 static int blkdebug_debug_breakpoint(BlockDriverState *bs, const char *event,
580 const char *tag)
582 BDRVBlkdebugState *s = bs->opaque;
583 struct BlkdebugRule *rule;
584 BlkdebugEvent blkdebug_event;
586 if (get_event_by_name(event, &blkdebug_event) < 0) {
587 return -ENOENT;
591 rule = g_malloc(sizeof(*rule));
592 *rule = (struct BlkdebugRule) {
593 .event = blkdebug_event,
594 .action = ACTION_SUSPEND,
595 .state = 0,
596 .options.suspend.tag = g_strdup(tag),
599 QLIST_INSERT_HEAD(&s->rules[blkdebug_event], rule, next);
601 return 0;
604 static int blkdebug_debug_resume(BlockDriverState *bs, const char *tag)
606 BDRVBlkdebugState *s = bs->opaque;
607 BlkdebugSuspendedReq *r, *next;
609 QLIST_FOREACH_SAFE(r, &s->suspended_reqs, next, next) {
610 if (!strcmp(r->tag, tag)) {
611 qemu_coroutine_enter(r->co);
612 return 0;
615 return -ENOENT;
618 static int blkdebug_debug_remove_breakpoint(BlockDriverState *bs,
619 const char *tag)
621 BDRVBlkdebugState *s = bs->opaque;
622 BlkdebugSuspendedReq *r, *r_next;
623 BlkdebugRule *rule, *next;
624 int i, ret = -ENOENT;
626 for (i = 0; i < BLKDBG__MAX; i++) {
627 QLIST_FOREACH_SAFE(rule, &s->rules[i], next, next) {
628 if (rule->action == ACTION_SUSPEND &&
629 !strcmp(rule->options.suspend.tag, tag)) {
630 remove_rule(rule);
631 ret = 0;
635 QLIST_FOREACH_SAFE(r, &s->suspended_reqs, next, r_next) {
636 if (!strcmp(r->tag, tag)) {
637 qemu_coroutine_enter(r->co);
638 ret = 0;
641 return ret;
644 static bool blkdebug_debug_is_suspended(BlockDriverState *bs, const char *tag)
646 BDRVBlkdebugState *s = bs->opaque;
647 BlkdebugSuspendedReq *r;
649 QLIST_FOREACH(r, &s->suspended_reqs, next) {
650 if (!strcmp(r->tag, tag)) {
651 return true;
654 return false;
657 static int64_t blkdebug_getlength(BlockDriverState *bs)
659 return bdrv_getlength(bs->file->bs);
662 static int blkdebug_truncate(BlockDriverState *bs, int64_t offset, Error **errp)
664 return bdrv_truncate(bs->file, offset, errp);
667 static void blkdebug_refresh_filename(BlockDriverState *bs, QDict *options)
669 BDRVBlkdebugState *s = bs->opaque;
670 QDict *opts;
671 const QDictEntry *e;
672 bool force_json = false;
674 for (e = qdict_first(options); e; e = qdict_next(options, e)) {
675 if (strcmp(qdict_entry_key(e), "config") &&
676 strcmp(qdict_entry_key(e), "x-image"))
678 force_json = true;
679 break;
683 if (force_json && !bs->file->bs->full_open_options) {
684 /* The config file cannot be recreated, so creating a plain filename
685 * is impossible */
686 return;
689 if (!force_json && bs->file->bs->exact_filename[0]) {
690 snprintf(bs->exact_filename, sizeof(bs->exact_filename),
691 "blkdebug:%s:%s", s->config_file ?: "",
692 bs->file->bs->exact_filename);
695 opts = qdict_new();
696 qdict_put_str(opts, "driver", "blkdebug");
698 QINCREF(bs->file->bs->full_open_options);
699 qdict_put(opts, "image", bs->file->bs->full_open_options);
701 for (e = qdict_first(options); e; e = qdict_next(options, e)) {
702 if (strcmp(qdict_entry_key(e), "x-image")) {
703 qobject_incref(qdict_entry_value(e));
704 qdict_put_obj(opts, qdict_entry_key(e), qdict_entry_value(e));
708 bs->full_open_options = opts;
711 static void blkdebug_refresh_limits(BlockDriverState *bs, Error **errp)
713 BDRVBlkdebugState *s = bs->opaque;
715 if (s->align) {
716 bs->bl.request_alignment = s->align;
720 static int blkdebug_reopen_prepare(BDRVReopenState *reopen_state,
721 BlockReopenQueue *queue, Error **errp)
723 return 0;
726 static BlockDriver bdrv_blkdebug = {
727 .format_name = "blkdebug",
728 .protocol_name = "blkdebug",
729 .instance_size = sizeof(BDRVBlkdebugState),
731 .bdrv_parse_filename = blkdebug_parse_filename,
732 .bdrv_file_open = blkdebug_open,
733 .bdrv_close = blkdebug_close,
734 .bdrv_reopen_prepare = blkdebug_reopen_prepare,
735 .bdrv_child_perm = bdrv_filter_default_perms,
737 .bdrv_getlength = blkdebug_getlength,
738 .bdrv_truncate = blkdebug_truncate,
739 .bdrv_refresh_filename = blkdebug_refresh_filename,
740 .bdrv_refresh_limits = blkdebug_refresh_limits,
742 .bdrv_co_preadv = blkdebug_co_preadv,
743 .bdrv_co_pwritev = blkdebug_co_pwritev,
744 .bdrv_co_flush_to_disk = blkdebug_co_flush,
746 .bdrv_debug_event = blkdebug_debug_event,
747 .bdrv_debug_breakpoint = blkdebug_debug_breakpoint,
748 .bdrv_debug_remove_breakpoint
749 = blkdebug_debug_remove_breakpoint,
750 .bdrv_debug_resume = blkdebug_debug_resume,
751 .bdrv_debug_is_suspended = blkdebug_debug_is_suspended,
754 static void bdrv_blkdebug_init(void)
756 bdrv_register(&bdrv_blkdebug);
759 block_init(bdrv_blkdebug_init);