cpus.c 41.0 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"
W
Wenchao Xia 已提交
29
#include "qapi/qmp/qerror.h"
30
#include "sysemu/sysemu.h"
31
#include "exec/gdbstub.h"
32 33
#include "sysemu/dma.h"
#include "sysemu/kvm.h"
L
Luiz Capitulino 已提交
34
#include "qmp-commands.h"
35

36
#include "qemu/thread.h"
37 38
#include "sysemu/cpus.h"
#include "sysemu/qtest.h"
39 40
#include "qemu/main-loop.h"
#include "qemu/bitmap.h"
41
#include "qemu/seqlock.h"
W
Wenchao Xia 已提交
42
#include "qapi-event.h"
43
#include "hw/nmi.h"
J
Jan Kiszka 已提交
44 45

#ifndef _WIN32
46
#include "qemu/compatfd.h"
J
Jan Kiszka 已提交
47
#endif
48

49 50 51 52
#ifdef CONFIG_LINUX

#include <sys/prctl.h>

M
Marcelo Tosatti 已提交
53 54 55 56
#ifndef PR_MCE_KILL
#define PR_MCE_KILL 33
#endif

57 58 59 60 61 62 63 64 65 66
#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 */

67
static CPUState *next_cpu;
68 69
int64_t max_delay;
int64_t max_advance;
70

71 72 73 74 75
bool cpu_is_stopped(CPUState *cpu)
{
    return cpu->stopped || !runstate_is_running();
}

76
static bool cpu_thread_is_idle(CPUState *cpu)
77
{
78
    if (cpu->stop || cpu->queued_work_first) {
79 80
        return false;
    }
81
    if (cpu_is_stopped(cpu)) {
82 83
        return true;
    }
84
    if (!cpu->halted || cpu_has_work(cpu) ||
85
        kvm_halt_in_kernel()) {
86 87 88 89 90 91 92
        return false;
    }
    return true;
}

static bool all_cpu_threads_idle(void)
{
93
    CPUState *cpu;
94

A
Andreas Färber 已提交
95
    CPU_FOREACH(cpu) {
96
        if (!cpu_thread_is_idle(cpu)) {
97 98 99 100 101 102
            return false;
        }
    }
    return true;
}

P
Paolo Bonzini 已提交
103 104 105
/***********************************************************/
/* guest cycle counter */

106 107
/* Protected by TimersState seqlock */

108
static bool icount_sleep = true;
109
static int64_t vm_clock_warp_start = -1;
P
Paolo Bonzini 已提交
110 111 112 113
/* 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
114

P
Paolo Bonzini 已提交
115 116 117 118 119
static QEMUTimer *icount_rt_timer;
static QEMUTimer *icount_vm_timer;
static QEMUTimer *icount_warp_timer;

typedef struct TimersState {
120
    /* Protected by BQL.  */
P
Paolo Bonzini 已提交
121 122
    int64_t cpu_ticks_prev;
    int64_t cpu_ticks_offset;
123 124 125 126 127

    /* cpu_clock_offset can be read out of BQL, so protect it with
     * this lock.
     */
    QemuSeqLock vm_clock_seqlock;
P
Paolo Bonzini 已提交
128 129 130
    int64_t cpu_clock_offset;
    int32_t cpu_ticks_enabled;
    int64_t dummy;
131 132 133 134 135

    /* Compensate for varying guest execution speed.  */
    int64_t qemu_icount_bias;
    /* Only written by TCG thread */
    int64_t qemu_icount;
P
Paolo Bonzini 已提交
136 137
} TimersState;

L
Liu Ping Fan 已提交
138
static TimersState timers_state;
P
Paolo Bonzini 已提交
139

140
int64_t cpu_get_icount_raw(void)
P
Paolo Bonzini 已提交
141 142
{
    int64_t icount;
143
    CPUState *cpu = current_cpu;
P
Paolo Bonzini 已提交
144

145
    icount = timers_state.qemu_icount;
146
    if (cpu) {
147
        if (!cpu_can_do_io(cpu)) {
148 149
            fprintf(stderr, "Bad icount read\n");
            exit(1);
P
Paolo Bonzini 已提交
150
        }
151
        icount -= (cpu->icount_decr.u16.low + cpu->icount_extra);
P
Paolo Bonzini 已提交
152
    }
153 154 155 156 157 158 159
    return icount;
}

/* Return the virtual CPU time, based on the instruction counter.  */
static int64_t cpu_get_icount_locked(void)
{
    int64_t icount = cpu_get_icount_raw();
160
    return timers_state.qemu_icount_bias + cpu_icount_to_ns(icount);
P
Paolo Bonzini 已提交
161 162
}

P
Paolo Bonzini 已提交
163 164 165 166 167 168 169 170 171 172 173 174 175
int64_t cpu_get_icount(void)
{
    int64_t icount;
    unsigned start;

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

    return icount;
}

176 177 178 179 180
int64_t cpu_icount_to_ns(int64_t icount)
{
    return icount << icount_time_shift;
}

P
Paolo Bonzini 已提交
181
/* return the host CPU cycle counter and handle stop/restart */
182
/* Caller must hold the BQL */
P
Paolo Bonzini 已提交
183 184
int64_t cpu_get_ticks(void)
{
P
Paolo Bonzini 已提交
185 186
    int64_t ticks;

P
Paolo Bonzini 已提交
187 188 189
    if (use_icount) {
        return cpu_get_icount();
    }
P
Paolo Bonzini 已提交
190 191 192 193 194 195 196 197 198 199 200

    ticks = timers_state.cpu_ticks_offset;
    if (timers_state.cpu_ticks_enabled) {
        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;
        ticks = timers_state.cpu_ticks_prev;
P
Paolo Bonzini 已提交
201
    }
P
Paolo Bonzini 已提交
202 203 204

    timers_state.cpu_ticks_prev = ticks;
    return ticks;
P
Paolo Bonzini 已提交
205 206
}

207
static int64_t cpu_get_clock_locked(void)
P
Paolo Bonzini 已提交
208
{
P
Paolo Bonzini 已提交
209
    int64_t ticks;
210

P
Paolo Bonzini 已提交
211 212 213
    ticks = timers_state.cpu_clock_offset;
    if (timers_state.cpu_ticks_enabled) {
        ticks += get_clock();
P
Paolo Bonzini 已提交
214
    }
215

P
Paolo Bonzini 已提交
216
    return ticks;
217 218 219 220 221 222 223 224 225 226 227 228 229 230
}

/* 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 已提交
231 232
}

233 234 235
/* enable cpu_get_ticks()
 * Caller must hold BQL which server as mutex for vm_clock_seqlock.
 */
P
Paolo Bonzini 已提交
236 237
void cpu_enable_ticks(void)
{
238 239
    /* Here, the really thing protected by seqlock is cpu_clock_offset. */
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
240 241 242 243 244
    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;
    }
245
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
246 247 248
}

/* disable cpu_get_ticks() : the clock is stopped. You must not call
249 250 251
 * cpu_get_ticks() after that.
 * Caller must hold BQL which server as mutex for vm_clock_seqlock.
 */
P
Paolo Bonzini 已提交
252 253
void cpu_disable_ticks(void)
{
254 255
    /* Here, the really thing protected by seqlock is cpu_clock_offset. */
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
256
    if (timers_state.cpu_ticks_enabled) {
P
Paolo Bonzini 已提交
257
        timers_state.cpu_ticks_offset += cpu_get_real_ticks();
258
        timers_state.cpu_clock_offset = cpu_get_clock_locked();
P
Paolo Bonzini 已提交
259 260
        timers_state.cpu_ticks_enabled = 0;
    }
261
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
262 263 264 265 266 267 268 269 270 271 272 273 274
}

/* 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;
275 276

    /* Protected by TimersState mutex.  */
P
Paolo Bonzini 已提交
277
    static int64_t last_delta;
278

P
Paolo Bonzini 已提交
279 280 281 282
    /* If the VM is not running, then do nothing.  */
    if (!runstate_is_running()) {
        return;
    }
283

P
Paolo Bonzini 已提交
284 285 286
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
    cur_time = cpu_get_clock_locked();
    cur_icount = cpu_get_icount_locked();
287

P
Paolo Bonzini 已提交
288 289 290 291 292 293 294 295 296 297 298 299 300 301 302
    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;
303 304
    timers_state.qemu_icount_bias = cur_icount
                              - (timers_state.qemu_icount << icount_time_shift);
P
Paolo Bonzini 已提交
305
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
306 307 308 309
}

static void icount_adjust_rt(void *opaque)
{
310
    timer_mod(icount_rt_timer,
311
              qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL_RT) + 1000);
P
Paolo Bonzini 已提交
312 313 314 315 316
    icount_adjust();
}

static void icount_adjust_vm(void *opaque)
{
317 318 319
    timer_mod(icount_vm_timer,
                   qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
                   get_ticks_per_sec() / 10);
P
Paolo Bonzini 已提交
320 321 322 323 324 325 326 327 328 329
    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)
{
P
Paolo Bonzini 已提交
330 331 332 333
    /* The icount_warp_timer is rescheduled soon after vm_clock_warp_start
     * changes from -1 to another value, so the race here is okay.
     */
    if (atomic_read(&vm_clock_warp_start) == -1) {
P
Paolo Bonzini 已提交
334 335 336
        return;
    }

P
Paolo Bonzini 已提交
337
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
338
    if (runstate_is_running()) {
339
        int64_t clock = cpu_get_clock_locked();
P
Paolo Bonzini 已提交
340 341 342 343
        int64_t warp_delta;

        warp_delta = clock - vm_clock_warp_start;
        if (use_icount == 2) {
P
Paolo Bonzini 已提交
344
            /*
345
             * In adaptive mode, do not let QEMU_CLOCK_VIRTUAL run too
P
Paolo Bonzini 已提交
346 347
             * far ahead of real time.
             */
P
Paolo Bonzini 已提交
348
            int64_t cur_icount = cpu_get_icount_locked();
349
            int64_t delta = clock - cur_icount;
P
Paolo Bonzini 已提交
350
            warp_delta = MIN(warp_delta, delta);
P
Paolo Bonzini 已提交
351
        }
352
        timers_state.qemu_icount_bias += warp_delta;
P
Paolo Bonzini 已提交
353 354
    }
    vm_clock_warp_start = -1;
P
Paolo Bonzini 已提交
355
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
356 357 358 359

    if (qemu_clock_expired(QEMU_CLOCK_VIRTUAL)) {
        qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
    }
P
Paolo Bonzini 已提交
360 361
}

P
Paolo Bonzini 已提交
362 363
void qtest_clock_warp(int64_t dest)
{
364
    int64_t clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
365
    AioContext *aio_context;
P
Paolo Bonzini 已提交
366
    assert(qtest_enabled());
367
    aio_context = qemu_get_aio_context();
P
Paolo Bonzini 已提交
368
    while (clock < dest) {
369
        int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
370
        int64_t warp = qemu_soonest_timeout(dest - clock, deadline);
371

P
Paolo Bonzini 已提交
372
        seqlock_write_lock(&timers_state.vm_clock_seqlock);
373
        timers_state.qemu_icount_bias += warp;
P
Paolo Bonzini 已提交
374 375
        seqlock_write_unlock(&timers_state.vm_clock_seqlock);

376
        qemu_clock_run_timers(QEMU_CLOCK_VIRTUAL);
377
        timerlist_run_timers(aio_context->tlg.tl[QEMU_CLOCK_VIRTUAL]);
378
        clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
379
    }
380
    qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
381 382
}

383
void qemu_clock_warp(QEMUClockType type)
P
Paolo Bonzini 已提交
384
{
385
    int64_t clock;
P
Paolo Bonzini 已提交
386 387 388 389 390 391 392
    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.
     */
393
    if (type != QEMU_CLOCK_VIRTUAL || !use_icount) {
P
Paolo Bonzini 已提交
394 395 396
        return;
    }

397 398 399 400 401 402 403 404 405 406 407 408
    if (icount_sleep) {
        /*
         * If the CPUs have been sleeping, advance QEMU_CLOCK_VIRTUAL timer now.
         * This ensures that the deadline for the timer is computed correctly
         * below.
         * 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 the earliest QEMU_CLOCK_VIRTUAL timer.
         */
        icount_warp_rt(NULL);
        timer_del(icount_warp_timer);
    }
409
    if (!all_cpu_threads_idle()) {
P
Paolo Bonzini 已提交
410 411 412
        return;
    }

P
Paolo Bonzini 已提交
413 414 415 416 417
    if (qtest_enabled()) {
        /* When testing, qtest commands advance icount.  */
	return;
    }

418
    /* We want to use the earliest deadline from ALL vm_clocks */
419
    clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL_RT);
420
    deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
421
    if (deadline < 0) {
422 423 424 425 426
        static bool notified;
        if (!icount_sleep && !notified) {
            error_report("WARNING: icount sleep disabled and no active timers");
            notified = true;
        }
427
        return;
428 429
    }

P
Paolo Bonzini 已提交
430 431
    if (deadline > 0) {
        /*
432
         * Ensure QEMU_CLOCK_VIRTUAL proceeds even when the virtual CPU goes to
P
Paolo Bonzini 已提交
433 434 435
         * 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
436
         * QEMU_CLOCK_VIRTUAL.
P
Paolo Bonzini 已提交
437
         */
438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464
        if (!icount_sleep) {
            /*
             * We never let VCPUs sleep in no sleep icount mode.
             * If there is a pending QEMU_CLOCK_VIRTUAL timer we just advance
             * to the next QEMU_CLOCK_VIRTUAL event and notify it.
             * It is useful when we want a deterministic execution time,
             * isolated from host latencies.
             */
            seqlock_write_lock(&timers_state.vm_clock_seqlock);
            timers_state.qemu_icount_bias += deadline;
            seqlock_write_unlock(&timers_state.vm_clock_seqlock);
            qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
        } else {
            /*
             * We do stop VCPUs and only advance QEMU_CLOCK_VIRTUAL after some
             * "real" time, (related to the time left until the next event) has
             * passed. The QEMU_CLOCK_VIRTUAL_RT clock 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.
             */
            seqlock_write_lock(&timers_state.vm_clock_seqlock);
            if (vm_clock_warp_start == -1 || vm_clock_warp_start > clock) {
                vm_clock_warp_start = clock;
            }
            seqlock_write_unlock(&timers_state.vm_clock_seqlock);
            timer_mod_anticipate(icount_warp_timer, clock + deadline);
465
        }
466
    } else if (deadline == 0) {
467
        qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
468 469 470
    }
}

471 472 473 474 475 476 477 478 479 480 481 482
static bool icount_state_needed(void *opaque)
{
    return use_icount;
}

/*
 * This is a subsection for icount migration.
 */
static const VMStateDescription icount_vmstate_timers = {
    .name = "timer/icount",
    .version_id = 1,
    .minimum_version_id = 1,
483
    .needed = icount_state_needed,
484 485 486 487 488 489 490
    .fields = (VMStateField[]) {
        VMSTATE_INT64(qemu_icount_bias, TimersState),
        VMSTATE_INT64(qemu_icount, TimersState),
        VMSTATE_END_OF_LIST()
    }
};

P
Paolo Bonzini 已提交
491 492 493 494
static const VMStateDescription vmstate_timers = {
    .name = "timer",
    .version_id = 2,
    .minimum_version_id = 1,
495
    .fields = (VMStateField[]) {
P
Paolo Bonzini 已提交
496 497 498 499
        VMSTATE_INT64(cpu_ticks_offset, TimersState),
        VMSTATE_INT64(dummy, TimersState),
        VMSTATE_INT64_V(cpu_clock_offset, TimersState, 2),
        VMSTATE_END_OF_LIST()
500
    },
501 502 503
    .subsections = (const VMStateDescription*[]) {
        &icount_vmstate_timers,
        NULL
P
Paolo Bonzini 已提交
504 505 506
    }
};

507 508 509 510 511 512
void cpu_ticks_init(void)
{
    seqlock_init(&timers_state.vm_clock_seqlock, NULL);
    vmstate_register(NULL, 0, &vmstate_timers, &timers_state);
}

513
void configure_icount(QemuOpts *opts, Error **errp)
P
Paolo Bonzini 已提交
514
{
515
    const char *option;
516
    char *rem_str = NULL;
517 518

    option = qemu_opt_get(opts, "shift");
P
Paolo Bonzini 已提交
519
    if (!option) {
520 521 522
        if (qemu_opt_get(opts, "align") != NULL) {
            error_setg(errp, "Please specify shift option when using align");
        }
P
Paolo Bonzini 已提交
523 524
        return;
    }
525 526

    icount_sleep = qemu_opt_get_bool(opts, "sleep", true);
527 528 529 530
    if (icount_sleep) {
        icount_warp_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL_RT,
                                         icount_warp_rt, NULL);
    }
531

532
    icount_align_option = qemu_opt_get_bool(opts, "align", false);
533 534 535 536

    if (icount_align_option && !icount_sleep) {
        error_setg(errp, "align=on and sleep=no are incompatible");
    }
P
Paolo Bonzini 已提交
537
    if (strcmp(option, "auto") != 0) {
538 539 540 541 542
        errno = 0;
        icount_time_shift = strtol(option, &rem_str, 0);
        if (errno != 0 || *rem_str != '\0' || !strlen(option)) {
            error_setg(errp, "icount: Invalid shift value");
        }
P
Paolo Bonzini 已提交
543 544
        use_icount = 1;
        return;
545 546
    } else if (icount_align_option) {
        error_setg(errp, "shift=auto and align=on are incompatible");
547 548
    } else if (!icount_sleep) {
        error_setg(errp, "shift=auto and sleep=no are incompatible");
P
Paolo Bonzini 已提交
549 550 551 552 553 554 555 556 557 558 559 560 561
    }

    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.  */
562 563
    icount_rt_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL_RT,
                                   icount_adjust_rt, NULL);
564
    timer_mod(icount_rt_timer,
565
                   qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL_RT) + 1000);
566 567 568 569 570
    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 已提交
571 572
}

573 574 575 576
/***********************************************************/
void hw_error(const char *fmt, ...)
{
    va_list ap;
577
    CPUState *cpu;
578 579 580 581 582

    va_start(ap, fmt);
    fprintf(stderr, "qemu: hardware error: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
A
Andreas Färber 已提交
583
    CPU_FOREACH(cpu) {
584
        fprintf(stderr, "CPU #%d:\n", cpu->cpu_index);
585
        cpu_dump_state(cpu, stderr, fprintf, CPU_DUMP_FPU);
586 587 588 589 590 591 592
    }
    va_end(ap);
    abort();
}

void cpu_synchronize_all_states(void)
{
593
    CPUState *cpu;
594

A
Andreas Färber 已提交
595
    CPU_FOREACH(cpu) {
596
        cpu_synchronize_state(cpu);
597 598 599 600 601
    }
}

void cpu_synchronize_all_post_reset(void)
{
602
    CPUState *cpu;
603

A
Andreas Färber 已提交
604
    CPU_FOREACH(cpu) {
605
        cpu_synchronize_post_reset(cpu);
606 607 608 609 610
    }
}

void cpu_synchronize_all_post_init(void)
{
611
    CPUState *cpu;
612

A
Andreas Färber 已提交
613
    CPU_FOREACH(cpu) {
614
        cpu_synchronize_post_init(cpu);
615 616 617
    }
}

M
Marcelo Tosatti 已提交
618 619 620 621 622 623 624 625 626
void cpu_clean_all_dirty(void)
{
    CPUState *cpu;

    CPU_FOREACH(cpu) {
        cpu_clean_state(cpu);
    }
}

627
static int do_vm_stop(RunState state)
628
{
629 630
    int ret = 0;

631
    if (runstate_is_running()) {
632 633
        cpu_disable_ticks();
        pause_all_vcpus();
634
        runstate_set(state);
635
        vm_state_notify(0, state);
W
Wenchao Xia 已提交
636
        qapi_event_send_stop(&error_abort);
637
    }
638

639 640 641
    bdrv_drain_all();
    ret = bdrv_flush_all();

642
    return ret;
643 644
}

645
static bool cpu_can_run(CPUState *cpu)
646
{
A
Andreas Färber 已提交
647
    if (cpu->stop) {
648
        return false;
649
    }
650
    if (cpu_is_stopped(cpu)) {
651
        return false;
652
    }
653
    return true;
654 655
}

656
static void cpu_handle_guest_debug(CPUState *cpu)
657
{
658
    gdb_set_stop_cpu(cpu);
659
    qemu_system_debug_request();
660
    cpu->stopped = true;
661 662
}

663 664
static void cpu_signal(int sig)
{
665 666
    if (current_cpu) {
        cpu_exit(current_cpu);
667 668 669 670
    }
    exit_request = 1;
}

671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709
#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);
}

710
static void qemu_kvm_eat_signals(CPUState *cpu)
711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730
{
    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:
731
            if (kvm_on_sigbus_vcpu(cpu, siginfo.si_code, siginfo.si_addr)) {
732 733 734 735 736 737 738 739 740 741 742 743 744 745 746
                sigbus_reraise();
            }
            break;
        default:
            break;
        }

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

747 748 749 750 751
#else /* !CONFIG_LINUX */

static void qemu_init_sigbus(void)
{
}
752

753
static void qemu_kvm_eat_signals(CPUState *cpu)
754 755
{
}
756 757
#endif /* !CONFIG_LINUX */

758
#ifndef _WIN32
759 760 761 762
static void dummy_signal(int sig)
{
}

763
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
764 765 766 767 768 769 770 771 772 773 774 775
{
    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);
776
    r = kvm_set_signal_mask(cpu, &set);
777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796
    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);
}

797
#else /* _WIN32 */
798
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
799
{
800 801
    abort();
}
802

803 804
static void qemu_tcg_init_cpu_signals(void)
{
805
}
806
#endif /* _WIN32 */
807

808
static QemuMutex qemu_global_mutex;
809
static QemuCond qemu_io_proceeded_cond;
810
static unsigned iothread_requesting_mutex;
811 812 813 814 815 816 817 818 819 820

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 已提交
821
static QemuCond qemu_work_cond;
822

P
Paolo Bonzini 已提交
823
void qemu_init_cpu_loop(void)
824
{
825
    qemu_init_sigbus();
826 827 828
    qemu_cond_init(&qemu_cpu_cond);
    qemu_cond_init(&qemu_pause_cond);
    qemu_cond_init(&qemu_work_cond);
829
    qemu_cond_init(&qemu_io_proceeded_cond);
830 831
    qemu_mutex_init(&qemu_global_mutex);

J
Jan Kiszka 已提交
832
    qemu_thread_get_self(&io_thread);
833 834
}

835
void run_on_cpu(CPUState *cpu, void (*func)(void *data), void *data)
M
Marcelo Tosatti 已提交
836 837 838
{
    struct qemu_work_item wi;

839
    if (qemu_cpu_is_self(cpu)) {
M
Marcelo Tosatti 已提交
840 841 842 843 844 845
        func(data);
        return;
    }

    wi.func = func;
    wi.data = data;
C
Chegu Vinod 已提交
846
    wi.free = false;
847 848
    if (cpu->queued_work_first == NULL) {
        cpu->queued_work_first = &wi;
849
    } else {
850
        cpu->queued_work_last->next = &wi;
851
    }
852
    cpu->queued_work_last = &wi;
M
Marcelo Tosatti 已提交
853 854 855
    wi.next = NULL;
    wi.done = false;

856
    qemu_cpu_kick(cpu);
M
Marcelo Tosatti 已提交
857
    while (!wi.done) {
858
        CPUState *self_cpu = current_cpu;
M
Marcelo Tosatti 已提交
859 860

        qemu_cond_wait(&qemu_work_cond, &qemu_global_mutex);
861
        current_cpu = self_cpu;
M
Marcelo Tosatti 已提交
862 863 864
    }
}

C
Chegu Vinod 已提交
865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
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);
}

890
static void flush_queued_work(CPUState *cpu)
M
Marcelo Tosatti 已提交
891 892 893
{
    struct qemu_work_item *wi;

894
    if (cpu->queued_work_first == NULL) {
M
Marcelo Tosatti 已提交
895
        return;
896
    }
M
Marcelo Tosatti 已提交
897

898 899
    while ((wi = cpu->queued_work_first)) {
        cpu->queued_work_first = wi->next;
M
Marcelo Tosatti 已提交
900 901
        wi->func(wi->data);
        wi->done = true;
C
Chegu Vinod 已提交
902 903 904
        if (wi->free) {
            g_free(wi);
        }
M
Marcelo Tosatti 已提交
905
    }
906
    cpu->queued_work_last = NULL;
M
Marcelo Tosatti 已提交
907 908 909
    qemu_cond_broadcast(&qemu_work_cond);
}

910
static void qemu_wait_io_event_common(CPUState *cpu)
911
{
A
Andreas Färber 已提交
912 913
    if (cpu->stop) {
        cpu->stop = false;
914
        cpu->stopped = true;
915 916
        qemu_cond_signal(&qemu_pause_cond);
    }
917
    flush_queued_work(cpu);
918
    cpu->thread_kicked = false;
919 920
}

921
static void qemu_tcg_wait_io_event(void)
922
{
923
    CPUState *cpu;
924

925
    while (all_cpu_threads_idle()) {
926 927
       /* Start accounting real time to the virtual clock if the CPUs
          are idle.  */
928
        qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
929
        qemu_cond_wait(tcg_halt_cond, &qemu_global_mutex);
930
    }
931

932 933 934
    while (iothread_requesting_mutex) {
        qemu_cond_wait(&qemu_io_proceeded_cond, &qemu_global_mutex);
    }
935

A
Andreas Färber 已提交
936
    CPU_FOREACH(cpu) {
937
        qemu_wait_io_event_common(cpu);
938
    }
939 940
}

941
static void qemu_kvm_wait_io_event(CPUState *cpu)
942
{
943
    while (cpu_thread_is_idle(cpu)) {
A
Andreas Färber 已提交
944
        qemu_cond_wait(cpu->halt_cond, &qemu_global_mutex);
945
    }
946

947
    qemu_kvm_eat_signals(cpu);
948
    qemu_wait_io_event_common(cpu);
949 950
}

951
static void *qemu_kvm_cpu_thread_fn(void *arg)
952
{
953
    CPUState *cpu = arg;
J
Jan Kiszka 已提交
954
    int r;
955

956
    qemu_mutex_lock(&qemu_global_mutex);
957
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
958
    cpu->thread_id = qemu_get_thread_id();
959
    cpu->can_do_io = 1;
960
    current_cpu = cpu;
961

962
    r = kvm_init_vcpu(cpu);
J
Jan Kiszka 已提交
963 964 965 966
    if (r < 0) {
        fprintf(stderr, "kvm_init_vcpu failed: %s\n", strerror(-r));
        exit(1);
    }
967

968
    qemu_kvm_init_cpu_signals(cpu);
969 970

    /* signal CPU creation */
971
    cpu->created = true;
972 973 974
    qemu_cond_signal(&qemu_cpu_cond);

    while (1) {
975
        if (cpu_can_run(cpu)) {
976
            r = kvm_cpu_exec(cpu);
977
            if (r == EXCP_DEBUG) {
978
                cpu_handle_guest_debug(cpu);
979
            }
980
        }
981
        qemu_kvm_wait_io_event(cpu);
982 983 984 985 986
    }

    return NULL;
}

A
Anthony Liguori 已提交
987 988 989 990 991 992
static void *qemu_dummy_cpu_thread_fn(void *arg)
{
#ifdef _WIN32
    fprintf(stderr, "qtest is not supported under Windows\n");
    exit(1);
#else
993
    CPUState *cpu = arg;
A
Anthony Liguori 已提交
994 995 996 997
    sigset_t waitset;
    int r;

    qemu_mutex_lock_iothread();
998
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
999
    cpu->thread_id = qemu_get_thread_id();
1000
    cpu->can_do_io = 1;
A
Anthony Liguori 已提交
1001 1002 1003 1004 1005

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

    /* signal CPU creation */
1006
    cpu->created = true;
A
Anthony Liguori 已提交
1007 1008
    qemu_cond_signal(&qemu_cpu_cond);

1009
    current_cpu = cpu;
A
Anthony Liguori 已提交
1010
    while (1) {
1011
        current_cpu = NULL;
A
Anthony Liguori 已提交
1012 1013 1014 1015 1016 1017 1018 1019 1020 1021
        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();
1022
        current_cpu = cpu;
1023
        qemu_wait_io_event_common(cpu);
A
Anthony Liguori 已提交
1024 1025 1026 1027 1028 1029
    }

    return NULL;
#endif
}

J
Jan Kiszka 已提交
1030 1031
static void tcg_exec_all(void);

1032
static void *qemu_tcg_cpu_thread_fn(void *arg)
1033
{
1034
    CPUState *cpu = arg;
1035

1036
    qemu_tcg_init_cpu_signals();
1037
    qemu_thread_get_self(cpu->thread);
1038 1039

    qemu_mutex_lock(&qemu_global_mutex);
1040 1041 1042
    CPU_FOREACH(cpu) {
        cpu->thread_id = qemu_get_thread_id();
        cpu->created = true;
1043
        cpu->can_do_io = 1;
1044
    }
1045 1046
    qemu_cond_signal(&qemu_cpu_cond);

1047
    /* wait for initial kick-off after machine start */
1048
    while (first_cpu->stopped) {
1049
        qemu_cond_wait(tcg_halt_cond, &qemu_global_mutex);
1050 1051

        /* process any pending work */
A
Andreas Färber 已提交
1052
        CPU_FOREACH(cpu) {
1053
            qemu_wait_io_event_common(cpu);
1054
        }
1055
    }
1056

1057 1058 1059
    /* process any pending work */
    exit_request = 1;

1060
    while (1) {
J
Jan Kiszka 已提交
1061
        tcg_exec_all();
1062 1063

        if (use_icount) {
1064
            int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
1065 1066

            if (deadline == 0) {
1067
                qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
1068
            }
1069
        }
1070
        qemu_tcg_wait_io_event();
1071 1072 1073 1074 1075
    }

    return NULL;
}

1076
static void qemu_cpu_kick_thread(CPUState *cpu)
P
Paolo Bonzini 已提交
1077 1078 1079 1080
{
#ifndef _WIN32
    int err;

1081
    err = pthread_kill(cpu->thread->thread, SIG_IPI);
P
Paolo Bonzini 已提交
1082 1083 1084 1085 1086
    if (err) {
        fprintf(stderr, "qemu:%s: %s", __func__, strerror(err));
        exit(1);
    }
#else /* _WIN32 */
1087
    if (!qemu_cpu_is_self(cpu)) {
1088 1089 1090
        CONTEXT tcgContext;

        if (SuspendThread(cpu->hThread) == (DWORD)-1) {
1091
            fprintf(stderr, "qemu:%s: GetLastError:%lu\n", __func__,
1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103
                    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 已提交
1104
        cpu_signal(0);
1105 1106

        if (ResumeThread(cpu->hThread) == (DWORD)-1) {
1107
            fprintf(stderr, "qemu:%s: GetLastError:%lu\n", __func__,
1108 1109 1110
                    GetLastError());
            exit(1);
        }
P
Paolo Bonzini 已提交
1111 1112 1113 1114
    }
#endif
}

1115
void qemu_cpu_kick(CPUState *cpu)
1116
{
A
Andreas Färber 已提交
1117
    qemu_cond_broadcast(cpu->halt_cond);
1118
    if (!tcg_enabled() && !cpu->thread_kicked) {
1119
        qemu_cpu_kick_thread(cpu);
1120
        cpu->thread_kicked = true;
1121
    }
1122 1123
}

1124
void qemu_cpu_kick_self(void)
1125
{
1126
#ifndef _WIN32
1127
    assert(current_cpu);
1128

1129 1130 1131
    if (!current_cpu->thread_kicked) {
        qemu_cpu_kick_thread(current_cpu);
        current_cpu->thread_kicked = true;
1132
    }
1133 1134 1135
#else
    abort();
#endif
1136 1137
}

1138
bool qemu_cpu_is_self(CPUState *cpu)
1139
{
1140
    return qemu_thread_is_self(cpu->thread);
1141 1142
}

1143
bool qemu_in_vcpu_thread(void)
J
Juan Quintela 已提交
1144
{
1145
    return current_cpu && qemu_cpu_is_self(current_cpu);
J
Juan Quintela 已提交
1146 1147
}

1148 1149
void qemu_mutex_lock_iothread(void)
{
1150
    atomic_inc(&iothread_requesting_mutex);
1151
    if (!tcg_enabled() || !first_cpu || !first_cpu->thread) {
1152
        qemu_mutex_lock(&qemu_global_mutex);
1153
        atomic_dec(&iothread_requesting_mutex);
1154 1155
    } else {
        if (qemu_mutex_trylock(&qemu_global_mutex)) {
1156
            qemu_cpu_kick_thread(first_cpu);
1157 1158
            qemu_mutex_lock(&qemu_global_mutex);
        }
1159
        atomic_dec(&iothread_requesting_mutex);
1160
        qemu_cond_broadcast(&qemu_io_proceeded_cond);
1161
    }
1162 1163 1164 1165 1166 1167 1168 1169 1170
}

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

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

A
Andreas Färber 已提交
1173
    CPU_FOREACH(cpu) {
1174
        if (!cpu->stopped) {
1175
            return 0;
1176
        }
1177 1178 1179 1180 1181 1182 1183
    }

    return 1;
}

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

1186
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, false);
A
Andreas Färber 已提交
1187
    CPU_FOREACH(cpu) {
1188 1189
        cpu->stop = true;
        qemu_cpu_kick(cpu);
1190 1191
    }

J
Juan Quintela 已提交
1192
    if (qemu_in_vcpu_thread()) {
1193 1194
        cpu_stop_current();
        if (!kvm_enabled()) {
A
Andreas Färber 已提交
1195
            CPU_FOREACH(cpu) {
1196 1197
                cpu->stop = false;
                cpu->stopped = true;
1198 1199 1200 1201 1202
            }
            return;
        }
    }

1203
    while (!all_vcpus_paused()) {
1204
        qemu_cond_wait(&qemu_pause_cond, &qemu_global_mutex);
A
Andreas Färber 已提交
1205
        CPU_FOREACH(cpu) {
1206
            qemu_cpu_kick(cpu);
1207 1208 1209 1210
        }
    }
}

1211 1212 1213 1214 1215 1216 1217
void cpu_resume(CPUState *cpu)
{
    cpu->stop = false;
    cpu->stopped = false;
    qemu_cpu_kick(cpu);
}

1218 1219
void resume_all_vcpus(void)
{
A
Andreas Färber 已提交
1220
    CPUState *cpu;
1221

1222
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, true);
A
Andreas Färber 已提交
1223
    CPU_FOREACH(cpu) {
1224
        cpu_resume(cpu);
1225 1226 1227
    }
}

1228 1229 1230
/* For temporary buffers for forming a name */
#define VCPU_THREAD_NAME_SIZE 16

1231
static void qemu_tcg_init_vcpu(CPUState *cpu)
1232
{
1233 1234
    char thread_name[VCPU_THREAD_NAME_SIZE];

1235 1236
    tcg_cpu_address_space_init(cpu, cpu->as);

1237 1238
    /* share a single thread for all cpus with TCG */
    if (!tcg_cpu_thread) {
1239
        cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1240 1241 1242
        cpu->halt_cond = g_malloc0(sizeof(QemuCond));
        qemu_cond_init(cpu->halt_cond);
        tcg_halt_cond = cpu->halt_cond;
1243 1244 1245 1246
        snprintf(thread_name, VCPU_THREAD_NAME_SIZE, "CPU %d/TCG",
                 cpu->cpu_index);
        qemu_thread_create(cpu->thread, thread_name, qemu_tcg_cpu_thread_fn,
                           cpu, QEMU_THREAD_JOINABLE);
P
Paolo Bonzini 已提交
1247
#ifdef _WIN32
1248
        cpu->hThread = qemu_thread_get_handle(cpu->thread);
P
Paolo Bonzini 已提交
1249
#endif
1250
        while (!cpu->created) {
1251
            qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
1252
        }
1253
        tcg_cpu_thread = cpu->thread;
1254
    } else {
1255
        cpu->thread = tcg_cpu_thread;
A
Andreas Färber 已提交
1256
        cpu->halt_cond = tcg_halt_cond;
1257 1258 1259
    }
}

1260
static void qemu_kvm_start_vcpu(CPUState *cpu)
1261
{
1262 1263
    char thread_name[VCPU_THREAD_NAME_SIZE];

1264
    cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1265 1266
    cpu->halt_cond = g_malloc0(sizeof(QemuCond));
    qemu_cond_init(cpu->halt_cond);
1267 1268 1269 1270
    snprintf(thread_name, VCPU_THREAD_NAME_SIZE, "CPU %d/KVM",
             cpu->cpu_index);
    qemu_thread_create(cpu->thread, thread_name, qemu_kvm_cpu_thread_fn,
                       cpu, QEMU_THREAD_JOINABLE);
1271
    while (!cpu->created) {
1272
        qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
1273
    }
1274 1275
}

1276
static void qemu_dummy_start_vcpu(CPUState *cpu)
A
Anthony Liguori 已提交
1277
{
1278 1279
    char thread_name[VCPU_THREAD_NAME_SIZE];

1280
    cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1281 1282
    cpu->halt_cond = g_malloc0(sizeof(QemuCond));
    qemu_cond_init(cpu->halt_cond);
1283 1284 1285
    snprintf(thread_name, VCPU_THREAD_NAME_SIZE, "CPU %d/DUMMY",
             cpu->cpu_index);
    qemu_thread_create(cpu->thread, thread_name, qemu_dummy_cpu_thread_fn, cpu,
A
Anthony Liguori 已提交
1286
                       QEMU_THREAD_JOINABLE);
1287
    while (!cpu->created) {
A
Anthony Liguori 已提交
1288 1289 1290 1291
        qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
    }
}

1292
void qemu_init_vcpu(CPUState *cpu)
1293
{
1294 1295
    cpu->nr_cores = smp_cores;
    cpu->nr_threads = smp_threads;
1296
    cpu->stopped = true;
1297
    if (kvm_enabled()) {
1298
        qemu_kvm_start_vcpu(cpu);
A
Anthony Liguori 已提交
1299
    } else if (tcg_enabled()) {
1300
        qemu_tcg_init_vcpu(cpu);
A
Anthony Liguori 已提交
1301
    } else {
1302
        qemu_dummy_start_vcpu(cpu);
1303
    }
1304 1305
}

1306
void cpu_stop_current(void)
1307
{
1308 1309 1310 1311
    if (current_cpu) {
        current_cpu->stop = false;
        current_cpu->stopped = true;
        cpu_exit(current_cpu);
1312
        qemu_cond_signal(&qemu_pause_cond);
1313
    }
1314 1315
}

1316
int vm_stop(RunState state)
1317
{
J
Juan Quintela 已提交
1318
    if (qemu_in_vcpu_thread()) {
1319
        qemu_system_vmstop_request_prepare();
1320
        qemu_system_vmstop_request(state);
1321 1322 1323 1324
        /*
         * FIXME: should not return to device code in case
         * vm_stop() has been requested.
         */
1325
        cpu_stop_current();
1326
        return 0;
1327
    }
1328 1329

    return do_vm_stop(state);
1330 1331
}

1332 1333
/* does a state transition even if the VM is already stopped,
   current state is forgotten forever */
1334
int vm_stop_force_state(RunState state)
1335 1336
{
    if (runstate_is_running()) {
1337
        return vm_stop(state);
1338 1339
    } else {
        runstate_set(state);
1340 1341 1342
        /* Make sure to return an error if the flush in a previous vm_stop()
         * failed. */
        return bdrv_flush_all();
1343 1344 1345
    }
}

1346
static int tcg_cpu_exec(CPUArchState *env)
1347
{
1348
    CPUState *cpu = ENV_GET_CPU(env);
1349 1350 1351 1352 1353 1354 1355 1356 1357 1358
    int ret;
#ifdef CONFIG_PROFILER
    int64_t ti;
#endif

#ifdef CONFIG_PROFILER
    ti = profile_getclock();
#endif
    if (use_icount) {
        int64_t count;
1359
        int64_t deadline;
1360
        int decr;
1361 1362
        timers_state.qemu_icount -= (cpu->icount_decr.u16.low
                                    + cpu->icount_extra);
1363
        cpu->icount_decr.u16.low = 0;
1364
        cpu->icount_extra = 0;
1365
        deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
1366 1367

        /* Maintain prior (possibly buggy) behaviour where if no deadline
1368
         * was set (as there is no QEMU_CLOCK_VIRTUAL timer) or it is more than
1369 1370 1371 1372 1373 1374 1375 1376
         * INT32_MAX nanoseconds ahead, we still use INT32_MAX
         * nanoseconds.
         */
        if ((deadline < 0) || (deadline > INT32_MAX)) {
            deadline = INT32_MAX;
        }

        count = qemu_icount_round(deadline);
1377
        timers_state.qemu_icount += count;
1378 1379
        decr = (count > 0xffff) ? 0xffff : count;
        count -= decr;
1380
        cpu->icount_decr.u16.low = decr;
1381
        cpu->icount_extra = count;
1382 1383 1384
    }
    ret = cpu_exec(env);
#ifdef CONFIG_PROFILER
1385
    tcg_time += profile_getclock() - ti;
1386 1387 1388 1389
#endif
    if (use_icount) {
        /* Fold pending instructions back into the
           instruction counter, and clear the interrupt flag.  */
1390 1391
        timers_state.qemu_icount -= (cpu->icount_decr.u16.low
                        + cpu->icount_extra);
1392
        cpu->icount_decr.u32 = 0;
1393
        cpu->icount_extra = 0;
1394 1395 1396 1397
    }
    return ret;
}

J
Jan Kiszka 已提交
1398
static void tcg_exec_all(void)
1399
{
1400 1401
    int r;

1402 1403
    /* Account partial waits to QEMU_CLOCK_VIRTUAL.  */
    qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
1404

1405
    if (next_cpu == NULL) {
1406
        next_cpu = first_cpu;
1407
    }
A
Andreas Färber 已提交
1408
    for (; next_cpu != NULL && !exit_request; next_cpu = CPU_NEXT(next_cpu)) {
1409 1410
        CPUState *cpu = next_cpu;
        CPUArchState *env = cpu->env_ptr;
1411

1412
        qemu_clock_enable(QEMU_CLOCK_VIRTUAL,
1413
                          (cpu->singlestep_enabled & SSTEP_NOTIMER) == 0);
1414

1415
        if (cpu_can_run(cpu)) {
J
Jan Kiszka 已提交
1416
            r = tcg_cpu_exec(env);
1417
            if (r == EXCP_DEBUG) {
1418
                cpu_handle_guest_debug(cpu);
1419 1420
                break;
            }
1421
        } else if (cpu->stop || cpu->stopped) {
1422 1423 1424
            break;
        }
    }
J
Jan Kiszka 已提交
1425
    exit_request = 0;
1426 1427
}

1428
void list_cpus(FILE *f, fprintf_function cpu_fprintf, const char *optarg)
1429 1430
{
    /* XXX: implement xxx_cpu_list for targets that still miss it */
P
Peter Maydell 已提交
1431 1432
#if defined(cpu_list)
    cpu_list(f, cpu_fprintf);
1433 1434
#endif
}
L
Luiz Capitulino 已提交
1435 1436 1437 1438

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

A
Andreas Färber 已提交
1441
    CPU_FOREACH(cpu) {
L
Luiz Capitulino 已提交
1442
        CpuInfoList *info;
1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454
#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;
1455 1456 1457
#elif defined(TARGET_TRICORE)
        TriCoreCPU *tricore_cpu = TRICORE_CPU(cpu);
        CPUTriCoreState *env = &tricore_cpu->env;
1458
#endif
L
Luiz Capitulino 已提交
1459

1460
        cpu_synchronize_state(cpu);
L
Luiz Capitulino 已提交
1461 1462 1463

        info = g_malloc0(sizeof(*info));
        info->value = g_malloc0(sizeof(*info->value));
1464
        info->value->CPU = cpu->cpu_index;
1465
        info->value->current = (cpu == first_cpu);
1466
        info->value->halted = cpu->halted;
1467
        info->value->qom_path = object_get_canonical_path(OBJECT(cpu));
A
Andreas Färber 已提交
1468
        info->value->thread_id = cpu->thread_id;
L
Luiz Capitulino 已提交
1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482
#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;
1483 1484 1485
#elif defined(TARGET_TRICORE)
        info->value->has_PC = true;
        info->value->PC = env->PC;
L
Luiz Capitulino 已提交
1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498
#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 已提交
1499 1500 1501 1502 1503 1504

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;
1505
    CPUState *cpu;
L
Luiz Capitulino 已提交
1506
    uint8_t buf[1024];
1507
    int64_t orig_addr = addr, orig_size = size;
L
Luiz Capitulino 已提交
1508 1509 1510 1511 1512

    if (!has_cpu) {
        cpu_index = 0;
    }

1513 1514
    cpu = qemu_get_cpu(cpu_index);
    if (cpu == NULL) {
1515 1516
        error_setg(errp, QERR_INVALID_PARAMETER_VALUE, "cpu-index",
                   "a CPU number");
L
Luiz Capitulino 已提交
1517 1518 1519 1520 1521
        return;
    }

    f = fopen(filename, "wb");
    if (!f) {
1522
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1523 1524 1525 1526 1527 1528 1529
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1530
        if (cpu_memory_rw_debug(cpu, addr, buf, l, 0) != 0) {
1531 1532
            error_setg(errp, "Invalid addr 0x%016" PRIx64 "/size %" PRId64
                             " specified", orig_addr, orig_size);
1533 1534
            goto exit;
        }
L
Luiz Capitulino 已提交
1535
        if (fwrite(buf, 1, l, f) != l) {
1536
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1537 1538 1539 1540 1541 1542 1543 1544 1545
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1546 1547 1548 1549 1550 1551 1552 1553 1554 1555

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) {
1556
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1557 1558 1559 1560 1561 1562 1563
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1564
        cpu_physical_memory_read(addr, buf, l);
L
Luiz Capitulino 已提交
1565
        if (fwrite(buf, 1, l, f) != l) {
1566
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1567 1568 1569 1570 1571 1572 1573 1574 1575
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1576 1577 1578 1579

void qmp_inject_nmi(Error **errp)
{
#if defined(TARGET_I386)
1580 1581
    CPUState *cs;

A
Andreas Färber 已提交
1582
    CPU_FOREACH(cs) {
1583
        X86CPU *cpu = X86_CPU(cs);
L
Luiz Capitulino 已提交
1584

1585
        if (!cpu->apic_state) {
1586
            cpu_interrupt(cs, CPU_INTERRUPT_NMI);
1587
        } else {
1588
            apic_deliver_nmi(cpu->apic_state);
1589
        }
L
Luiz Capitulino 已提交
1590 1591
    }
#else
1592
    nmi_monitor_handle(monitor_get_cpu_index(), errp);
L
Luiz Capitulino 已提交
1593 1594
#endif
}
1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611

void dump_drift_info(FILE *f, fprintf_function cpu_fprintf)
{
    if (!use_icount) {
        return;
    }

    cpu_fprintf(f, "Host - Guest clock  %"PRIi64" ms\n",
                (cpu_get_clock() - cpu_get_icount())/SCALE_MS);
    if (icount_align_option) {
        cpu_fprintf(f, "Max guest delay     %"PRIi64" ms\n", -max_delay/SCALE_MS);
        cpu_fprintf(f, "Max guest advance   %"PRIi64" ms\n", max_advance/SCALE_MS);
    } else {
        cpu_fprintf(f, "Max guest delay     NA\n");
        cpu_fprintf(f, "Max guest advance   NA\n");
    }
}