cpus.c 36.1 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27
/*
 * QEMU System Emulator
 *
 * Copyright (c) 2003-2008 Fabrice Bellard
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

/* Needed early for CONFIG_BSD etc. */
#include "config-host.h"

28
#include "monitor/monitor.h"
29
#include "sysemu/sysemu.h"
30
#include "exec/gdbstub.h"
31 32
#include "sysemu/dma.h"
#include "sysemu/kvm.h"
L
Luiz Capitulino 已提交
33
#include "qmp-commands.h"
34

35
#include "qemu/thread.h"
36 37
#include "sysemu/cpus.h"
#include "sysemu/qtest.h"
38 39
#include "qemu/main-loop.h"
#include "qemu/bitmap.h"
40
#include "qemu/seqlock.h"
J
Jan Kiszka 已提交
41 42

#ifndef _WIN32
43
#include "qemu/compatfd.h"
J
Jan Kiszka 已提交
44
#endif
45

46 47 48 49
#ifdef CONFIG_LINUX

#include <sys/prctl.h>

M
Marcelo Tosatti 已提交
50 51 52 53
#ifndef PR_MCE_KILL
#define PR_MCE_KILL 33
#endif

54 55 56 57 58 59 60 61 62 63
#ifndef PR_MCE_KILL_SET
#define PR_MCE_KILL_SET 1
#endif

#ifndef PR_MCE_KILL_EARLY
#define PR_MCE_KILL_EARLY 1
#endif

#endif /* CONFIG_LINUX */

64
static CPUState *next_cpu;
65

66 67 68 69 70
bool cpu_is_stopped(CPUState *cpu)
{
    return cpu->stopped || !runstate_is_running();
}

71
static bool cpu_thread_is_idle(CPUState *cpu)
72
{
73
    if (cpu->stop || cpu->queued_work_first) {
74 75
        return false;
    }
76
    if (cpu_is_stopped(cpu)) {
77 78
        return true;
    }
79
    if (!cpu->halted || qemu_cpu_has_work(cpu) ||
80
        kvm_halt_in_kernel()) {
81 82 83 84 85 86 87
        return false;
    }
    return true;
}

static bool all_cpu_threads_idle(void)
{
88
    CPUState *cpu;
89

A
Andreas Färber 已提交
90
    CPU_FOREACH(cpu) {
91
        if (!cpu_thread_is_idle(cpu)) {
92 93 94 95 96 97
            return false;
        }
    }
    return true;
}

P
Paolo Bonzini 已提交
98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113
/***********************************************************/
/* guest cycle counter */

/* Conversion factor from emulated instructions to virtual clock ticks.  */
static int icount_time_shift;
/* Arbitrarily pick 1MIPS as the minimum allowable speed.  */
#define MAX_ICOUNT_SHIFT 10
/* Compensate for varying guest execution speed.  */
static int64_t qemu_icount_bias;
static QEMUTimer *icount_rt_timer;
static QEMUTimer *icount_vm_timer;
static QEMUTimer *icount_warp_timer;
static int64_t vm_clock_warp_start;
static int64_t qemu_icount;

typedef struct TimersState {
114
    /* Protected by BQL.  */
P
Paolo Bonzini 已提交
115 116
    int64_t cpu_ticks_prev;
    int64_t cpu_ticks_offset;
117 118 119 120 121

    /* cpu_clock_offset can be read out of BQL, so protect it with
     * this lock.
     */
    QemuSeqLock vm_clock_seqlock;
P
Paolo Bonzini 已提交
122 123 124 125 126
    int64_t cpu_clock_offset;
    int32_t cpu_ticks_enabled;
    int64_t dummy;
} TimersState;

L
Liu Ping Fan 已提交
127
static TimersState timers_state;
P
Paolo Bonzini 已提交
128 129 130 131 132

/* Return the virtual CPU time, based on the instruction counter.  */
int64_t cpu_get_icount(void)
{
    int64_t icount;
133
    CPUState *cpu = current_cpu;
P
Paolo Bonzini 已提交
134 135

    icount = qemu_icount;
136 137
    if (cpu) {
        CPUArchState *env = cpu->env_ptr;
P
Paolo Bonzini 已提交
138 139 140 141 142 143 144 145 146
        if (!can_do_io(env)) {
            fprintf(stderr, "Bad clock read\n");
        }
        icount -= (env->icount_decr.u16.low + env->icount_extra);
    }
    return qemu_icount_bias + (icount << icount_time_shift);
}

/* return the host CPU cycle counter and handle stop/restart */
147
/* Caller must hold the BQL */
P
Paolo Bonzini 已提交
148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167
int64_t cpu_get_ticks(void)
{
    if (use_icount) {
        return cpu_get_icount();
    }
    if (!timers_state.cpu_ticks_enabled) {
        return timers_state.cpu_ticks_offset;
    } else {
        int64_t ticks;
        ticks = cpu_get_real_ticks();
        if (timers_state.cpu_ticks_prev > ticks) {
            /* Note: non increasing ticks may happen if the host uses
               software suspend */
            timers_state.cpu_ticks_offset += timers_state.cpu_ticks_prev - ticks;
        }
        timers_state.cpu_ticks_prev = ticks;
        return ticks + timers_state.cpu_ticks_offset;
    }
}

168
static int64_t cpu_get_clock_locked(void)
P
Paolo Bonzini 已提交
169 170
{
    int64_t ti;
171

P
Paolo Bonzini 已提交
172
    if (!timers_state.cpu_ticks_enabled) {
173
        ti = timers_state.cpu_clock_offset;
P
Paolo Bonzini 已提交
174 175
    } else {
        ti = get_clock();
176
        ti += timers_state.cpu_clock_offset;
P
Paolo Bonzini 已提交
177
    }
178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193

    return ti;
}

/* return the host CPU monotonic timer and handle stop/restart */
int64_t cpu_get_clock(void)
{
    int64_t ti;
    unsigned start;

    do {
        start = seqlock_read_begin(&timers_state.vm_clock_seqlock);
        ti = cpu_get_clock_locked();
    } while (seqlock_read_retry(&timers_state.vm_clock_seqlock, start));

    return ti;
P
Paolo Bonzini 已提交
194 195
}

196 197 198
/* enable cpu_get_ticks()
 * Caller must hold BQL which server as mutex for vm_clock_seqlock.
 */
P
Paolo Bonzini 已提交
199 200
void cpu_enable_ticks(void)
{
201 202
    /* Here, the really thing protected by seqlock is cpu_clock_offset. */
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
203 204 205 206 207
    if (!timers_state.cpu_ticks_enabled) {
        timers_state.cpu_ticks_offset -= cpu_get_real_ticks();
        timers_state.cpu_clock_offset -= get_clock();
        timers_state.cpu_ticks_enabled = 1;
    }
208
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
209 210 211
}

/* disable cpu_get_ticks() : the clock is stopped. You must not call
212 213 214
 * cpu_get_ticks() after that.
 * Caller must hold BQL which server as mutex for vm_clock_seqlock.
 */
P
Paolo Bonzini 已提交
215 216
void cpu_disable_ticks(void)
{
217 218
    /* Here, the really thing protected by seqlock is cpu_clock_offset. */
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
219 220
    if (timers_state.cpu_ticks_enabled) {
        timers_state.cpu_ticks_offset = cpu_get_ticks();
221
        timers_state.cpu_clock_offset = cpu_get_clock_locked();
P
Paolo Bonzini 已提交
222 223
        timers_state.cpu_ticks_enabled = 0;
    }
224
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243
}

/* Correlation between real and virtual time is always going to be
   fairly approximate, so ignore small variation.
   When the guest is idle real and virtual time will be aligned in
   the IO wait loop.  */
#define ICOUNT_WOBBLE (get_ticks_per_sec() / 10)

static void icount_adjust(void)
{
    int64_t cur_time;
    int64_t cur_icount;
    int64_t delta;
    static int64_t last_delta;
    /* If the VM is not running, then do nothing.  */
    if (!runstate_is_running()) {
        return;
    }
    cur_time = cpu_get_clock();
244
    cur_icount = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264
    delta = cur_icount - cur_time;
    /* FIXME: This is a very crude algorithm, somewhat prone to oscillation.  */
    if (delta > 0
        && last_delta + ICOUNT_WOBBLE < delta * 2
        && icount_time_shift > 0) {
        /* The guest is getting too far ahead.  Slow time down.  */
        icount_time_shift--;
    }
    if (delta < 0
        && last_delta - ICOUNT_WOBBLE > delta * 2
        && icount_time_shift < MAX_ICOUNT_SHIFT) {
        /* The guest is getting too far behind.  Speed time up.  */
        icount_time_shift++;
    }
    last_delta = delta;
    qemu_icount_bias = cur_icount - (qemu_icount << icount_time_shift);
}

static void icount_adjust_rt(void *opaque)
{
265 266
    timer_mod(icount_rt_timer,
                   qemu_clock_get_ms(QEMU_CLOCK_REALTIME) + 1000);
P
Paolo Bonzini 已提交
267 268 269 270 271
    icount_adjust();
}

static void icount_adjust_vm(void *opaque)
{
272 273 274
    timer_mod(icount_vm_timer,
                   qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
                   get_ticks_per_sec() / 10);
P
Paolo Bonzini 已提交
275 276 277 278 279 280 281 282 283 284 285 286 287 288 289
    icount_adjust();
}

static int64_t qemu_icount_round(int64_t count)
{
    return (count + (1 << icount_time_shift) - 1) >> icount_time_shift;
}

static void icount_warp_rt(void *opaque)
{
    if (vm_clock_warp_start == -1) {
        return;
    }

    if (runstate_is_running()) {
290
        int64_t clock = qemu_clock_get_ns(QEMU_CLOCK_REALTIME);
P
Paolo Bonzini 已提交
291 292 293 294 295
        int64_t warp_delta = clock - vm_clock_warp_start;
        if (use_icount == 1) {
            qemu_icount_bias += warp_delta;
        } else {
            /*
296
             * In adaptive mode, do not let QEMU_CLOCK_VIRTUAL run too
P
Paolo Bonzini 已提交
297 298 299
             * far ahead of real time.
             */
            int64_t cur_time = cpu_get_clock();
300
            int64_t cur_icount = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
301 302 303
            int64_t delta = cur_time - cur_icount;
            qemu_icount_bias += MIN(warp_delta, delta);
        }
304 305
        if (qemu_clock_expired(QEMU_CLOCK_VIRTUAL)) {
            qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
306 307 308 309 310
        }
    }
    vm_clock_warp_start = -1;
}

P
Paolo Bonzini 已提交
311 312
void qtest_clock_warp(int64_t dest)
{
313
    int64_t clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
314 315
    assert(qtest_enabled());
    while (clock < dest) {
316
        int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
317 318
        int64_t warp = MIN(dest - clock, deadline);
        qemu_icount_bias += warp;
319 320
        qemu_clock_run_timers(QEMU_CLOCK_VIRTUAL);
        clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
321
    }
322
    qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
323 324
}

325
void qemu_clock_warp(QEMUClockType type)
P
Paolo Bonzini 已提交
326 327 328 329 330 331 332 333
{
    int64_t deadline;

    /*
     * There are too many global variables to make the "warp" behavior
     * applicable to other clocks.  But a clock argument removes the
     * need for if statements all over the place.
     */
334
    if (type != QEMU_CLOCK_VIRTUAL || !use_icount) {
P
Paolo Bonzini 已提交
335 336 337 338
        return;
    }

    /*
339 340
     * If the CPUs have been sleeping, advance QEMU_CLOCK_VIRTUAL timer now.
     * This ensures that the deadline for the timer is computed correctly below.
P
Paolo Bonzini 已提交
341 342
     * This also makes sure that the insn counter is synchronized before the
     * CPU starts running, in case the CPU is woken by an event other than
343
     * the earliest QEMU_CLOCK_VIRTUAL timer.
P
Paolo Bonzini 已提交
344 345
     */
    icount_warp_rt(NULL);
346 347
    if (!all_cpu_threads_idle() || !qemu_clock_has_timers(QEMU_CLOCK_VIRTUAL)) {
        timer_del(icount_warp_timer);
P
Paolo Bonzini 已提交
348 349 350
        return;
    }

P
Paolo Bonzini 已提交
351 352 353 354 355
    if (qtest_enabled()) {
        /* When testing, qtest commands advance icount.  */
	return;
    }

356
    vm_clock_warp_start = qemu_clock_get_ns(QEMU_CLOCK_REALTIME);
357
    /* We want to use the earliest deadline from ALL vm_clocks */
358
    deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
359 360

    /* Maintain prior (possibly buggy) behaviour where if no deadline
361
     * was set (as there is no QEMU_CLOCK_VIRTUAL timer) or it is more than
362 363 364 365 366 367 368
     * INT32_MAX nanoseconds ahead, we still use INT32_MAX
     * nanoseconds.
     */
    if ((deadline < 0) || (deadline > INT32_MAX)) {
        deadline = INT32_MAX;
    }

P
Paolo Bonzini 已提交
369 370
    if (deadline > 0) {
        /*
371
         * Ensure QEMU_CLOCK_VIRTUAL proceeds even when the virtual CPU goes to
P
Paolo Bonzini 已提交
372 373 374
         * sleep.  Otherwise, the CPU might be waiting for a future timer
         * interrupt to wake it up, but the interrupt never comes because
         * the vCPU isn't running any insns and thus doesn't advance the
375
         * QEMU_CLOCK_VIRTUAL.
P
Paolo Bonzini 已提交
376 377
         *
         * An extreme solution for this problem would be to never let VCPUs
378 379 380 381 382 383 384 385
         * sleep in icount mode if there is a pending QEMU_CLOCK_VIRTUAL
         * timer; rather time could just advance to the next QEMU_CLOCK_VIRTUAL
         * event.  Instead, we do stop VCPUs and only advance QEMU_CLOCK_VIRTUAL
         * after some e"real" time, (related to the time left until the next
         * event) has passed. The QEMU_CLOCK_REALTIME timer will do this.
         * This avoids that the warps are visible externally; for example,
         * you will not be sending network packets continuously instead of
         * every 100ms.
P
Paolo Bonzini 已提交
386
         */
387
        timer_mod(icount_warp_timer, vm_clock_warp_start + deadline);
388
    } else if (deadline == 0) {
389
        qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
    }
}

static const VMStateDescription vmstate_timers = {
    .name = "timer",
    .version_id = 2,
    .minimum_version_id = 1,
    .minimum_version_id_old = 1,
    .fields      = (VMStateField[]) {
        VMSTATE_INT64(cpu_ticks_offset, TimersState),
        VMSTATE_INT64(dummy, TimersState),
        VMSTATE_INT64_V(cpu_clock_offset, TimersState, 2),
        VMSTATE_END_OF_LIST()
    }
};

void configure_icount(const char *option)
{
408
    seqlock_init(&timers_state.vm_clock_seqlock, NULL);
P
Paolo Bonzini 已提交
409 410 411 412 413
    vmstate_register(NULL, 0, &vmstate_timers, &timers_state);
    if (!option) {
        return;
    }

414 415
    icount_warp_timer = timer_new_ns(QEMU_CLOCK_REALTIME,
                                          icount_warp_rt, NULL);
P
Paolo Bonzini 已提交
416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432
    if (strcmp(option, "auto") != 0) {
        icount_time_shift = strtol(option, NULL, 0);
        use_icount = 1;
        return;
    }

    use_icount = 2;

    /* 125MIPS seems a reasonable initial guess at the guest speed.
       It will be corrected fairly quickly anyway.  */
    icount_time_shift = 3;

    /* Have both realtime and virtual time triggers for speed adjustment.
       The realtime trigger catches emulated time passing too slowly,
       the virtual time trigger catches emulated time passing too fast.
       Realtime triggers occur even when idle, so use them less frequently
       than VM triggers.  */
433 434 435 436 437 438 439 440 441
    icount_rt_timer = timer_new_ms(QEMU_CLOCK_REALTIME,
                                        icount_adjust_rt, NULL);
    timer_mod(icount_rt_timer,
                   qemu_clock_get_ms(QEMU_CLOCK_REALTIME) + 1000);
    icount_vm_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
                                        icount_adjust_vm, NULL);
    timer_mod(icount_vm_timer,
                   qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
                   get_ticks_per_sec() / 10);
P
Paolo Bonzini 已提交
442 443
}

444 445 446 447
/***********************************************************/
void hw_error(const char *fmt, ...)
{
    va_list ap;
448
    CPUState *cpu;
449 450 451 452 453

    va_start(ap, fmt);
    fprintf(stderr, "qemu: hardware error: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
A
Andreas Färber 已提交
454
    CPU_FOREACH(cpu) {
455
        fprintf(stderr, "CPU #%d:\n", cpu->cpu_index);
456
        cpu_dump_state(cpu, stderr, fprintf, CPU_DUMP_FPU);
457 458 459 460 461 462 463
    }
    va_end(ap);
    abort();
}

void cpu_synchronize_all_states(void)
{
464
    CPUState *cpu;
465

A
Andreas Färber 已提交
466
    CPU_FOREACH(cpu) {
467
        cpu_synchronize_state(cpu);
468 469 470 471 472
    }
}

void cpu_synchronize_all_post_reset(void)
{
473
    CPUState *cpu;
474

A
Andreas Färber 已提交
475
    CPU_FOREACH(cpu) {
476
        cpu_synchronize_post_reset(cpu);
477 478 479 480 481
    }
}

void cpu_synchronize_all_post_init(void)
{
482
    CPUState *cpu;
483

A
Andreas Färber 已提交
484
    CPU_FOREACH(cpu) {
485
        cpu_synchronize_post_init(cpu);
486 487 488
    }
}

489
static int do_vm_stop(RunState state)
490
{
491 492
    int ret = 0;

493
    if (runstate_is_running()) {
494 495
        cpu_disable_ticks();
        pause_all_vcpus();
496
        runstate_set(state);
497
        vm_state_notify(0, state);
498 499
        monitor_protocol_event(QEVENT_STOP, NULL);
    }
500

501 502 503
    bdrv_drain_all();
    ret = bdrv_flush_all();

504
    return ret;
505 506
}

507
static bool cpu_can_run(CPUState *cpu)
508
{
A
Andreas Färber 已提交
509
    if (cpu->stop) {
510
        return false;
511
    }
512
    if (cpu_is_stopped(cpu)) {
513
        return false;
514
    }
515
    return true;
516 517
}

518
static void cpu_handle_guest_debug(CPUState *cpu)
519
{
520
    gdb_set_stop_cpu(cpu);
521
    qemu_system_debug_request();
522
    cpu->stopped = true;
523 524
}

525 526
static void cpu_signal(int sig)
{
527 528
    if (current_cpu) {
        cpu_exit(current_cpu);
529 530 531 532
    }
    exit_request = 1;
}

533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571
#ifdef CONFIG_LINUX
static void sigbus_reraise(void)
{
    sigset_t set;
    struct sigaction action;

    memset(&action, 0, sizeof(action));
    action.sa_handler = SIG_DFL;
    if (!sigaction(SIGBUS, &action, NULL)) {
        raise(SIGBUS);
        sigemptyset(&set);
        sigaddset(&set, SIGBUS);
        sigprocmask(SIG_UNBLOCK, &set, NULL);
    }
    perror("Failed to re-raise SIGBUS!\n");
    abort();
}

static void sigbus_handler(int n, struct qemu_signalfd_siginfo *siginfo,
                           void *ctx)
{
    if (kvm_on_sigbus(siginfo->ssi_code,
                      (void *)(intptr_t)siginfo->ssi_addr)) {
        sigbus_reraise();
    }
}

static void qemu_init_sigbus(void)
{
    struct sigaction action;

    memset(&action, 0, sizeof(action));
    action.sa_flags = SA_SIGINFO;
    action.sa_sigaction = (void (*)(int, siginfo_t*, void*))sigbus_handler;
    sigaction(SIGBUS, &action, NULL);

    prctl(PR_MCE_KILL, PR_MCE_KILL_SET, PR_MCE_KILL_EARLY, 0, 0);
}

572
static void qemu_kvm_eat_signals(CPUState *cpu)
573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592
{
    struct timespec ts = { 0, 0 };
    siginfo_t siginfo;
    sigset_t waitset;
    sigset_t chkset;
    int r;

    sigemptyset(&waitset);
    sigaddset(&waitset, SIG_IPI);
    sigaddset(&waitset, SIGBUS);

    do {
        r = sigtimedwait(&waitset, &siginfo, &ts);
        if (r == -1 && !(errno == EAGAIN || errno == EINTR)) {
            perror("sigtimedwait");
            exit(1);
        }

        switch (r) {
        case SIGBUS:
593
            if (kvm_on_sigbus_vcpu(cpu, siginfo.si_code, siginfo.si_addr)) {
594 595 596 597 598 599 600 601 602 603 604 605 606 607 608
                sigbus_reraise();
            }
            break;
        default:
            break;
        }

        r = sigpending(&chkset);
        if (r == -1) {
            perror("sigpending");
            exit(1);
        }
    } while (sigismember(&chkset, SIG_IPI) || sigismember(&chkset, SIGBUS));
}

609 610 611 612 613
#else /* !CONFIG_LINUX */

static void qemu_init_sigbus(void)
{
}
614

615
static void qemu_kvm_eat_signals(CPUState *cpu)
616 617
{
}
618 619
#endif /* !CONFIG_LINUX */

620
#ifndef _WIN32
621 622 623 624
static void dummy_signal(int sig)
{
}

625
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
626 627 628 629 630 631 632 633 634 635 636 637
{
    int r;
    sigset_t set;
    struct sigaction sigact;

    memset(&sigact, 0, sizeof(sigact));
    sigact.sa_handler = dummy_signal;
    sigaction(SIG_IPI, &sigact, NULL);

    pthread_sigmask(SIG_BLOCK, NULL, &set);
    sigdelset(&set, SIG_IPI);
    sigdelset(&set, SIGBUS);
638
    r = kvm_set_signal_mask(cpu, &set);
639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658
    if (r) {
        fprintf(stderr, "kvm_set_signal_mask: %s\n", strerror(-r));
        exit(1);
    }
}

static void qemu_tcg_init_cpu_signals(void)
{
    sigset_t set;
    struct sigaction sigact;

    memset(&sigact, 0, sizeof(sigact));
    sigact.sa_handler = cpu_signal;
    sigaction(SIG_IPI, &sigact, NULL);

    sigemptyset(&set);
    sigaddset(&set, SIG_IPI);
    pthread_sigmask(SIG_UNBLOCK, &set, NULL);
}

659
#else /* _WIN32 */
660
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
661
{
662 663
    abort();
}
664

665 666
static void qemu_tcg_init_cpu_signals(void)
{
667
}
668
#endif /* _WIN32 */
669

670
static QemuMutex qemu_global_mutex;
671 672
static QemuCond qemu_io_proceeded_cond;
static bool iothread_requesting_mutex;
673 674 675 676 677 678 679 680 681 682

static QemuThread io_thread;

static QemuThread *tcg_cpu_thread;
static QemuCond *tcg_halt_cond;

/* cpu creation */
static QemuCond qemu_cpu_cond;
/* system init */
static QemuCond qemu_pause_cond;
M
Marcelo Tosatti 已提交
683
static QemuCond qemu_work_cond;
684

P
Paolo Bonzini 已提交
685
void qemu_init_cpu_loop(void)
686
{
687
    qemu_init_sigbus();
688 689 690
    qemu_cond_init(&qemu_cpu_cond);
    qemu_cond_init(&qemu_pause_cond);
    qemu_cond_init(&qemu_work_cond);
691
    qemu_cond_init(&qemu_io_proceeded_cond);
692 693
    qemu_mutex_init(&qemu_global_mutex);

J
Jan Kiszka 已提交
694
    qemu_thread_get_self(&io_thread);
695 696
}

697
void run_on_cpu(CPUState *cpu, void (*func)(void *data), void *data)
M
Marcelo Tosatti 已提交
698 699 700
{
    struct qemu_work_item wi;

701
    if (qemu_cpu_is_self(cpu)) {
M
Marcelo Tosatti 已提交
702 703 704 705 706 707
        func(data);
        return;
    }

    wi.func = func;
    wi.data = data;
C
Chegu Vinod 已提交
708
    wi.free = false;
709 710
    if (cpu->queued_work_first == NULL) {
        cpu->queued_work_first = &wi;
711
    } else {
712
        cpu->queued_work_last->next = &wi;
713
    }
714
    cpu->queued_work_last = &wi;
M
Marcelo Tosatti 已提交
715 716 717
    wi.next = NULL;
    wi.done = false;

718
    qemu_cpu_kick(cpu);
M
Marcelo Tosatti 已提交
719
    while (!wi.done) {
720
        CPUState *self_cpu = current_cpu;
M
Marcelo Tosatti 已提交
721 722

        qemu_cond_wait(&qemu_work_cond, &qemu_global_mutex);
723
        current_cpu = self_cpu;
M
Marcelo Tosatti 已提交
724 725 726
    }
}

C
Chegu Vinod 已提交
727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751
void async_run_on_cpu(CPUState *cpu, void (*func)(void *data), void *data)
{
    struct qemu_work_item *wi;

    if (qemu_cpu_is_self(cpu)) {
        func(data);
        return;
    }

    wi = g_malloc0(sizeof(struct qemu_work_item));
    wi->func = func;
    wi->data = data;
    wi->free = true;
    if (cpu->queued_work_first == NULL) {
        cpu->queued_work_first = wi;
    } else {
        cpu->queued_work_last->next = wi;
    }
    cpu->queued_work_last = wi;
    wi->next = NULL;
    wi->done = false;

    qemu_cpu_kick(cpu);
}

752
static void flush_queued_work(CPUState *cpu)
M
Marcelo Tosatti 已提交
753 754 755
{
    struct qemu_work_item *wi;

756
    if (cpu->queued_work_first == NULL) {
M
Marcelo Tosatti 已提交
757
        return;
758
    }
M
Marcelo Tosatti 已提交
759

760 761
    while ((wi = cpu->queued_work_first)) {
        cpu->queued_work_first = wi->next;
M
Marcelo Tosatti 已提交
762 763
        wi->func(wi->data);
        wi->done = true;
C
Chegu Vinod 已提交
764 765 766
        if (wi->free) {
            g_free(wi);
        }
M
Marcelo Tosatti 已提交
767
    }
768
    cpu->queued_work_last = NULL;
M
Marcelo Tosatti 已提交
769 770 771
    qemu_cond_broadcast(&qemu_work_cond);
}

772
static void qemu_wait_io_event_common(CPUState *cpu)
773
{
A
Andreas Färber 已提交
774 775
    if (cpu->stop) {
        cpu->stop = false;
776
        cpu->stopped = true;
777 778
        qemu_cond_signal(&qemu_pause_cond);
    }
779
    flush_queued_work(cpu);
780
    cpu->thread_kicked = false;
781 782
}

783
static void qemu_tcg_wait_io_event(void)
784
{
785
    CPUState *cpu;
786

787
    while (all_cpu_threads_idle()) {
788 789
       /* Start accounting real time to the virtual clock if the CPUs
          are idle.  */
790
        qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
791
        qemu_cond_wait(tcg_halt_cond, &qemu_global_mutex);
792
    }
793

794 795 796
    while (iothread_requesting_mutex) {
        qemu_cond_wait(&qemu_io_proceeded_cond, &qemu_global_mutex);
    }
797

A
Andreas Färber 已提交
798
    CPU_FOREACH(cpu) {
799
        qemu_wait_io_event_common(cpu);
800
    }
801 802
}

803
static void qemu_kvm_wait_io_event(CPUState *cpu)
804
{
805
    while (cpu_thread_is_idle(cpu)) {
A
Andreas Färber 已提交
806
        qemu_cond_wait(cpu->halt_cond, &qemu_global_mutex);
807
    }
808

809
    qemu_kvm_eat_signals(cpu);
810
    qemu_wait_io_event_common(cpu);
811 812
}

813
static void *qemu_kvm_cpu_thread_fn(void *arg)
814
{
815
    CPUState *cpu = arg;
J
Jan Kiszka 已提交
816
    int r;
817

818
    qemu_mutex_lock(&qemu_global_mutex);
819
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
820
    cpu->thread_id = qemu_get_thread_id();
821
    current_cpu = cpu;
822

823
    r = kvm_init_vcpu(cpu);
J
Jan Kiszka 已提交
824 825 826 827
    if (r < 0) {
        fprintf(stderr, "kvm_init_vcpu failed: %s\n", strerror(-r));
        exit(1);
    }
828

829
    qemu_kvm_init_cpu_signals(cpu);
830 831

    /* signal CPU creation */
832
    cpu->created = true;
833 834 835
    qemu_cond_signal(&qemu_cpu_cond);

    while (1) {
836
        if (cpu_can_run(cpu)) {
837
            r = kvm_cpu_exec(cpu);
838
            if (r == EXCP_DEBUG) {
839
                cpu_handle_guest_debug(cpu);
840
            }
841
        }
842
        qemu_kvm_wait_io_event(cpu);
843 844 845 846 847
    }

    return NULL;
}

A
Anthony Liguori 已提交
848 849 850 851 852 853
static void *qemu_dummy_cpu_thread_fn(void *arg)
{
#ifdef _WIN32
    fprintf(stderr, "qtest is not supported under Windows\n");
    exit(1);
#else
854
    CPUState *cpu = arg;
A
Anthony Liguori 已提交
855 856 857 858
    sigset_t waitset;
    int r;

    qemu_mutex_lock_iothread();
859
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
860
    cpu->thread_id = qemu_get_thread_id();
A
Anthony Liguori 已提交
861 862 863 864 865

    sigemptyset(&waitset);
    sigaddset(&waitset, SIG_IPI);

    /* signal CPU creation */
866
    cpu->created = true;
A
Anthony Liguori 已提交
867 868
    qemu_cond_signal(&qemu_cpu_cond);

869
    current_cpu = cpu;
A
Anthony Liguori 已提交
870
    while (1) {
871
        current_cpu = NULL;
A
Anthony Liguori 已提交
872 873 874 875 876 877 878 879 880 881
        qemu_mutex_unlock_iothread();
        do {
            int sig;
            r = sigwait(&waitset, &sig);
        } while (r == -1 && (errno == EAGAIN || errno == EINTR));
        if (r == -1) {
            perror("sigwait");
            exit(1);
        }
        qemu_mutex_lock_iothread();
882
        current_cpu = cpu;
883
        qemu_wait_io_event_common(cpu);
A
Anthony Liguori 已提交
884 885 886 887 888 889
    }

    return NULL;
#endif
}

J
Jan Kiszka 已提交
890 891
static void tcg_exec_all(void);

892
static void *qemu_tcg_cpu_thread_fn(void *arg)
893
{
894
    CPUState *cpu = arg;
895

896
    qemu_tcg_init_cpu_signals();
897
    qemu_thread_get_self(cpu->thread);
898 899

    qemu_mutex_lock(&qemu_global_mutex);
900 901 902 903
    CPU_FOREACH(cpu) {
        cpu->thread_id = qemu_get_thread_id();
        cpu->created = true;
    }
904 905
    qemu_cond_signal(&qemu_cpu_cond);

906
    /* wait for initial kick-off after machine start */
A
Andreas Färber 已提交
907
    while (QTAILQ_FIRST(&cpus)->stopped) {
908
        qemu_cond_wait(tcg_halt_cond, &qemu_global_mutex);
909 910

        /* process any pending work */
A
Andreas Färber 已提交
911
        CPU_FOREACH(cpu) {
912
            qemu_wait_io_event_common(cpu);
913
        }
914
    }
915 916

    while (1) {
J
Jan Kiszka 已提交
917
        tcg_exec_all();
918 919

        if (use_icount) {
920
            int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
921 922

            if (deadline == 0) {
923
                qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
924
            }
925
        }
926
        qemu_tcg_wait_io_event();
927 928 929 930 931
    }

    return NULL;
}

932
static void qemu_cpu_kick_thread(CPUState *cpu)
P
Paolo Bonzini 已提交
933 934 935 936
{
#ifndef _WIN32
    int err;

937
    err = pthread_kill(cpu->thread->thread, SIG_IPI);
P
Paolo Bonzini 已提交
938 939 940 941 942
    if (err) {
        fprintf(stderr, "qemu:%s: %s", __func__, strerror(err));
        exit(1);
    }
#else /* _WIN32 */
943
    if (!qemu_cpu_is_self(cpu)) {
944 945 946
        CONTEXT tcgContext;

        if (SuspendThread(cpu->hThread) == (DWORD)-1) {
947
            fprintf(stderr, "qemu:%s: GetLastError:%lu\n", __func__,
948 949 950 951 952 953 954 955 956 957 958 959
                    GetLastError());
            exit(1);
        }

        /* On multi-core systems, we are not sure that the thread is actually
         * suspended until we can get the context.
         */
        tcgContext.ContextFlags = CONTEXT_CONTROL;
        while (GetThreadContext(cpu->hThread, &tcgContext) != 0) {
            continue;
        }

P
Paolo Bonzini 已提交
960
        cpu_signal(0);
961 962

        if (ResumeThread(cpu->hThread) == (DWORD)-1) {
963
            fprintf(stderr, "qemu:%s: GetLastError:%lu\n", __func__,
964 965 966
                    GetLastError());
            exit(1);
        }
P
Paolo Bonzini 已提交
967 968 969 970
    }
#endif
}

971
void qemu_cpu_kick(CPUState *cpu)
972
{
A
Andreas Färber 已提交
973
    qemu_cond_broadcast(cpu->halt_cond);
974
    if (!tcg_enabled() && !cpu->thread_kicked) {
975
        qemu_cpu_kick_thread(cpu);
976
        cpu->thread_kicked = true;
977
    }
978 979
}

980
void qemu_cpu_kick_self(void)
981
{
982
#ifndef _WIN32
983
    assert(current_cpu);
984

985 986 987
    if (!current_cpu->thread_kicked) {
        qemu_cpu_kick_thread(current_cpu);
        current_cpu->thread_kicked = true;
988
    }
989 990 991
#else
    abort();
#endif
992 993
}

994
bool qemu_cpu_is_self(CPUState *cpu)
995
{
996
    return qemu_thread_is_self(cpu->thread);
997 998
}

J
Juan Quintela 已提交
999 1000
static bool qemu_in_vcpu_thread(void)
{
1001
    return current_cpu && qemu_cpu_is_self(current_cpu);
J
Juan Quintela 已提交
1002 1003
}

1004 1005
void qemu_mutex_lock_iothread(void)
{
A
Anthony Liguori 已提交
1006
    if (!tcg_enabled()) {
1007
        qemu_mutex_lock(&qemu_global_mutex);
1008
    } else {
1009
        iothread_requesting_mutex = true;
1010
        if (qemu_mutex_trylock(&qemu_global_mutex)) {
1011
            qemu_cpu_kick_thread(first_cpu);
1012 1013
            qemu_mutex_lock(&qemu_global_mutex);
        }
1014 1015
        iothread_requesting_mutex = false;
        qemu_cond_broadcast(&qemu_io_proceeded_cond);
1016
    }
1017 1018 1019 1020 1021 1022 1023 1024 1025
}

void qemu_mutex_unlock_iothread(void)
{
    qemu_mutex_unlock(&qemu_global_mutex);
}

static int all_vcpus_paused(void)
{
A
Andreas Färber 已提交
1026
    CPUState *cpu;
1027

A
Andreas Färber 已提交
1028
    CPU_FOREACH(cpu) {
1029
        if (!cpu->stopped) {
1030
            return 0;
1031
        }
1032 1033 1034 1035 1036 1037 1038
    }

    return 1;
}

void pause_all_vcpus(void)
{
A
Andreas Färber 已提交
1039
    CPUState *cpu;
1040

1041
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, false);
A
Andreas Färber 已提交
1042
    CPU_FOREACH(cpu) {
1043 1044
        cpu->stop = true;
        qemu_cpu_kick(cpu);
1045 1046
    }

J
Juan Quintela 已提交
1047
    if (qemu_in_vcpu_thread()) {
1048 1049
        cpu_stop_current();
        if (!kvm_enabled()) {
A
Andreas Färber 已提交
1050
            CPU_FOREACH(cpu) {
1051 1052
                cpu->stop = false;
                cpu->stopped = true;
1053 1054 1055 1056 1057
            }
            return;
        }
    }

1058
    while (!all_vcpus_paused()) {
1059
        qemu_cond_wait(&qemu_pause_cond, &qemu_global_mutex);
A
Andreas Färber 已提交
1060
        CPU_FOREACH(cpu) {
1061
            qemu_cpu_kick(cpu);
1062 1063 1064 1065
        }
    }
}

1066 1067 1068 1069 1070 1071 1072
void cpu_resume(CPUState *cpu)
{
    cpu->stop = false;
    cpu->stopped = false;
    qemu_cpu_kick(cpu);
}

1073 1074
void resume_all_vcpus(void)
{
A
Andreas Färber 已提交
1075
    CPUState *cpu;
1076

1077
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, true);
A
Andreas Färber 已提交
1078
    CPU_FOREACH(cpu) {
1079
        cpu_resume(cpu);
1080 1081 1082
    }
}

1083
static void qemu_tcg_init_vcpu(CPUState *cpu)
1084 1085 1086
{
    /* share a single thread for all cpus with TCG */
    if (!tcg_cpu_thread) {
1087
        cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1088 1089 1090
        cpu->halt_cond = g_malloc0(sizeof(QemuCond));
        qemu_cond_init(cpu->halt_cond);
        tcg_halt_cond = cpu->halt_cond;
1091
        qemu_thread_create(cpu->thread, qemu_tcg_cpu_thread_fn, cpu,
P
Paolo Bonzini 已提交
1092 1093
                           QEMU_THREAD_JOINABLE);
#ifdef _WIN32
1094
        cpu->hThread = qemu_thread_get_handle(cpu->thread);
P
Paolo Bonzini 已提交
1095
#endif
1096
        while (!cpu->created) {
1097
            qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
1098
        }
1099
        tcg_cpu_thread = cpu->thread;
1100
    } else {
1101
        cpu->thread = tcg_cpu_thread;
A
Andreas Färber 已提交
1102
        cpu->halt_cond = tcg_halt_cond;
1103 1104 1105
    }
}

1106
static void qemu_kvm_start_vcpu(CPUState *cpu)
1107
{
1108
    cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1109 1110
    cpu->halt_cond = g_malloc0(sizeof(QemuCond));
    qemu_cond_init(cpu->halt_cond);
1111
    qemu_thread_create(cpu->thread, qemu_kvm_cpu_thread_fn, cpu,
P
Paolo Bonzini 已提交
1112
                       QEMU_THREAD_JOINABLE);
1113
    while (!cpu->created) {
1114
        qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
1115
    }
1116 1117
}

1118
static void qemu_dummy_start_vcpu(CPUState *cpu)
A
Anthony Liguori 已提交
1119
{
1120
    cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1121 1122
    cpu->halt_cond = g_malloc0(sizeof(QemuCond));
    qemu_cond_init(cpu->halt_cond);
1123
    qemu_thread_create(cpu->thread, qemu_dummy_cpu_thread_fn, cpu,
A
Anthony Liguori 已提交
1124
                       QEMU_THREAD_JOINABLE);
1125
    while (!cpu->created) {
A
Anthony Liguori 已提交
1126 1127 1128 1129
        qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
    }
}

1130
void qemu_init_vcpu(CPUState *cpu)
1131
{
1132 1133
    cpu->nr_cores = smp_cores;
    cpu->nr_threads = smp_threads;
1134
    cpu->stopped = true;
1135
    if (kvm_enabled()) {
1136
        qemu_kvm_start_vcpu(cpu);
A
Anthony Liguori 已提交
1137
    } else if (tcg_enabled()) {
1138
        qemu_tcg_init_vcpu(cpu);
A
Anthony Liguori 已提交
1139
    } else {
1140
        qemu_dummy_start_vcpu(cpu);
1141
    }
1142 1143
}

1144
void cpu_stop_current(void)
1145
{
1146 1147 1148 1149
    if (current_cpu) {
        current_cpu->stop = false;
        current_cpu->stopped = true;
        cpu_exit(current_cpu);
1150
        qemu_cond_signal(&qemu_pause_cond);
1151
    }
1152 1153
}

1154
int vm_stop(RunState state)
1155
{
J
Juan Quintela 已提交
1156
    if (qemu_in_vcpu_thread()) {
1157
        qemu_system_vmstop_request(state);
1158 1159 1160 1161
        /*
         * FIXME: should not return to device code in case
         * vm_stop() has been requested.
         */
1162
        cpu_stop_current();
1163
        return 0;
1164
    }
1165 1166

    return do_vm_stop(state);
1167 1168
}

1169 1170
/* does a state transition even if the VM is already stopped,
   current state is forgotten forever */
1171
int vm_stop_force_state(RunState state)
1172 1173
{
    if (runstate_is_running()) {
1174
        return vm_stop(state);
1175 1176
    } else {
        runstate_set(state);
1177 1178 1179
        /* Make sure to return an error if the flush in a previous vm_stop()
         * failed. */
        return bdrv_flush_all();
1180 1181 1182
    }
}

1183
static int tcg_cpu_exec(CPUArchState *env)
1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
{
    int ret;
#ifdef CONFIG_PROFILER
    int64_t ti;
#endif

#ifdef CONFIG_PROFILER
    ti = profile_getclock();
#endif
    if (use_icount) {
        int64_t count;
1195
        int64_t deadline;
1196 1197 1198 1199
        int decr;
        qemu_icount -= (env->icount_decr.u16.low + env->icount_extra);
        env->icount_decr.u16.low = 0;
        env->icount_extra = 0;
1200
        deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
1201 1202

        /* Maintain prior (possibly buggy) behaviour where if no deadline
1203
         * was set (as there is no QEMU_CLOCK_VIRTUAL timer) or it is more than
1204 1205 1206 1207 1208 1209 1210 1211
         * INT32_MAX nanoseconds ahead, we still use INT32_MAX
         * nanoseconds.
         */
        if ((deadline < 0) || (deadline > INT32_MAX)) {
            deadline = INT32_MAX;
        }

        count = qemu_icount_round(deadline);
1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
        qemu_icount += count;
        decr = (count > 0xffff) ? 0xffff : count;
        count -= decr;
        env->icount_decr.u16.low = decr;
        env->icount_extra = count;
    }
    ret = cpu_exec(env);
#ifdef CONFIG_PROFILER
    qemu_time += profile_getclock() - ti;
#endif
    if (use_icount) {
        /* Fold pending instructions back into the
           instruction counter, and clear the interrupt flag.  */
        qemu_icount -= (env->icount_decr.u16.low
                        + env->icount_extra);
        env->icount_decr.u32 = 0;
        env->icount_extra = 0;
    }
    return ret;
}

J
Jan Kiszka 已提交
1233
static void tcg_exec_all(void)
1234
{
1235 1236
    int r;

1237 1238
    /* Account partial waits to QEMU_CLOCK_VIRTUAL.  */
    qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
1239

1240
    if (next_cpu == NULL) {
1241
        next_cpu = first_cpu;
1242
    }
A
Andreas Färber 已提交
1243
    for (; next_cpu != NULL && !exit_request; next_cpu = CPU_NEXT(next_cpu)) {
1244 1245
        CPUState *cpu = next_cpu;
        CPUArchState *env = cpu->env_ptr;
1246

1247
        qemu_clock_enable(QEMU_CLOCK_VIRTUAL,
1248
                          (cpu->singlestep_enabled & SSTEP_NOTIMER) == 0);
1249

1250
        if (cpu_can_run(cpu)) {
J
Jan Kiszka 已提交
1251
            r = tcg_cpu_exec(env);
1252
            if (r == EXCP_DEBUG) {
1253
                cpu_handle_guest_debug(cpu);
1254 1255
                break;
            }
1256
        } else if (cpu->stop || cpu->stopped) {
1257 1258 1259
            break;
        }
    }
J
Jan Kiszka 已提交
1260
    exit_request = 0;
1261 1262 1263 1264
}

void set_numa_modes(void)
{
1265
    CPUState *cpu;
1266 1267
    int i;

A
Andreas Färber 已提交
1268
    CPU_FOREACH(cpu) {
1269
        for (i = 0; i < nb_numa_nodes; i++) {
1270
            if (test_bit(cpu->cpu_index, node_cpumask[i])) {
1271
                cpu->numa_node = i;
1272 1273 1274 1275 1276
            }
        }
    }
}

1277
void list_cpus(FILE *f, fprintf_function cpu_fprintf, const char *optarg)
1278 1279
{
    /* XXX: implement xxx_cpu_list for targets that still miss it */
P
Peter Maydell 已提交
1280 1281
#if defined(cpu_list)
    cpu_list(f, cpu_fprintf);
1282 1283
#endif
}
L
Luiz Capitulino 已提交
1284 1285 1286 1287

CpuInfoList *qmp_query_cpus(Error **errp)
{
    CpuInfoList *head = NULL, *cur_item = NULL;
1288
    CPUState *cpu;
L
Luiz Capitulino 已提交
1289

A
Andreas Färber 已提交
1290
    CPU_FOREACH(cpu) {
L
Luiz Capitulino 已提交
1291
        CpuInfoList *info;
1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304
#if defined(TARGET_I386)
        X86CPU *x86_cpu = X86_CPU(cpu);
        CPUX86State *env = &x86_cpu->env;
#elif defined(TARGET_PPC)
        PowerPCCPU *ppc_cpu = POWERPC_CPU(cpu);
        CPUPPCState *env = &ppc_cpu->env;
#elif defined(TARGET_SPARC)
        SPARCCPU *sparc_cpu = SPARC_CPU(cpu);
        CPUSPARCState *env = &sparc_cpu->env;
#elif defined(TARGET_MIPS)
        MIPSCPU *mips_cpu = MIPS_CPU(cpu);
        CPUMIPSState *env = &mips_cpu->env;
#endif
L
Luiz Capitulino 已提交
1305

1306
        cpu_synchronize_state(cpu);
L
Luiz Capitulino 已提交
1307 1308 1309

        info = g_malloc0(sizeof(*info));
        info->value = g_malloc0(sizeof(*info->value));
1310
        info->value->CPU = cpu->cpu_index;
1311
        info->value->current = (cpu == first_cpu);
1312
        info->value->halted = cpu->halted;
A
Andreas Färber 已提交
1313
        info->value->thread_id = cpu->thread_id;
L
Luiz Capitulino 已提交
1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340
#if defined(TARGET_I386)
        info->value->has_pc = true;
        info->value->pc = env->eip + env->segs[R_CS].base;
#elif defined(TARGET_PPC)
        info->value->has_nip = true;
        info->value->nip = env->nip;
#elif defined(TARGET_SPARC)
        info->value->has_pc = true;
        info->value->pc = env->pc;
        info->value->has_npc = true;
        info->value->npc = env->npc;
#elif defined(TARGET_MIPS)
        info->value->has_PC = true;
        info->value->PC = env->active_tc.PC;
#endif

        /* XXX: waiting for the qapi to support GSList */
        if (!cur_item) {
            head = cur_item = info;
        } else {
            cur_item->next = info;
            cur_item = info;
        }
    }

    return head;
}
L
Luiz Capitulino 已提交
1341 1342 1343 1344 1345 1346

void qmp_memsave(int64_t addr, int64_t size, const char *filename,
                 bool has_cpu, int64_t cpu_index, Error **errp)
{
    FILE *f;
    uint32_t l;
1347
    CPUState *cpu;
L
Luiz Capitulino 已提交
1348 1349 1350 1351 1352 1353
    uint8_t buf[1024];

    if (!has_cpu) {
        cpu_index = 0;
    }

1354 1355
    cpu = qemu_get_cpu(cpu_index);
    if (cpu == NULL) {
L
Luiz Capitulino 已提交
1356 1357 1358 1359 1360 1361 1362
        error_set(errp, QERR_INVALID_PARAMETER_VALUE, "cpu-index",
                  "a CPU number");
        return;
    }

    f = fopen(filename, "wb");
    if (!f) {
1363
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1364 1365 1366 1367 1368 1369 1370
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1371
        cpu_memory_rw_debug(cpu, addr, buf, l, 0);
L
Luiz Capitulino 已提交
1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382
        if (fwrite(buf, 1, l, f) != l) {
            error_set(errp, QERR_IO_ERROR);
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1383 1384 1385 1386 1387 1388 1389 1390 1391 1392

void qmp_pmemsave(int64_t addr, int64_t size, const char *filename,
                  Error **errp)
{
    FILE *f;
    uint32_t l;
    uint8_t buf[1024];

    f = fopen(filename, "wb");
    if (!f) {
1393
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
        cpu_physical_memory_rw(addr, buf, l, 0);
        if (fwrite(buf, 1, l, f) != l) {
            error_set(errp, QERR_IO_ERROR);
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1413 1414 1415 1416

void qmp_inject_nmi(Error **errp)
{
#if defined(TARGET_I386)
1417 1418
    CPUState *cs;

A
Andreas Färber 已提交
1419
    CPU_FOREACH(cs) {
1420 1421
        X86CPU *cpu = X86_CPU(cs);
        CPUX86State *env = &cpu->env;
L
Luiz Capitulino 已提交
1422

1423
        if (!env->apic_state) {
1424
            cpu_interrupt(cs, CPU_INTERRUPT_NMI);
1425 1426 1427
        } else {
            apic_deliver_nmi(env->apic_state);
        }
L
Luiz Capitulino 已提交
1428
    }
1429 1430 1431 1432
#elif defined(TARGET_S390X)
    CPUState *cs;
    S390CPU *cpu;

A
Andreas Färber 已提交
1433
    CPU_FOREACH(cs) {
1434 1435 1436 1437 1438 1439 1440 1441 1442
        cpu = S390_CPU(cs);
        if (cpu->env.cpu_num == monitor_get_cpu_index()) {
            if (s390_cpu_restart(S390_CPU(cs)) == -1) {
                error_set(errp, QERR_UNSUPPORTED);
                return;
            }
            break;
        }
    }
L
Luiz Capitulino 已提交
1443 1444 1445 1446
#else
    error_set(errp, QERR_UNSUPPORTED);
#endif
}