cpus.c 43.9 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
/*
 * 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. */
P
Peter Maydell 已提交
26
#include "qemu/osdep.h"
27

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

    if (icount_align_option && !icount_sleep) {
633
        error_setg(errp, "align=on and sleep=off are incompatible");
634
    }
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
    } else if (!icount_sleep) {
646
        error_setg(errp, "shift=auto and sleep=off 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
        qemu_cond_broadcast(&qemu_pause_cond);
990
    }
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
        qemu_cond_wait(cpu->halt_cond, &qemu_global_mutex);
999
    }
1000

1001 1002 1003
    while (iothread_requesting_mutex) {
        qemu_cond_wait(&qemu_io_proceeded_cond, &qemu_global_mutex);
    }
1004

A
Andreas Färber 已提交
1005
    CPU_FOREACH(cpu) {
1006
        qemu_wait_io_event_common(cpu);
1007
    }
1008 1009
}

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

1016
    qemu_kvm_eat_signals(cpu);
1017
    qemu_wait_io_event_common(cpu);
1018 1019
}

1020
static void *qemu_kvm_cpu_thread_fn(void *arg)
1021
{
1022
    CPUState *cpu = arg;
J
Jan Kiszka 已提交
1023
    int r;
1024

1025 1026
    rcu_register_thread();

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

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

1039
    qemu_kvm_init_cpu_signals(cpu);
1040 1041

    /* signal CPU creation */
1042
    cpu->created = true;
1043 1044 1045
    qemu_cond_signal(&qemu_cpu_cond);

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

    return NULL;
}

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

1068 1069
    rcu_register_thread();

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

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

    /* signal CPU creation */
1079
    cpu->created = true;
A
Anthony Liguori 已提交
1080 1081
    qemu_cond_signal(&qemu_cpu_cond);

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

    return NULL;
#endif
}

J
Jan Kiszka 已提交
1103 1104
static void tcg_exec_all(void);

1105
static void *qemu_tcg_cpu_thread_fn(void *arg)
1106
{
1107
    CPUState *cpu = arg;
1108

1109 1110
    rcu_register_thread();

1111
    qemu_mutex_lock_iothread();
1112
    qemu_thread_get_self(cpu->thread);
1113

1114 1115 1116
    CPU_FOREACH(cpu) {
        cpu->thread_id = qemu_get_thread_id();
        cpu->created = true;
1117
        cpu->can_do_io = 1;
1118
    }
1119 1120
    qemu_cond_signal(&qemu_cpu_cond);

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

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

1131
    /* process any pending work */
1132
    atomic_mb_set(&exit_request, 1);
1133

1134
    while (1) {
J
Jan Kiszka 已提交
1135
        tcg_exec_all();
1136 1137

        if (use_icount) {
1138
            int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
1139 1140

            if (deadline == 0) {
1141
                qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
1142
            }
1143
        }
1144
        qemu_tcg_wait_io_event(QTAILQ_FIRST(&cpus));
1145 1146 1147 1148 1149
    }

    return NULL;
}

1150
static void qemu_cpu_kick_thread(CPUState *cpu)
P
Paolo Bonzini 已提交
1151 1152 1153 1154
{
#ifndef _WIN32
    int err;

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

P
Paolo Bonzini 已提交
1169 1170 1171 1172 1173 1174 1175 1176 1177 1178
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 已提交
1179 1180 1181
    }
}

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

1192
void qemu_cpu_kick_self(void)
1193
{
1194
    assert(current_cpu);
1195
    qemu_cpu_kick_thread(current_cpu);
1196 1197
}

1198
bool qemu_cpu_is_self(CPUState *cpu)
1199
{
1200
    return qemu_thread_is_self(cpu->thread);
1201 1202
}

1203
bool qemu_in_vcpu_thread(void)
J
Juan Quintela 已提交
1204
{
1205
    return current_cpu && qemu_cpu_is_self(current_cpu);
J
Juan Quintela 已提交
1206 1207
}

1208 1209 1210 1211 1212 1213 1214
static __thread bool iothread_locked = false;

bool qemu_mutex_iothread_locked(void)
{
    return iothread_locked;
}

1215 1216
void qemu_mutex_lock_iothread(void)
{
1217
    atomic_inc(&iothread_requesting_mutex);
1218 1219 1220 1221
    /* 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() ||
1222
        !first_cpu || !first_cpu->created) {
1223
        qemu_mutex_lock(&qemu_global_mutex);
1224
        atomic_dec(&iothread_requesting_mutex);
1225 1226
    } else {
        if (qemu_mutex_trylock(&qemu_global_mutex)) {
P
Paolo Bonzini 已提交
1227
            qemu_cpu_kick_no_halt();
1228 1229
            qemu_mutex_lock(&qemu_global_mutex);
        }
1230
        atomic_dec(&iothread_requesting_mutex);
1231
        qemu_cond_broadcast(&qemu_io_proceeded_cond);
1232
    }
1233
    iothread_locked = true;
1234 1235 1236 1237
}

void qemu_mutex_unlock_iothread(void)
{
1238
    iothread_locked = false;
1239 1240 1241 1242 1243
    qemu_mutex_unlock(&qemu_global_mutex);
}

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

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

    return 1;
}

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

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

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

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

1284 1285 1286 1287 1288 1289 1290
void cpu_resume(CPUState *cpu)
{
    cpu->stop = false;
    cpu->stopped = false;
    qemu_cpu_kick(cpu);
}

1291 1292
void resume_all_vcpus(void)
{
A
Andreas Färber 已提交
1293
    CPUState *cpu;
1294

1295
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, true);
A
Andreas Färber 已提交
1296
    CPU_FOREACH(cpu) {
1297
        cpu_resume(cpu);
1298 1299 1300
    }
}

1301 1302 1303
/* For temporary buffers for forming a name */
#define VCPU_THREAD_NAME_SIZE 16

1304
static void qemu_tcg_init_vcpu(CPUState *cpu)
1305
{
1306
    char thread_name[VCPU_THREAD_NAME_SIZE];
1307 1308
    static QemuCond *tcg_halt_cond;
    static QemuThread *tcg_cpu_thread;
1309

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

1333
static void qemu_kvm_start_vcpu(CPUState *cpu)
1334
{
1335 1336
    char thread_name[VCPU_THREAD_NAME_SIZE];

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

1349
static void qemu_dummy_start_vcpu(CPUState *cpu)
A
Anthony Liguori 已提交
1350
{
1351 1352
    char thread_name[VCPU_THREAD_NAME_SIZE];

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

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

    if (!cpu->as) {
        /* If the target cpu hasn't set up any address spaces itself,
         * give it the default one.
         */
1375 1376
        AddressSpace *as = address_space_init_shareable(cpu->memory,
                                                        "cpu-memory");
1377
        cpu->num_ases = 1;
1378
        cpu_address_space_init(cpu, as, 0);
1379 1380
    }

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

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

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

    return do_vm_stop(state);
1414 1415
}

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

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

1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453
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();
    }
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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;
1603
    CPUState *cpu;
L
Luiz Capitulino 已提交
1604
    uint8_t buf[1024];
1605
    int64_t orig_addr = addr, orig_size = size;
L
Luiz Capitulino 已提交
1606 1607 1608 1609 1610

    if (!has_cpu) {
        cpu_index = 0;
    }

1611 1612
    cpu = qemu_get_cpu(cpu_index);
    if (cpu == NULL) {
1613 1614
        error_setg(errp, QERR_INVALID_PARAMETER_VALUE, "cpu-index",
                   "a CPU number");
L
Luiz Capitulino 已提交
1615 1616 1617 1618 1619
        return;
    }

    f = fopen(filename, "wb");
    if (!f) {
1620
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1621 1622 1623 1624 1625 1626 1627
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1628
        if (cpu_memory_rw_debug(cpu, addr, buf, l, 0) != 0) {
1629 1630
            error_setg(errp, "Invalid addr 0x%016" PRIx64 "/size %" PRId64
                             " specified", orig_addr, orig_size);
1631 1632
            goto exit;
        }
L
Luiz Capitulino 已提交
1633
        if (fwrite(buf, 1, l, f) != l) {
1634
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1635 1636 1637 1638 1639 1640 1641 1642 1643
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1644 1645 1646 1647 1648 1649 1650 1651 1652 1653

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) {
1654
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1655 1656 1657 1658 1659 1660 1661
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1662
        cpu_physical_memory_read(addr, buf, l);
L
Luiz Capitulino 已提交
1663
        if (fwrite(buf, 1, l, f) != l) {
1664
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1665 1666 1667 1668 1669 1670 1671 1672 1673
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1674 1675 1676 1677

void qmp_inject_nmi(Error **errp)
{
#if defined(TARGET_I386)
1678 1679
    CPUState *cs;

A
Andreas Färber 已提交
1680
    CPU_FOREACH(cs) {
1681
        X86CPU *cpu = X86_CPU(cs);
L
Luiz Capitulino 已提交
1682

1683
        if (!cpu->apic_state) {
1684
            cpu_interrupt(cs, CPU_INTERRUPT_NMI);
1685
        } else {
1686
            apic_deliver_nmi(cpu->apic_state);
1687
        }
L
Luiz Capitulino 已提交
1688 1689
    }
#else
1690
    nmi_monitor_handle(monitor_get_cpu_index(), errp);
L
Luiz Capitulino 已提交
1691 1692
#endif
}
1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709

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