cpus.c 44.3 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 "qemu/error-report.h"
31
#include "sysemu/sysemu.h"
32
#include "exec/gdbstub.h"
33 34
#include "sysemu/dma.h"
#include "sysemu/kvm.h"
L
Luiz Capitulino 已提交
35
#include "qmp-commands.h"
36

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

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

51 52 53 54
#ifdef CONFIG_LINUX

#include <sys/prctl.h>

M
Marcelo Tosatti 已提交
55 56 57 58
#ifndef PR_MCE_KILL
#define PR_MCE_KILL 33
#endif

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

69
static CPUState *next_cpu;
70 71
int64_t max_delay;
int64_t max_advance;
72

73 74 75 76 77 78 79 80
/* vcpu throttling controls */
static QEMUTimer *throttle_timer;
static unsigned int throttle_percentage;

#define CPU_THROTTLE_PCT_MIN 1
#define CPU_THROTTLE_PCT_MAX 99
#define CPU_THROTTLE_TIMESLICE_NS 10000000

81 82 83 84 85
bool cpu_is_stopped(CPUState *cpu)
{
    return cpu->stopped || !runstate_is_running();
}

86
static bool cpu_thread_is_idle(CPUState *cpu)
87
{
88
    if (cpu->stop || cpu->queued_work_first) {
89 90
        return false;
    }
91
    if (cpu_is_stopped(cpu)) {
92 93
        return true;
    }
94
    if (!cpu->halted || cpu_has_work(cpu) ||
95
        kvm_halt_in_kernel()) {
96 97 98 99 100 101 102
        return false;
    }
    return true;
}

static bool all_cpu_threads_idle(void)
{
103
    CPUState *cpu;
104

A
Andreas Färber 已提交
105
    CPU_FOREACH(cpu) {
106
        if (!cpu_thread_is_idle(cpu)) {
107 108 109 110 111 112
            return false;
        }
    }
    return true;
}

P
Paolo Bonzini 已提交
113 114 115
/***********************************************************/
/* guest cycle counter */

116 117
/* Protected by TimersState seqlock */

118
static bool icount_sleep = true;
119
static int64_t vm_clock_warp_start = -1;
P
Paolo Bonzini 已提交
120 121 122 123
/* 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
124

P
Paolo Bonzini 已提交
125 126 127 128 129
static QEMUTimer *icount_rt_timer;
static QEMUTimer *icount_vm_timer;
static QEMUTimer *icount_warp_timer;

typedef struct TimersState {
130
    /* Protected by BQL.  */
P
Paolo Bonzini 已提交
131 132
    int64_t cpu_ticks_prev;
    int64_t cpu_ticks_offset;
133 134 135 136 137

    /* cpu_clock_offset can be read out of BQL, so protect it with
     * this lock.
     */
    QemuSeqLock vm_clock_seqlock;
P
Paolo Bonzini 已提交
138 139 140
    int64_t cpu_clock_offset;
    int32_t cpu_ticks_enabled;
    int64_t dummy;
141 142 143 144 145

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

L
Liu Ping Fan 已提交
148
static TimersState timers_state;
P
Paolo Bonzini 已提交
149

150
int64_t cpu_get_icount_raw(void)
P
Paolo Bonzini 已提交
151 152
{
    int64_t icount;
153
    CPUState *cpu = current_cpu;
P
Paolo Bonzini 已提交
154

155
    icount = timers_state.qemu_icount;
156
    if (cpu) {
157
        if (!cpu->can_do_io) {
158 159
            fprintf(stderr, "Bad icount read\n");
            exit(1);
P
Paolo Bonzini 已提交
160
        }
161
        icount -= (cpu->icount_decr.u16.low + cpu->icount_extra);
P
Paolo Bonzini 已提交
162
    }
163 164 165 166 167 168 169
    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();
170
    return timers_state.qemu_icount_bias + cpu_icount_to_ns(icount);
P
Paolo Bonzini 已提交
171 172
}

P
Paolo Bonzini 已提交
173 174 175 176 177 178 179 180 181 182 183 184 185
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;
}

186 187 188 189 190
int64_t cpu_icount_to_ns(int64_t icount)
{
    return icount << icount_time_shift;
}

P
Paolo Bonzini 已提交
191
/* return the host CPU cycle counter and handle stop/restart */
192
/* Caller must hold the BQL */
P
Paolo Bonzini 已提交
193 194
int64_t cpu_get_ticks(void)
{
P
Paolo Bonzini 已提交
195 196
    int64_t ticks;

P
Paolo Bonzini 已提交
197 198 199
    if (use_icount) {
        return cpu_get_icount();
    }
P
Paolo Bonzini 已提交
200 201 202

    ticks = timers_state.cpu_ticks_offset;
    if (timers_state.cpu_ticks_enabled) {
203
        ticks += cpu_get_host_ticks();
P
Paolo Bonzini 已提交
204 205 206 207 208 209 210
    }

    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 已提交
211
    }
P
Paolo Bonzini 已提交
212 213 214

    timers_state.cpu_ticks_prev = ticks;
    return ticks;
P
Paolo Bonzini 已提交
215 216
}

217
static int64_t cpu_get_clock_locked(void)
P
Paolo Bonzini 已提交
218
{
P
Paolo Bonzini 已提交
219
    int64_t ticks;
220

P
Paolo Bonzini 已提交
221 222 223
    ticks = timers_state.cpu_clock_offset;
    if (timers_state.cpu_ticks_enabled) {
        ticks += get_clock();
P
Paolo Bonzini 已提交
224
    }
225

P
Paolo Bonzini 已提交
226
    return ticks;
227 228 229 230 231 232 233 234 235 236 237 238 239 240
}

/* 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 已提交
241 242
}

243 244 245
/* enable cpu_get_ticks()
 * Caller must hold BQL which server as mutex for vm_clock_seqlock.
 */
P
Paolo Bonzini 已提交
246 247
void cpu_enable_ticks(void)
{
248 249
    /* Here, the really thing protected by seqlock is cpu_clock_offset. */
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
250
    if (!timers_state.cpu_ticks_enabled) {
251
        timers_state.cpu_ticks_offset -= cpu_get_host_ticks();
P
Paolo Bonzini 已提交
252 253 254
        timers_state.cpu_clock_offset -= get_clock();
        timers_state.cpu_ticks_enabled = 1;
    }
255
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
256 257 258
}

/* disable cpu_get_ticks() : the clock is stopped. You must not call
259 260 261
 * cpu_get_ticks() after that.
 * Caller must hold BQL which server as mutex for vm_clock_seqlock.
 */
P
Paolo Bonzini 已提交
262 263
void cpu_disable_ticks(void)
{
264 265
    /* Here, the really thing protected by seqlock is cpu_clock_offset. */
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
266
    if (timers_state.cpu_ticks_enabled) {
267
        timers_state.cpu_ticks_offset += cpu_get_host_ticks();
268
        timers_state.cpu_clock_offset = cpu_get_clock_locked();
P
Paolo Bonzini 已提交
269 270
        timers_state.cpu_ticks_enabled = 0;
    }
271
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
272 273 274 275 276 277 278 279 280 281 282 283 284
}

/* 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;
285 286

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

P
Paolo Bonzini 已提交
289 290 291 292
    /* If the VM is not running, then do nothing.  */
    if (!runstate_is_running()) {
        return;
    }
293

P
Paolo Bonzini 已提交
294 295 296
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
    cur_time = cpu_get_clock_locked();
    cur_icount = cpu_get_icount_locked();
297

P
Paolo Bonzini 已提交
298 299 300 301 302 303 304 305 306 307 308 309 310 311 312
    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;
313 314
    timers_state.qemu_icount_bias = cur_icount
                              - (timers_state.qemu_icount << icount_time_shift);
P
Paolo Bonzini 已提交
315
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
316 317 318 319
}

static void icount_adjust_rt(void *opaque)
{
320
    timer_mod(icount_rt_timer,
321
              qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL_RT) + 1000);
P
Paolo Bonzini 已提交
322 323 324 325 326
    icount_adjust();
}

static void icount_adjust_vm(void *opaque)
{
327 328 329
    timer_mod(icount_vm_timer,
                   qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
                   get_ticks_per_sec() / 10);
P
Paolo Bonzini 已提交
330 331 332 333 334 335 336 337
    icount_adjust();
}

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

338
static void icount_warp_rt(void)
P
Paolo Bonzini 已提交
339
{
P
Paolo Bonzini 已提交
340 341 342 343
    /* 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 已提交
344 345 346
        return;
    }

P
Paolo Bonzini 已提交
347
    seqlock_write_lock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
348
    if (runstate_is_running()) {
349 350
        int64_t clock = REPLAY_CLOCK(REPLAY_CLOCK_VIRTUAL_RT,
                                     cpu_get_clock_locked());
P
Paolo Bonzini 已提交
351 352 353 354
        int64_t warp_delta;

        warp_delta = clock - vm_clock_warp_start;
        if (use_icount == 2) {
P
Paolo Bonzini 已提交
355
            /*
356
             * In adaptive mode, do not let QEMU_CLOCK_VIRTUAL run too
P
Paolo Bonzini 已提交
357 358
             * far ahead of real time.
             */
P
Paolo Bonzini 已提交
359
            int64_t cur_icount = cpu_get_icount_locked();
360
            int64_t delta = clock - cur_icount;
P
Paolo Bonzini 已提交
361
            warp_delta = MIN(warp_delta, delta);
P
Paolo Bonzini 已提交
362
        }
363
        timers_state.qemu_icount_bias += warp_delta;
P
Paolo Bonzini 已提交
364 365
    }
    vm_clock_warp_start = -1;
P
Paolo Bonzini 已提交
366
    seqlock_write_unlock(&timers_state.vm_clock_seqlock);
P
Paolo Bonzini 已提交
367 368 369 370

    if (qemu_clock_expired(QEMU_CLOCK_VIRTUAL)) {
        qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
    }
P
Paolo Bonzini 已提交
371 372
}

373 374 375 376 377
static void icount_dummy_timer(void *opaque)
{
    (void)opaque;
}

P
Paolo Bonzini 已提交
378 379
void qtest_clock_warp(int64_t dest)
{
380
    int64_t clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
381
    AioContext *aio_context;
P
Paolo Bonzini 已提交
382
    assert(qtest_enabled());
383
    aio_context = qemu_get_aio_context();
P
Paolo Bonzini 已提交
384
    while (clock < dest) {
385
        int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
386
        int64_t warp = qemu_soonest_timeout(dest - clock, deadline);
387

P
Paolo Bonzini 已提交
388
        seqlock_write_lock(&timers_state.vm_clock_seqlock);
389
        timers_state.qemu_icount_bias += warp;
P
Paolo Bonzini 已提交
390 391
        seqlock_write_unlock(&timers_state.vm_clock_seqlock);

392
        qemu_clock_run_timers(QEMU_CLOCK_VIRTUAL);
393
        timerlist_run_timers(aio_context->tlg.tl[QEMU_CLOCK_VIRTUAL]);
394
        clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
395
    }
396
    qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
397 398
}

399
void qemu_clock_warp(QEMUClockType type)
P
Paolo Bonzini 已提交
400
{
401
    int64_t clock;
P
Paolo Bonzini 已提交
402 403 404 405 406 407 408
    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.
     */
409
    if (type != QEMU_CLOCK_VIRTUAL || !use_icount) {
P
Paolo Bonzini 已提交
410 411 412
        return;
    }

P
Pavel Dovgalyuk 已提交
413 414 415 416 417 418 419 420 421 422 423 424
    /* Nothing to do if the VM is stopped: QEMU_CLOCK_VIRTUAL timers
     * do not fire, so computing the deadline does not make sense.
     */
    if (!runstate_is_running()) {
        return;
    }

    /* warp clock deterministically in record/replay mode */
    if (!replay_checkpoint(CHECKPOINT_CLOCK_WARP)) {
        return;
    }

425 426 427 428 429 430 431 432 433
    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.
         */
434
        icount_warp_rt();
435 436
        timer_del(icount_warp_timer);
    }
437
    if (!all_cpu_threads_idle()) {
P
Paolo Bonzini 已提交
438 439 440
        return;
    }

P
Paolo Bonzini 已提交
441 442 443 444 445
    if (qtest_enabled()) {
        /* When testing, qtest commands advance icount.  */
	return;
    }

446
    /* We want to use the earliest deadline from ALL vm_clocks */
447
    clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL_RT);
448
    deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
449
    if (deadline < 0) {
450 451 452 453 454
        static bool notified;
        if (!icount_sleep && !notified) {
            error_report("WARNING: icount sleep disabled and no active timers");
            notified = true;
        }
455
        return;
456 457
    }

P
Paolo Bonzini 已提交
458 459
    if (deadline > 0) {
        /*
460
         * Ensure QEMU_CLOCK_VIRTUAL proceeds even when the virtual CPU goes to
P
Paolo Bonzini 已提交
461 462 463
         * 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
464
         * QEMU_CLOCK_VIRTUAL.
P
Paolo Bonzini 已提交
465
         */
466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492
        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);
493
        }
494
    } else if (deadline == 0) {
495
        qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
496 497 498
    }
}

499 500 501 502 503 504 505 506 507 508 509 510
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,
511
    .needed = icount_state_needed,
512 513 514 515 516 517 518
    .fields = (VMStateField[]) {
        VMSTATE_INT64(qemu_icount_bias, TimersState),
        VMSTATE_INT64(qemu_icount, TimersState),
        VMSTATE_END_OF_LIST()
    }
};

P
Paolo Bonzini 已提交
519 520 521 522
static const VMStateDescription vmstate_timers = {
    .name = "timer",
    .version_id = 2,
    .minimum_version_id = 1,
523
    .fields = (VMStateField[]) {
P
Paolo Bonzini 已提交
524 525 526 527
        VMSTATE_INT64(cpu_ticks_offset, TimersState),
        VMSTATE_INT64(dummy, TimersState),
        VMSTATE_INT64_V(cpu_clock_offset, TimersState, 2),
        VMSTATE_END_OF_LIST()
528
    },
529 530 531
    .subsections = (const VMStateDescription*[]) {
        &icount_vmstate_timers,
        NULL
P
Paolo Bonzini 已提交
532 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 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602
static void cpu_throttle_thread(void *opaque)
{
    CPUState *cpu = opaque;
    double pct;
    double throttle_ratio;
    long sleeptime_ns;

    if (!cpu_throttle_get_percentage()) {
        return;
    }

    pct = (double)cpu_throttle_get_percentage()/100;
    throttle_ratio = pct / (1 - pct);
    sleeptime_ns = (long)(throttle_ratio * CPU_THROTTLE_TIMESLICE_NS);

    qemu_mutex_unlock_iothread();
    atomic_set(&cpu->throttle_thread_scheduled, 0);
    g_usleep(sleeptime_ns / 1000); /* Convert ns to us for usleep call */
    qemu_mutex_lock_iothread();
}

static void cpu_throttle_timer_tick(void *opaque)
{
    CPUState *cpu;
    double pct;

    /* Stop the timer if needed */
    if (!cpu_throttle_get_percentage()) {
        return;
    }
    CPU_FOREACH(cpu) {
        if (!atomic_xchg(&cpu->throttle_thread_scheduled, 1)) {
            async_run_on_cpu(cpu, cpu_throttle_thread, cpu);
        }
    }

    pct = (double)cpu_throttle_get_percentage()/100;
    timer_mod(throttle_timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL_RT) +
                                   CPU_THROTTLE_TIMESLICE_NS / (1-pct));
}

void cpu_throttle_set(int new_throttle_pct)
{
    /* Ensure throttle percentage is within valid range */
    new_throttle_pct = MIN(new_throttle_pct, CPU_THROTTLE_PCT_MAX);
    new_throttle_pct = MAX(new_throttle_pct, CPU_THROTTLE_PCT_MIN);

    atomic_set(&throttle_percentage, new_throttle_pct);

    timer_mod(throttle_timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL_RT) +
                                       CPU_THROTTLE_TIMESLICE_NS);
}

void cpu_throttle_stop(void)
{
    atomic_set(&throttle_percentage, 0);
}

bool cpu_throttle_active(void)
{
    return (cpu_throttle_get_percentage() != 0);
}

int cpu_throttle_get_percentage(void)
{
    return atomic_read(&throttle_percentage);
}

603 604 605 606
void cpu_ticks_init(void)
{
    seqlock_init(&timers_state.vm_clock_seqlock, NULL);
    vmstate_register(NULL, 0, &vmstate_timers, &timers_state);
607 608
    throttle_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL_RT,
                                           cpu_throttle_timer_tick, NULL);
609 610
}

611
void configure_icount(QemuOpts *opts, Error **errp)
P
Paolo Bonzini 已提交
612
{
613
    const char *option;
614
    char *rem_str = NULL;
615 616

    option = qemu_opt_get(opts, "shift");
P
Paolo Bonzini 已提交
617
    if (!option) {
618 619 620
        if (qemu_opt_get(opts, "align") != NULL) {
            error_setg(errp, "Please specify shift option when using align");
        }
P
Paolo Bonzini 已提交
621 622
        return;
    }
623 624

    icount_sleep = qemu_opt_get_bool(opts, "sleep", true);
625 626
    if (icount_sleep) {
        icount_warp_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL_RT,
627
                                         icount_dummy_timer, NULL);
628
    }
629

630
    icount_align_option = qemu_opt_get_bool(opts, "align", false);
631 632 633 634

    if (icount_align_option && !icount_sleep) {
        error_setg(errp, "align=on and sleep=no are incompatible");
    }
P
Paolo Bonzini 已提交
635
    if (strcmp(option, "auto") != 0) {
636 637 638 639 640
        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 已提交
641 642
        use_icount = 1;
        return;
643 644
    } else if (icount_align_option) {
        error_setg(errp, "shift=auto and align=on are incompatible");
645 646
    } else if (!icount_sleep) {
        error_setg(errp, "shift=auto and sleep=no are incompatible");
P
Paolo Bonzini 已提交
647 648 649 650 651 652 653 654 655 656 657 658 659
    }

    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.  */
660 661
    icount_rt_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL_RT,
                                   icount_adjust_rt, NULL);
662
    timer_mod(icount_rt_timer,
663
                   qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL_RT) + 1000);
664 665 666 667 668
    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 已提交
669 670
}

671 672 673 674
/***********************************************************/
void hw_error(const char *fmt, ...)
{
    va_list ap;
675
    CPUState *cpu;
676 677 678 679 680

    va_start(ap, fmt);
    fprintf(stderr, "qemu: hardware error: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
A
Andreas Färber 已提交
681
    CPU_FOREACH(cpu) {
682
        fprintf(stderr, "CPU #%d:\n", cpu->cpu_index);
683
        cpu_dump_state(cpu, stderr, fprintf, CPU_DUMP_FPU);
684 685 686 687 688 689 690
    }
    va_end(ap);
    abort();
}

void cpu_synchronize_all_states(void)
{
691
    CPUState *cpu;
692

A
Andreas Färber 已提交
693
    CPU_FOREACH(cpu) {
694
        cpu_synchronize_state(cpu);
695 696 697 698 699
    }
}

void cpu_synchronize_all_post_reset(void)
{
700
    CPUState *cpu;
701

A
Andreas Färber 已提交
702
    CPU_FOREACH(cpu) {
703
        cpu_synchronize_post_reset(cpu);
704 705 706 707 708
    }
}

void cpu_synchronize_all_post_init(void)
{
709
    CPUState *cpu;
710

A
Andreas Färber 已提交
711
    CPU_FOREACH(cpu) {
712
        cpu_synchronize_post_init(cpu);
713 714 715
    }
}

716
static int do_vm_stop(RunState state)
717
{
718 719
    int ret = 0;

720
    if (runstate_is_running()) {
721 722
        cpu_disable_ticks();
        pause_all_vcpus();
723
        runstate_set(state);
724
        vm_state_notify(0, state);
W
Wenchao Xia 已提交
725
        qapi_event_send_stop(&error_abort);
726
    }
727

728 729 730
    bdrv_drain_all();
    ret = bdrv_flush_all();

731
    return ret;
732 733
}

734
static bool cpu_can_run(CPUState *cpu)
735
{
A
Andreas Färber 已提交
736
    if (cpu->stop) {
737
        return false;
738
    }
739
    if (cpu_is_stopped(cpu)) {
740
        return false;
741
    }
742
    return true;
743 744
}

745
static void cpu_handle_guest_debug(CPUState *cpu)
746
{
747
    gdb_set_stop_cpu(cpu);
748
    qemu_system_debug_request();
749
    cpu->stopped = true;
750 751
}

752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790
#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);
}

791
static void qemu_kvm_eat_signals(CPUState *cpu)
792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811
{
    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:
812
            if (kvm_on_sigbus_vcpu(cpu, siginfo.si_code, siginfo.si_addr)) {
813 814 815 816 817 818 819 820 821 822 823 824 825 826 827
                sigbus_reraise();
            }
            break;
        default:
            break;
        }

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

828 829 830 831 832
#else /* !CONFIG_LINUX */

static void qemu_init_sigbus(void)
{
}
833

834
static void qemu_kvm_eat_signals(CPUState *cpu)
835 836
{
}
837 838
#endif /* !CONFIG_LINUX */

839
#ifndef _WIN32
840 841 842 843
static void dummy_signal(int sig)
{
}

844
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
845 846 847 848 849 850 851 852 853 854 855 856
{
    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);
857
    r = kvm_set_signal_mask(cpu, &set);
858 859 860 861 862 863
    if (r) {
        fprintf(stderr, "kvm_set_signal_mask: %s\n", strerror(-r));
        exit(1);
    }
}

864
#else /* _WIN32 */
865
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
866
{
867 868 869
    abort();
}
#endif /* _WIN32 */
870

871
static QemuMutex qemu_global_mutex;
872
static QemuCond qemu_io_proceeded_cond;
873
static unsigned iothread_requesting_mutex;
874 875 876 877 878 879 880

static QemuThread io_thread;

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

P
Paolo Bonzini 已提交
883
void qemu_init_cpu_loop(void)
884
{
885
    qemu_init_sigbus();
886 887 888
    qemu_cond_init(&qemu_cpu_cond);
    qemu_cond_init(&qemu_pause_cond);
    qemu_cond_init(&qemu_work_cond);
889
    qemu_cond_init(&qemu_io_proceeded_cond);
890 891
    qemu_mutex_init(&qemu_global_mutex);

J
Jan Kiszka 已提交
892
    qemu_thread_get_self(&io_thread);
893 894
}

895
void run_on_cpu(CPUState *cpu, void (*func)(void *data), void *data)
M
Marcelo Tosatti 已提交
896 897 898
{
    struct qemu_work_item wi;

899
    if (qemu_cpu_is_self(cpu)) {
M
Marcelo Tosatti 已提交
900 901 902 903 904 905
        func(data);
        return;
    }

    wi.func = func;
    wi.data = data;
C
Chegu Vinod 已提交
906
    wi.free = false;
907 908

    qemu_mutex_lock(&cpu->work_mutex);
909 910
    if (cpu->queued_work_first == NULL) {
        cpu->queued_work_first = &wi;
911
    } else {
912
        cpu->queued_work_last->next = &wi;
913
    }
914
    cpu->queued_work_last = &wi;
M
Marcelo Tosatti 已提交
915 916
    wi.next = NULL;
    wi.done = false;
917
    qemu_mutex_unlock(&cpu->work_mutex);
M
Marcelo Tosatti 已提交
918

919
    qemu_cpu_kick(cpu);
920
    while (!atomic_mb_read(&wi.done)) {
921
        CPUState *self_cpu = current_cpu;
M
Marcelo Tosatti 已提交
922 923

        qemu_cond_wait(&qemu_work_cond, &qemu_global_mutex);
924
        current_cpu = self_cpu;
M
Marcelo Tosatti 已提交
925 926 927
    }
}

C
Chegu Vinod 已提交
928 929 930 931 932 933 934 935 936 937 938 939 940
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;
941 942

    qemu_mutex_lock(&cpu->work_mutex);
C
Chegu Vinod 已提交
943 944 945 946 947 948 949 950
    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;
951
    qemu_mutex_unlock(&cpu->work_mutex);
C
Chegu Vinod 已提交
952 953 954 955

    qemu_cpu_kick(cpu);
}

956
static void flush_queued_work(CPUState *cpu)
M
Marcelo Tosatti 已提交
957 958 959
{
    struct qemu_work_item *wi;

960
    if (cpu->queued_work_first == NULL) {
M
Marcelo Tosatti 已提交
961
        return;
962
    }
M
Marcelo Tosatti 已提交
963

964 965 966
    qemu_mutex_lock(&cpu->work_mutex);
    while (cpu->queued_work_first != NULL) {
        wi = cpu->queued_work_first;
967
        cpu->queued_work_first = wi->next;
968 969 970 971
        if (!cpu->queued_work_first) {
            cpu->queued_work_last = NULL;
        }
        qemu_mutex_unlock(&cpu->work_mutex);
M
Marcelo Tosatti 已提交
972
        wi->func(wi->data);
973
        qemu_mutex_lock(&cpu->work_mutex);
C
Chegu Vinod 已提交
974 975
        if (wi->free) {
            g_free(wi);
976 977
        } else {
            atomic_mb_set(&wi->done, true);
C
Chegu Vinod 已提交
978
        }
M
Marcelo Tosatti 已提交
979
    }
980
    qemu_mutex_unlock(&cpu->work_mutex);
M
Marcelo Tosatti 已提交
981 982 983
    qemu_cond_broadcast(&qemu_work_cond);
}

984
static void qemu_wait_io_event_common(CPUState *cpu)
985
{
A
Andreas Färber 已提交
986 987
    if (cpu->stop) {
        cpu->stop = false;
988
        cpu->stopped = true;
989 990
        qemu_cond_signal(&qemu_pause_cond);
    }
991
    flush_queued_work(cpu);
992
    cpu->thread_kicked = false;
993 994
}

995
static void qemu_tcg_wait_io_event(CPUState *cpu)
996
{
997
    while (all_cpu_threads_idle()) {
998 999
       /* Start accounting real time to the virtual clock if the CPUs
          are idle.  */
1000
        qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
1001
        qemu_cond_wait(cpu->halt_cond, &qemu_global_mutex);
1002
    }
1003

1004 1005 1006
    while (iothread_requesting_mutex) {
        qemu_cond_wait(&qemu_io_proceeded_cond, &qemu_global_mutex);
    }
1007

A
Andreas Färber 已提交
1008
    CPU_FOREACH(cpu) {
1009
        qemu_wait_io_event_common(cpu);
1010
    }
1011 1012
}

1013
static void qemu_kvm_wait_io_event(CPUState *cpu)
1014
{
1015
    while (cpu_thread_is_idle(cpu)) {
A
Andreas Färber 已提交
1016
        qemu_cond_wait(cpu->halt_cond, &qemu_global_mutex);
1017
    }
1018

1019
    qemu_kvm_eat_signals(cpu);
1020
    qemu_wait_io_event_common(cpu);
1021 1022
}

1023
static void *qemu_kvm_cpu_thread_fn(void *arg)
1024
{
1025
    CPUState *cpu = arg;
J
Jan Kiszka 已提交
1026
    int r;
1027

1028 1029
    rcu_register_thread();

1030
    qemu_mutex_lock_iothread();
1031
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
1032
    cpu->thread_id = qemu_get_thread_id();
1033
    cpu->can_do_io = 1;
1034
    current_cpu = cpu;
1035

1036
    r = kvm_init_vcpu(cpu);
J
Jan Kiszka 已提交
1037 1038 1039 1040
    if (r < 0) {
        fprintf(stderr, "kvm_init_vcpu failed: %s\n", strerror(-r));
        exit(1);
    }
1041

1042
    qemu_kvm_init_cpu_signals(cpu);
1043 1044

    /* signal CPU creation */
1045
    cpu->created = true;
1046 1047 1048
    qemu_cond_signal(&qemu_cpu_cond);

    while (1) {
1049
        if (cpu_can_run(cpu)) {
1050
            r = kvm_cpu_exec(cpu);
1051
            if (r == EXCP_DEBUG) {
1052
                cpu_handle_guest_debug(cpu);
1053
            }
1054
        }
1055
        qemu_kvm_wait_io_event(cpu);
1056 1057 1058 1059 1060
    }

    return NULL;
}

A
Anthony Liguori 已提交
1061 1062 1063 1064 1065 1066
static void *qemu_dummy_cpu_thread_fn(void *arg)
{
#ifdef _WIN32
    fprintf(stderr, "qtest is not supported under Windows\n");
    exit(1);
#else
1067
    CPUState *cpu = arg;
A
Anthony Liguori 已提交
1068 1069 1070
    sigset_t waitset;
    int r;

1071 1072
    rcu_register_thread();

A
Anthony Liguori 已提交
1073
    qemu_mutex_lock_iothread();
1074
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
1075
    cpu->thread_id = qemu_get_thread_id();
1076
    cpu->can_do_io = 1;
A
Anthony Liguori 已提交
1077 1078 1079 1080 1081

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

    /* signal CPU creation */
1082
    cpu->created = true;
A
Anthony Liguori 已提交
1083 1084
    qemu_cond_signal(&qemu_cpu_cond);

1085
    current_cpu = cpu;
A
Anthony Liguori 已提交
1086
    while (1) {
1087
        current_cpu = NULL;
A
Anthony Liguori 已提交
1088 1089 1090 1091 1092 1093 1094 1095 1096 1097
        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();
1098
        current_cpu = cpu;
1099
        qemu_wait_io_event_common(cpu);
A
Anthony Liguori 已提交
1100 1101 1102 1103 1104 1105
    }

    return NULL;
#endif
}

J
Jan Kiszka 已提交
1106 1107
static void tcg_exec_all(void);

1108
static void *qemu_tcg_cpu_thread_fn(void *arg)
1109
{
1110
    CPUState *cpu = arg;
1111

1112 1113
    rcu_register_thread();

1114
    qemu_mutex_lock_iothread();
1115
    qemu_thread_get_self(cpu->thread);
1116

1117 1118 1119
    CPU_FOREACH(cpu) {
        cpu->thread_id = qemu_get_thread_id();
        cpu->created = true;
1120
        cpu->can_do_io = 1;
1121
    }
1122 1123
    qemu_cond_signal(&qemu_cpu_cond);

1124
    /* wait for initial kick-off after machine start */
1125
    while (first_cpu->stopped) {
1126
        qemu_cond_wait(first_cpu->halt_cond, &qemu_global_mutex);
1127 1128

        /* process any pending work */
A
Andreas Färber 已提交
1129
        CPU_FOREACH(cpu) {
1130
            qemu_wait_io_event_common(cpu);
1131
        }
1132
    }
1133

1134
    /* process any pending work */
1135
    atomic_mb_set(&exit_request, 1);
1136

1137
    while (1) {
J
Jan Kiszka 已提交
1138
        tcg_exec_all();
1139 1140

        if (use_icount) {
1141
            int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
1142 1143

            if (deadline == 0) {
1144
                qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
1145
            }
1146
        }
1147
        qemu_tcg_wait_io_event(QTAILQ_FIRST(&cpus));
1148 1149 1150 1151 1152
    }

    return NULL;
}

1153
static void qemu_cpu_kick_thread(CPUState *cpu)
P
Paolo Bonzini 已提交
1154 1155 1156 1157
{
#ifndef _WIN32
    int err;

P
Paolo Bonzini 已提交
1158 1159
    if (cpu->thread_kicked) {
        return;
1160
    }
P
Paolo Bonzini 已提交
1161
    cpu->thread_kicked = true;
1162
    err = pthread_kill(cpu->thread->thread, SIG_IPI);
P
Paolo Bonzini 已提交
1163 1164 1165 1166 1167
    if (err) {
        fprintf(stderr, "qemu:%s: %s", __func__, strerror(err));
        exit(1);
    }
#else /* _WIN32 */
P
Paolo Bonzini 已提交
1168 1169 1170
    abort();
#endif
}
1171

P
Paolo Bonzini 已提交
1172 1173 1174 1175 1176 1177 1178 1179 1180 1181
static void qemu_cpu_kick_no_halt(void)
{
    CPUState *cpu;
    /* Ensure whatever caused the exit has reached the CPU threads before
     * writing exit_request.
     */
    atomic_mb_set(&exit_request, 1);
    cpu = atomic_mb_read(&tcg_current_cpu);
    if (cpu) {
        cpu_exit(cpu);
P
Paolo Bonzini 已提交
1182 1183 1184
    }
}

1185
void qemu_cpu_kick(CPUState *cpu)
1186
{
A
Andreas Färber 已提交
1187
    qemu_cond_broadcast(cpu->halt_cond);
P
Paolo Bonzini 已提交
1188 1189 1190 1191 1192
    if (tcg_enabled()) {
        qemu_cpu_kick_no_halt();
    } else {
        qemu_cpu_kick_thread(cpu);
    }
1193 1194
}

1195
void qemu_cpu_kick_self(void)
1196
{
1197
    assert(current_cpu);
1198
    qemu_cpu_kick_thread(current_cpu);
1199 1200
}

1201
bool qemu_cpu_is_self(CPUState *cpu)
1202
{
1203
    return qemu_thread_is_self(cpu->thread);
1204 1205
}

1206
bool qemu_in_vcpu_thread(void)
J
Juan Quintela 已提交
1207
{
1208
    return current_cpu && qemu_cpu_is_self(current_cpu);
J
Juan Quintela 已提交
1209 1210
}

1211 1212 1213 1214 1215 1216 1217
static __thread bool iothread_locked = false;

bool qemu_mutex_iothread_locked(void)
{
    return iothread_locked;
}

1218 1219
void qemu_mutex_lock_iothread(void)
{
1220
    atomic_inc(&iothread_requesting_mutex);
1221 1222 1223 1224
    /* In the simple case there is no need to bump the VCPU thread out of
     * TCG code execution.
     */
    if (!tcg_enabled() || qemu_in_vcpu_thread() ||
1225
        !first_cpu || !first_cpu->created) {
1226
        qemu_mutex_lock(&qemu_global_mutex);
1227
        atomic_dec(&iothread_requesting_mutex);
1228 1229
    } else {
        if (qemu_mutex_trylock(&qemu_global_mutex)) {
P
Paolo Bonzini 已提交
1230
            qemu_cpu_kick_no_halt();
1231 1232
            qemu_mutex_lock(&qemu_global_mutex);
        }
1233
        atomic_dec(&iothread_requesting_mutex);
1234
        qemu_cond_broadcast(&qemu_io_proceeded_cond);
1235
    }
1236
    iothread_locked = true;
1237 1238 1239 1240
}

void qemu_mutex_unlock_iothread(void)
{
1241
    iothread_locked = false;
1242 1243 1244 1245 1246
    qemu_mutex_unlock(&qemu_global_mutex);
}

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

A
Andreas Färber 已提交
1249
    CPU_FOREACH(cpu) {
1250
        if (!cpu->stopped) {
1251
            return 0;
1252
        }
1253 1254 1255 1256 1257 1258 1259
    }

    return 1;
}

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

1262
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, false);
A
Andreas Färber 已提交
1263
    CPU_FOREACH(cpu) {
1264 1265
        cpu->stop = true;
        qemu_cpu_kick(cpu);
1266 1267
    }

J
Juan Quintela 已提交
1268
    if (qemu_in_vcpu_thread()) {
1269 1270
        cpu_stop_current();
        if (!kvm_enabled()) {
A
Andreas Färber 已提交
1271
            CPU_FOREACH(cpu) {
1272 1273
                cpu->stop = false;
                cpu->stopped = true;
1274 1275 1276 1277 1278
            }
            return;
        }
    }

1279
    while (!all_vcpus_paused()) {
1280
        qemu_cond_wait(&qemu_pause_cond, &qemu_global_mutex);
A
Andreas Färber 已提交
1281
        CPU_FOREACH(cpu) {
1282
            qemu_cpu_kick(cpu);
1283 1284 1285 1286
        }
    }
}

1287 1288 1289 1290 1291 1292 1293
void cpu_resume(CPUState *cpu)
{
    cpu->stop = false;
    cpu->stopped = false;
    qemu_cpu_kick(cpu);
}

1294 1295
void resume_all_vcpus(void)
{
A
Andreas Färber 已提交
1296
    CPUState *cpu;
1297

1298
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, true);
A
Andreas Färber 已提交
1299
    CPU_FOREACH(cpu) {
1300
        cpu_resume(cpu);
1301 1302 1303
    }
}

1304 1305 1306
/* For temporary buffers for forming a name */
#define VCPU_THREAD_NAME_SIZE 16

1307
static void qemu_tcg_init_vcpu(CPUState *cpu)
1308
{
1309
    char thread_name[VCPU_THREAD_NAME_SIZE];
1310 1311
    static QemuCond *tcg_halt_cond;
    static QemuThread *tcg_cpu_thread;
1312

1313 1314
    /* share a single thread for all cpus with TCG */
    if (!tcg_cpu_thread) {
1315
        cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1316 1317 1318
        cpu->halt_cond = g_malloc0(sizeof(QemuCond));
        qemu_cond_init(cpu->halt_cond);
        tcg_halt_cond = cpu->halt_cond;
1319 1320 1321 1322
        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 已提交
1323
#ifdef _WIN32
1324
        cpu->hThread = qemu_thread_get_handle(cpu->thread);
P
Paolo Bonzini 已提交
1325
#endif
1326
        while (!cpu->created) {
1327
            qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
1328
        }
1329
        tcg_cpu_thread = cpu->thread;
1330
    } else {
1331
        cpu->thread = tcg_cpu_thread;
A
Andreas Färber 已提交
1332
        cpu->halt_cond = tcg_halt_cond;
1333 1334 1335
    }
}

1336
static void qemu_kvm_start_vcpu(CPUState *cpu)
1337
{
1338 1339
    char thread_name[VCPU_THREAD_NAME_SIZE];

1340
    cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1341 1342
    cpu->halt_cond = g_malloc0(sizeof(QemuCond));
    qemu_cond_init(cpu->halt_cond);
1343 1344 1345 1346
    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);
1347
    while (!cpu->created) {
1348
        qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
1349
    }
1350 1351
}

1352
static void qemu_dummy_start_vcpu(CPUState *cpu)
A
Anthony Liguori 已提交
1353
{
1354 1355
    char thread_name[VCPU_THREAD_NAME_SIZE];

1356
    cpu->thread = g_malloc0(sizeof(QemuThread));
A
Andreas Färber 已提交
1357 1358
    cpu->halt_cond = g_malloc0(sizeof(QemuCond));
    qemu_cond_init(cpu->halt_cond);
1359 1360 1361
    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 已提交
1362
                       QEMU_THREAD_JOINABLE);
1363
    while (!cpu->created) {
A
Anthony Liguori 已提交
1364 1365 1366 1367
        qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
    }
}

1368
void qemu_init_vcpu(CPUState *cpu)
1369
{
1370 1371
    cpu->nr_cores = smp_cores;
    cpu->nr_threads = smp_threads;
1372
    cpu->stopped = true;
1373 1374 1375 1376 1377

    if (!cpu->as) {
        /* If the target cpu hasn't set up any address spaces itself,
         * give it the default one.
         */
1378
        cpu->num_ases = 1;
1379 1380 1381
        cpu_address_space_init(cpu, &address_space_memory, 0);
    }

1382
    if (kvm_enabled()) {
1383
        qemu_kvm_start_vcpu(cpu);
A
Anthony Liguori 已提交
1384
    } else if (tcg_enabled()) {
1385
        qemu_tcg_init_vcpu(cpu);
A
Anthony Liguori 已提交
1386
    } else {
1387
        qemu_dummy_start_vcpu(cpu);
1388
    }
1389 1390
}

1391
void cpu_stop_current(void)
1392
{
1393 1394 1395 1396
    if (current_cpu) {
        current_cpu->stop = false;
        current_cpu->stopped = true;
        cpu_exit(current_cpu);
1397
        qemu_cond_signal(&qemu_pause_cond);
1398
    }
1399 1400
}

1401
int vm_stop(RunState state)
1402
{
J
Juan Quintela 已提交
1403
    if (qemu_in_vcpu_thread()) {
1404
        qemu_system_vmstop_request_prepare();
1405
        qemu_system_vmstop_request(state);
1406 1407 1408 1409
        /*
         * FIXME: should not return to device code in case
         * vm_stop() has been requested.
         */
1410
        cpu_stop_current();
1411
        return 0;
1412
    }
1413 1414

    return do_vm_stop(state);
1415 1416
}

1417 1418
/* does a state transition even if the VM is already stopped,
   current state is forgotten forever */
1419
int vm_stop_force_state(RunState state)
1420 1421
{
    if (runstate_is_running()) {
1422
        return vm_stop(state);
1423 1424
    } else {
        runstate_set(state);
1425 1426

        bdrv_drain_all();
1427 1428 1429
        /* Make sure to return an error if the flush in a previous vm_stop()
         * failed. */
        return bdrv_flush_all();
1430 1431 1432
    }
}

1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454
static int64_t tcg_get_icount_limit(void)
{
    int64_t deadline;

    if (replay_mode != REPLAY_MODE_PLAY) {
        deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);

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

        return qemu_icount_round(deadline);
    } else {
        return replay_get_instructions();
    }
}

1455
static int tcg_cpu_exec(CPUState *cpu)
1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467
{
    int ret;
#ifdef CONFIG_PROFILER
    int64_t ti;
#endif

#ifdef CONFIG_PROFILER
    ti = profile_getclock();
#endif
    if (use_icount) {
        int64_t count;
        int decr;
1468 1469
        timers_state.qemu_icount -= (cpu->icount_decr.u16.low
                                    + cpu->icount_extra);
1470
        cpu->icount_decr.u16.low = 0;
1471
        cpu->icount_extra = 0;
1472
        count = tcg_get_icount_limit();
1473
        timers_state.qemu_icount += count;
1474 1475
        decr = (count > 0xffff) ? 0xffff : count;
        count -= decr;
1476
        cpu->icount_decr.u16.low = decr;
1477
        cpu->icount_extra = count;
1478
    }
1479
    ret = cpu_exec(cpu);
1480
#ifdef CONFIG_PROFILER
1481
    tcg_time += profile_getclock() - ti;
1482 1483 1484 1485
#endif
    if (use_icount) {
        /* Fold pending instructions back into the
           instruction counter, and clear the interrupt flag.  */
1486 1487
        timers_state.qemu_icount -= (cpu->icount_decr.u16.low
                        + cpu->icount_extra);
1488
        cpu->icount_decr.u32 = 0;
1489
        cpu->icount_extra = 0;
1490
        replay_account_executed_instructions();
1491 1492 1493 1494
    }
    return ret;
}

J
Jan Kiszka 已提交
1495
static void tcg_exec_all(void)
1496
{
1497 1498
    int r;

1499 1500
    /* Account partial waits to QEMU_CLOCK_VIRTUAL.  */
    qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
1501

1502
    if (next_cpu == NULL) {
1503
        next_cpu = first_cpu;
1504
    }
A
Andreas Färber 已提交
1505
    for (; next_cpu != NULL && !exit_request; next_cpu = CPU_NEXT(next_cpu)) {
1506
        CPUState *cpu = next_cpu;
1507

1508
        qemu_clock_enable(QEMU_CLOCK_VIRTUAL,
1509
                          (cpu->singlestep_enabled & SSTEP_NOTIMER) == 0);
1510

1511
        if (cpu_can_run(cpu)) {
1512
            r = tcg_cpu_exec(cpu);
1513
            if (r == EXCP_DEBUG) {
1514
                cpu_handle_guest_debug(cpu);
1515 1516
                break;
            }
1517
        } else if (cpu->stop || cpu->stopped) {
1518 1519 1520
            break;
        }
    }
1521 1522 1523

    /* Pairs with smp_wmb in qemu_cpu_kick.  */
    atomic_mb_set(&exit_request, 0);
1524 1525
}

1526
void list_cpus(FILE *f, fprintf_function cpu_fprintf, const char *optarg)
1527 1528
{
    /* XXX: implement xxx_cpu_list for targets that still miss it */
P
Peter Maydell 已提交
1529 1530
#if defined(cpu_list)
    cpu_list(f, cpu_fprintf);
1531 1532
#endif
}
L
Luiz Capitulino 已提交
1533 1534 1535 1536

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

A
Andreas Färber 已提交
1539
    CPU_FOREACH(cpu) {
L
Luiz Capitulino 已提交
1540
        CpuInfoList *info;
1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552
#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;
1553 1554 1555
#elif defined(TARGET_TRICORE)
        TriCoreCPU *tricore_cpu = TRICORE_CPU(cpu);
        CPUTriCoreState *env = &tricore_cpu->env;
1556
#endif
L
Luiz Capitulino 已提交
1557

1558
        cpu_synchronize_state(cpu);
L
Luiz Capitulino 已提交
1559 1560 1561

        info = g_malloc0(sizeof(*info));
        info->value = g_malloc0(sizeof(*info->value));
1562
        info->value->CPU = cpu->cpu_index;
1563
        info->value->current = (cpu == first_cpu);
1564
        info->value->halted = cpu->halted;
1565
        info->value->qom_path = object_get_canonical_path(OBJECT(cpu));
A
Andreas Färber 已提交
1566
        info->value->thread_id = cpu->thread_id;
L
Luiz Capitulino 已提交
1567
#if defined(TARGET_I386)
E
Eric Blake 已提交
1568 1569 1570
        info->value->arch = CPU_INFO_ARCH_X86;
        info->value->u.x86 = g_new0(CpuInfoX86, 1);
        info->value->u.x86->pc = env->eip + env->segs[R_CS].base;
L
Luiz Capitulino 已提交
1571
#elif defined(TARGET_PPC)
E
Eric Blake 已提交
1572 1573 1574
        info->value->arch = CPU_INFO_ARCH_PPC;
        info->value->u.ppc = g_new0(CpuInfoPPC, 1);
        info->value->u.ppc->nip = env->nip;
L
Luiz Capitulino 已提交
1575
#elif defined(TARGET_SPARC)
E
Eric Blake 已提交
1576 1577 1578 1579
        info->value->arch = CPU_INFO_ARCH_SPARC;
        info->value->u.sparc = g_new0(CpuInfoSPARC, 1);
        info->value->u.sparc->pc = env->pc;
        info->value->u.sparc->npc = env->npc;
L
Luiz Capitulino 已提交
1580
#elif defined(TARGET_MIPS)
E
Eric Blake 已提交
1581 1582 1583
        info->value->arch = CPU_INFO_ARCH_MIPS;
        info->value->u.mips = g_new0(CpuInfoMIPS, 1);
        info->value->u.mips->PC = env->active_tc.PC;
1584
#elif defined(TARGET_TRICORE)
E
Eric Blake 已提交
1585 1586 1587 1588 1589 1590
        info->value->arch = CPU_INFO_ARCH_TRICORE;
        info->value->u.tricore = g_new0(CpuInfoTricore, 1);
        info->value->u.tricore->PC = env->PC;
#else
        info->value->arch = CPU_INFO_ARCH_OTHER;
        info->value->u.other = g_new0(CpuInfoOther, 1);
L
Luiz Capitulino 已提交
1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603
#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 已提交
1604 1605 1606 1607 1608 1609

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;
1610
    CPUState *cpu;
L
Luiz Capitulino 已提交
1611
    uint8_t buf[1024];
1612
    int64_t orig_addr = addr, orig_size = size;
L
Luiz Capitulino 已提交
1613 1614 1615 1616 1617

    if (!has_cpu) {
        cpu_index = 0;
    }

1618 1619
    cpu = qemu_get_cpu(cpu_index);
    if (cpu == NULL) {
1620 1621
        error_setg(errp, QERR_INVALID_PARAMETER_VALUE, "cpu-index",
                   "a CPU number");
L
Luiz Capitulino 已提交
1622 1623 1624 1625 1626
        return;
    }

    f = fopen(filename, "wb");
    if (!f) {
1627
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1628 1629 1630 1631 1632 1633 1634
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1635
        if (cpu_memory_rw_debug(cpu, addr, buf, l, 0) != 0) {
1636 1637
            error_setg(errp, "Invalid addr 0x%016" PRIx64 "/size %" PRId64
                             " specified", orig_addr, orig_size);
1638 1639
            goto exit;
        }
L
Luiz Capitulino 已提交
1640
        if (fwrite(buf, 1, l, f) != l) {
1641
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1642 1643 1644 1645 1646 1647 1648 1649 1650
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1651 1652 1653 1654 1655 1656 1657 1658 1659 1660

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) {
1661
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1662 1663 1664 1665 1666 1667 1668
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1669
        cpu_physical_memory_read(addr, buf, l);
L
Luiz Capitulino 已提交
1670
        if (fwrite(buf, 1, l, f) != l) {
1671
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1672 1673 1674 1675 1676 1677 1678 1679 1680
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1681 1682 1683 1684

void qmp_inject_nmi(Error **errp)
{
#if defined(TARGET_I386)
1685 1686
    CPUState *cs;

A
Andreas Färber 已提交
1687
    CPU_FOREACH(cs) {
1688
        X86CPU *cpu = X86_CPU(cs);
L
Luiz Capitulino 已提交
1689

1690
        if (!cpu->apic_state) {
1691
            cpu_interrupt(cs, CPU_INTERRUPT_NMI);
1692
        } else {
1693
            apic_deliver_nmi(cpu->apic_state);
1694
        }
L
Luiz Capitulino 已提交
1695 1696
    }
#else
1697
    nmi_monitor_handle(monitor_get_cpu_index(), errp);
L
Luiz Capitulino 已提交
1698 1699
#endif
}
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716

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");
    }
}