cpus.c 43.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 338 339
    icount_adjust();
}

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

static void icount_warp_rt(void *opaque)
{
P
Paolo Bonzini 已提交
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
        int64_t clock = cpu_get_clock_locked();
P
Paolo Bonzini 已提交
350 351 352 353
        int64_t warp_delta;

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

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

P
Paolo Bonzini 已提交
372 373
void qtest_clock_warp(int64_t dest)
{
374
    int64_t clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
375
    AioContext *aio_context;
P
Paolo Bonzini 已提交
376
    assert(qtest_enabled());
377
    aio_context = qemu_get_aio_context();
P
Paolo Bonzini 已提交
378
    while (clock < dest) {
379
        int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
380
        int64_t warp = qemu_soonest_timeout(dest - clock, deadline);
381

P
Paolo Bonzini 已提交
382
        seqlock_write_lock(&timers_state.vm_clock_seqlock);
383
        timers_state.qemu_icount_bias += warp;
P
Paolo Bonzini 已提交
384 385
        seqlock_write_unlock(&timers_state.vm_clock_seqlock);

386
        qemu_clock_run_timers(QEMU_CLOCK_VIRTUAL);
387
        timerlist_run_timers(aio_context->tlg.tl[QEMU_CLOCK_VIRTUAL]);
388
        clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
389
    }
390
    qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
391 392
}

393
void qemu_clock_warp(QEMUClockType type)
P
Paolo Bonzini 已提交
394
{
395
    int64_t clock;
P
Paolo Bonzini 已提交
396 397 398 399 400 401 402
    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.
     */
403
    if (type != QEMU_CLOCK_VIRTUAL || !use_icount) {
P
Paolo Bonzini 已提交
404 405 406
        return;
    }

407 408 409 410 411 412 413 414 415 416 417 418
    if (icount_sleep) {
        /*
         * If the CPUs have been sleeping, advance QEMU_CLOCK_VIRTUAL timer now.
         * This ensures that the deadline for the timer is computed correctly
         * below.
         * This also makes sure that the insn counter is synchronized before
         * the CPU starts running, in case the CPU is woken by an event other
         * than the earliest QEMU_CLOCK_VIRTUAL timer.
         */
        icount_warp_rt(NULL);
        timer_del(icount_warp_timer);
    }
419
    if (!all_cpu_threads_idle()) {
P
Paolo Bonzini 已提交
420 421 422
        return;
    }

P
Paolo Bonzini 已提交
423 424 425 426 427
    if (qtest_enabled()) {
        /* When testing, qtest commands advance icount.  */
	return;
    }

428
    /* We want to use the earliest deadline from ALL vm_clocks */
429
    clock = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL_RT);
430
    deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
431
    if (deadline < 0) {
432 433 434 435 436
        static bool notified;
        if (!icount_sleep && !notified) {
            error_report("WARNING: icount sleep disabled and no active timers");
            notified = true;
        }
437
        return;
438 439
    }

P
Paolo Bonzini 已提交
440 441
    if (deadline > 0) {
        /*
442
         * Ensure QEMU_CLOCK_VIRTUAL proceeds even when the virtual CPU goes to
P
Paolo Bonzini 已提交
443 444 445
         * 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
446
         * QEMU_CLOCK_VIRTUAL.
P
Paolo Bonzini 已提交
447
         */
448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474
        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);
475
        }
476
    } else if (deadline == 0) {
477
        qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
P
Paolo Bonzini 已提交
478 479 480
    }
}

481 482 483 484 485 486 487 488 489 490 491 492
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,
493
    .needed = icount_state_needed,
494 495 496 497 498 499 500
    .fields = (VMStateField[]) {
        VMSTATE_INT64(qemu_icount_bias, TimersState),
        VMSTATE_INT64(qemu_icount, TimersState),
        VMSTATE_END_OF_LIST()
    }
};

P
Paolo Bonzini 已提交
501 502 503 504
static const VMStateDescription vmstate_timers = {
    .name = "timer",
    .version_id = 2,
    .minimum_version_id = 1,
505
    .fields = (VMStateField[]) {
P
Paolo Bonzini 已提交
506 507 508 509
        VMSTATE_INT64(cpu_ticks_offset, TimersState),
        VMSTATE_INT64(dummy, TimersState),
        VMSTATE_INT64_V(cpu_clock_offset, TimersState, 2),
        VMSTATE_END_OF_LIST()
510
    },
511 512 513
    .subsections = (const VMStateDescription*[]) {
        &icount_vmstate_timers,
        NULL
P
Paolo Bonzini 已提交
514 515 516
    }
};

517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 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
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);
}

585 586 587 588
void cpu_ticks_init(void)
{
    seqlock_init(&timers_state.vm_clock_seqlock, NULL);
    vmstate_register(NULL, 0, &vmstate_timers, &timers_state);
589 590
    throttle_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL_RT,
                                           cpu_throttle_timer_tick, NULL);
591 592
}

593
void configure_icount(QemuOpts *opts, Error **errp)
P
Paolo Bonzini 已提交
594
{
595
    const char *option;
596
    char *rem_str = NULL;
597 598

    option = qemu_opt_get(opts, "shift");
P
Paolo Bonzini 已提交
599
    if (!option) {
600 601 602
        if (qemu_opt_get(opts, "align") != NULL) {
            error_setg(errp, "Please specify shift option when using align");
        }
P
Paolo Bonzini 已提交
603 604
        return;
    }
605 606

    icount_sleep = qemu_opt_get_bool(opts, "sleep", true);
607 608 609 610
    if (icount_sleep) {
        icount_warp_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL_RT,
                                         icount_warp_rt, NULL);
    }
611

612
    icount_align_option = qemu_opt_get_bool(opts, "align", false);
613 614 615 616

    if (icount_align_option && !icount_sleep) {
        error_setg(errp, "align=on and sleep=no are incompatible");
    }
P
Paolo Bonzini 已提交
617
    if (strcmp(option, "auto") != 0) {
618 619 620 621 622
        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 已提交
623 624
        use_icount = 1;
        return;
625 626
    } else if (icount_align_option) {
        error_setg(errp, "shift=auto and align=on are incompatible");
627 628
    } else if (!icount_sleep) {
        error_setg(errp, "shift=auto and sleep=no are incompatible");
P
Paolo Bonzini 已提交
629 630 631 632 633 634 635 636 637 638 639 640 641
    }

    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.  */
642 643
    icount_rt_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL_RT,
                                   icount_adjust_rt, NULL);
644
    timer_mod(icount_rt_timer,
645
                   qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL_RT) + 1000);
646 647 648 649 650
    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 已提交
651 652
}

653 654 655 656
/***********************************************************/
void hw_error(const char *fmt, ...)
{
    va_list ap;
657
    CPUState *cpu;
658 659 660 661 662

    va_start(ap, fmt);
    fprintf(stderr, "qemu: hardware error: ");
    vfprintf(stderr, fmt, ap);
    fprintf(stderr, "\n");
A
Andreas Färber 已提交
663
    CPU_FOREACH(cpu) {
664
        fprintf(stderr, "CPU #%d:\n", cpu->cpu_index);
665
        cpu_dump_state(cpu, stderr, fprintf, CPU_DUMP_FPU);
666 667 668 669 670 671 672
    }
    va_end(ap);
    abort();
}

void cpu_synchronize_all_states(void)
{
673
    CPUState *cpu;
674

A
Andreas Färber 已提交
675
    CPU_FOREACH(cpu) {
676
        cpu_synchronize_state(cpu);
677 678 679 680 681
    }
}

void cpu_synchronize_all_post_reset(void)
{
682
    CPUState *cpu;
683

A
Andreas Färber 已提交
684
    CPU_FOREACH(cpu) {
685
        cpu_synchronize_post_reset(cpu);
686 687 688 689 690
    }
}

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

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

M
Marcelo Tosatti 已提交
698 699 700 701 702 703 704 705 706
void cpu_clean_all_dirty(void)
{
    CPUState *cpu;

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

707
static int do_vm_stop(RunState state)
708
{
709 710
    int ret = 0;

711
    if (runstate_is_running()) {
712 713
        cpu_disable_ticks();
        pause_all_vcpus();
714
        runstate_set(state);
715
        vm_state_notify(0, state);
W
Wenchao Xia 已提交
716
        qapi_event_send_stop(&error_abort);
717
    }
718

719 720 721
    bdrv_drain_all();
    ret = bdrv_flush_all();

722
    return ret;
723 724
}

725
static bool cpu_can_run(CPUState *cpu)
726
{
A
Andreas Färber 已提交
727
    if (cpu->stop) {
728
        return false;
729
    }
730
    if (cpu_is_stopped(cpu)) {
731
        return false;
732
    }
733
    return true;
734 735
}

736
static void cpu_handle_guest_debug(CPUState *cpu)
737
{
738
    gdb_set_stop_cpu(cpu);
739
    qemu_system_debug_request();
740
    cpu->stopped = true;
741 742
}

743 744 745 746 747 748 749 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
#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);
}

782
static void qemu_kvm_eat_signals(CPUState *cpu)
783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802
{
    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:
803
            if (kvm_on_sigbus_vcpu(cpu, siginfo.si_code, siginfo.si_addr)) {
804 805 806 807 808 809 810 811 812 813 814 815 816 817 818
                sigbus_reraise();
            }
            break;
        default:
            break;
        }

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

819 820 821 822 823
#else /* !CONFIG_LINUX */

static void qemu_init_sigbus(void)
{
}
824

825
static void qemu_kvm_eat_signals(CPUState *cpu)
826 827
{
}
828 829
#endif /* !CONFIG_LINUX */

830
#ifndef _WIN32
831 832 833 834
static void dummy_signal(int sig)
{
}

835
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
836 837 838 839 840 841 842 843 844 845 846 847
{
    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);
848
    r = kvm_set_signal_mask(cpu, &set);
849 850 851 852 853 854
    if (r) {
        fprintf(stderr, "kvm_set_signal_mask: %s\n", strerror(-r));
        exit(1);
    }
}

855
#else /* _WIN32 */
856
static void qemu_kvm_init_cpu_signals(CPUState *cpu)
857
{
858 859 860
    abort();
}
#endif /* _WIN32 */
861

862
static QemuMutex qemu_global_mutex;
863
static QemuCond qemu_io_proceeded_cond;
864
static unsigned iothread_requesting_mutex;
865 866 867 868 869 870 871

static QemuThread io_thread;

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

P
Paolo Bonzini 已提交
874
void qemu_init_cpu_loop(void)
875
{
876
    qemu_init_sigbus();
877 878 879
    qemu_cond_init(&qemu_cpu_cond);
    qemu_cond_init(&qemu_pause_cond);
    qemu_cond_init(&qemu_work_cond);
880
    qemu_cond_init(&qemu_io_proceeded_cond);
881 882
    qemu_mutex_init(&qemu_global_mutex);

J
Jan Kiszka 已提交
883
    qemu_thread_get_self(&io_thread);
884 885
}

886
void run_on_cpu(CPUState *cpu, void (*func)(void *data), void *data)
M
Marcelo Tosatti 已提交
887 888 889
{
    struct qemu_work_item wi;

890
    if (qemu_cpu_is_self(cpu)) {
M
Marcelo Tosatti 已提交
891 892 893 894 895 896
        func(data);
        return;
    }

    wi.func = func;
    wi.data = data;
C
Chegu Vinod 已提交
897
    wi.free = false;
898 899

    qemu_mutex_lock(&cpu->work_mutex);
900 901
    if (cpu->queued_work_first == NULL) {
        cpu->queued_work_first = &wi;
902
    } else {
903
        cpu->queued_work_last->next = &wi;
904
    }
905
    cpu->queued_work_last = &wi;
M
Marcelo Tosatti 已提交
906 907
    wi.next = NULL;
    wi.done = false;
908
    qemu_mutex_unlock(&cpu->work_mutex);
M
Marcelo Tosatti 已提交
909

910
    qemu_cpu_kick(cpu);
911
    while (!atomic_mb_read(&wi.done)) {
912
        CPUState *self_cpu = current_cpu;
M
Marcelo Tosatti 已提交
913 914

        qemu_cond_wait(&qemu_work_cond, &qemu_global_mutex);
915
        current_cpu = self_cpu;
M
Marcelo Tosatti 已提交
916 917 918
    }
}

C
Chegu Vinod 已提交
919 920 921 922 923 924 925 926 927 928 929 930 931
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;
932 933

    qemu_mutex_lock(&cpu->work_mutex);
C
Chegu Vinod 已提交
934 935 936 937 938 939 940 941
    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;
942
    qemu_mutex_unlock(&cpu->work_mutex);
C
Chegu Vinod 已提交
943 944 945 946

    qemu_cpu_kick(cpu);
}

947
static void flush_queued_work(CPUState *cpu)
M
Marcelo Tosatti 已提交
948 949 950
{
    struct qemu_work_item *wi;

951
    if (cpu->queued_work_first == NULL) {
M
Marcelo Tosatti 已提交
952
        return;
953
    }
M
Marcelo Tosatti 已提交
954

955 956 957
    qemu_mutex_lock(&cpu->work_mutex);
    while (cpu->queued_work_first != NULL) {
        wi = cpu->queued_work_first;
958
        cpu->queued_work_first = wi->next;
959 960 961 962
        if (!cpu->queued_work_first) {
            cpu->queued_work_last = NULL;
        }
        qemu_mutex_unlock(&cpu->work_mutex);
M
Marcelo Tosatti 已提交
963
        wi->func(wi->data);
964
        qemu_mutex_lock(&cpu->work_mutex);
C
Chegu Vinod 已提交
965 966
        if (wi->free) {
            g_free(wi);
967 968
        } else {
            atomic_mb_set(&wi->done, true);
C
Chegu Vinod 已提交
969
        }
M
Marcelo Tosatti 已提交
970
    }
971
    qemu_mutex_unlock(&cpu->work_mutex);
M
Marcelo Tosatti 已提交
972 973 974
    qemu_cond_broadcast(&qemu_work_cond);
}

975
static void qemu_wait_io_event_common(CPUState *cpu)
976
{
A
Andreas Färber 已提交
977 978
    if (cpu->stop) {
        cpu->stop = false;
979
        cpu->stopped = true;
980 981
        qemu_cond_signal(&qemu_pause_cond);
    }
982
    flush_queued_work(cpu);
983
    cpu->thread_kicked = false;
984 985
}

986
static void qemu_tcg_wait_io_event(CPUState *cpu)
987
{
988
    while (all_cpu_threads_idle()) {
989 990
       /* Start accounting real time to the virtual clock if the CPUs
          are idle.  */
991
        qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
992
        qemu_cond_wait(cpu->halt_cond, &qemu_global_mutex);
993
    }
994

995 996 997
    while (iothread_requesting_mutex) {
        qemu_cond_wait(&qemu_io_proceeded_cond, &qemu_global_mutex);
    }
998

A
Andreas Färber 已提交
999
    CPU_FOREACH(cpu) {
1000
        qemu_wait_io_event_common(cpu);
1001
    }
1002 1003
}

1004
static void qemu_kvm_wait_io_event(CPUState *cpu)
1005
{
1006
    while (cpu_thread_is_idle(cpu)) {
A
Andreas Färber 已提交
1007
        qemu_cond_wait(cpu->halt_cond, &qemu_global_mutex);
1008
    }
1009

1010
    qemu_kvm_eat_signals(cpu);
1011
    qemu_wait_io_event_common(cpu);
1012 1013
}

1014
static void *qemu_kvm_cpu_thread_fn(void *arg)
1015
{
1016
    CPUState *cpu = arg;
J
Jan Kiszka 已提交
1017
    int r;
1018

1019 1020
    rcu_register_thread();

1021
    qemu_mutex_lock_iothread();
1022
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
1023
    cpu->thread_id = qemu_get_thread_id();
1024
    cpu->can_do_io = 1;
1025
    current_cpu = cpu;
1026

1027
    r = kvm_init_vcpu(cpu);
J
Jan Kiszka 已提交
1028 1029 1030 1031
    if (r < 0) {
        fprintf(stderr, "kvm_init_vcpu failed: %s\n", strerror(-r));
        exit(1);
    }
1032

1033
    qemu_kvm_init_cpu_signals(cpu);
1034 1035

    /* signal CPU creation */
1036
    cpu->created = true;
1037 1038 1039
    qemu_cond_signal(&qemu_cpu_cond);

    while (1) {
1040
        if (cpu_can_run(cpu)) {
1041
            r = kvm_cpu_exec(cpu);
1042
            if (r == EXCP_DEBUG) {
1043
                cpu_handle_guest_debug(cpu);
1044
            }
1045
        }
1046
        qemu_kvm_wait_io_event(cpu);
1047 1048 1049 1050 1051
    }

    return NULL;
}

A
Anthony Liguori 已提交
1052 1053 1054 1055 1056 1057
static void *qemu_dummy_cpu_thread_fn(void *arg)
{
#ifdef _WIN32
    fprintf(stderr, "qtest is not supported under Windows\n");
    exit(1);
#else
1058
    CPUState *cpu = arg;
A
Anthony Liguori 已提交
1059 1060 1061
    sigset_t waitset;
    int r;

1062 1063
    rcu_register_thread();

A
Anthony Liguori 已提交
1064
    qemu_mutex_lock_iothread();
1065
    qemu_thread_get_self(cpu->thread);
A
Andreas Färber 已提交
1066
    cpu->thread_id = qemu_get_thread_id();
1067
    cpu->can_do_io = 1;
A
Anthony Liguori 已提交
1068 1069 1070 1071 1072

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

    /* signal CPU creation */
1073
    cpu->created = true;
A
Anthony Liguori 已提交
1074 1075
    qemu_cond_signal(&qemu_cpu_cond);

1076
    current_cpu = cpu;
A
Anthony Liguori 已提交
1077
    while (1) {
1078
        current_cpu = NULL;
A
Anthony Liguori 已提交
1079 1080 1081 1082 1083 1084 1085 1086 1087 1088
        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();
1089
        current_cpu = cpu;
1090
        qemu_wait_io_event_common(cpu);
A
Anthony Liguori 已提交
1091 1092 1093 1094 1095 1096
    }

    return NULL;
#endif
}

J
Jan Kiszka 已提交
1097 1098
static void tcg_exec_all(void);

1099
static void *qemu_tcg_cpu_thread_fn(void *arg)
1100
{
1101
    CPUState *cpu = arg;
1102

1103 1104
    rcu_register_thread();

1105
    qemu_mutex_lock_iothread();
1106
    qemu_thread_get_self(cpu->thread);
1107

1108 1109 1110
    CPU_FOREACH(cpu) {
        cpu->thread_id = qemu_get_thread_id();
        cpu->created = true;
1111
        cpu->can_do_io = 1;
1112
    }
1113 1114
    qemu_cond_signal(&qemu_cpu_cond);

1115
    /* wait for initial kick-off after machine start */
1116
    while (first_cpu->stopped) {
1117
        qemu_cond_wait(first_cpu->halt_cond, &qemu_global_mutex);
1118 1119

        /* process any pending work */
A
Andreas Färber 已提交
1120
        CPU_FOREACH(cpu) {
1121
            qemu_wait_io_event_common(cpu);
1122
        }
1123
    }
1124

1125
    /* process any pending work */
1126
    atomic_mb_set(&exit_request, 1);
1127

1128
    while (1) {
J
Jan Kiszka 已提交
1129
        tcg_exec_all();
1130 1131

        if (use_icount) {
1132
            int64_t deadline = qemu_clock_deadline_ns_all(QEMU_CLOCK_VIRTUAL);
1133 1134

            if (deadline == 0) {
1135
                qemu_clock_notify(QEMU_CLOCK_VIRTUAL);
1136
            }
1137
        }
1138
        qemu_tcg_wait_io_event(QTAILQ_FIRST(&cpus));
1139 1140 1141 1142 1143
    }

    return NULL;
}

1144
static void qemu_cpu_kick_thread(CPUState *cpu)
P
Paolo Bonzini 已提交
1145 1146 1147 1148
{
#ifndef _WIN32
    int err;

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

P
Paolo Bonzini 已提交
1163 1164 1165 1166 1167 1168 1169 1170 1171 1172
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 已提交
1173 1174 1175
    }
}

1176
void qemu_cpu_kick(CPUState *cpu)
1177
{
A
Andreas Färber 已提交
1178
    qemu_cond_broadcast(cpu->halt_cond);
P
Paolo Bonzini 已提交
1179 1180 1181 1182 1183
    if (tcg_enabled()) {
        qemu_cpu_kick_no_halt();
    } else {
        qemu_cpu_kick_thread(cpu);
    }
1184 1185
}

1186
void qemu_cpu_kick_self(void)
1187
{
1188
    assert(current_cpu);
1189
    qemu_cpu_kick_thread(current_cpu);
1190 1191
}

1192
bool qemu_cpu_is_self(CPUState *cpu)
1193
{
1194
    return qemu_thread_is_self(cpu->thread);
1195 1196
}

1197
bool qemu_in_vcpu_thread(void)
J
Juan Quintela 已提交
1198
{
1199
    return current_cpu && qemu_cpu_is_self(current_cpu);
J
Juan Quintela 已提交
1200 1201
}

1202 1203 1204 1205 1206 1207 1208
static __thread bool iothread_locked = false;

bool qemu_mutex_iothread_locked(void)
{
    return iothread_locked;
}

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

void qemu_mutex_unlock_iothread(void)
{
1232
    iothread_locked = false;
1233 1234 1235 1236 1237
    qemu_mutex_unlock(&qemu_global_mutex);
}

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

A
Andreas Färber 已提交
1240
    CPU_FOREACH(cpu) {
1241
        if (!cpu->stopped) {
1242
            return 0;
1243
        }
1244 1245 1246 1247 1248 1249 1250
    }

    return 1;
}

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

1253
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, false);
A
Andreas Färber 已提交
1254
    CPU_FOREACH(cpu) {
1255 1256
        cpu->stop = true;
        qemu_cpu_kick(cpu);
1257 1258
    }

J
Juan Quintela 已提交
1259
    if (qemu_in_vcpu_thread()) {
1260 1261
        cpu_stop_current();
        if (!kvm_enabled()) {
A
Andreas Färber 已提交
1262
            CPU_FOREACH(cpu) {
1263 1264
                cpu->stop = false;
                cpu->stopped = true;
1265 1266 1267 1268 1269
            }
            return;
        }
    }

1270
    while (!all_vcpus_paused()) {
1271
        qemu_cond_wait(&qemu_pause_cond, &qemu_global_mutex);
A
Andreas Färber 已提交
1272
        CPU_FOREACH(cpu) {
1273
            qemu_cpu_kick(cpu);
1274 1275 1276 1277
        }
    }
}

1278 1279 1280 1281 1282 1283 1284
void cpu_resume(CPUState *cpu)
{
    cpu->stop = false;
    cpu->stopped = false;
    qemu_cpu_kick(cpu);
}

1285 1286
void resume_all_vcpus(void)
{
A
Andreas Färber 已提交
1287
    CPUState *cpu;
1288

1289
    qemu_clock_enable(QEMU_CLOCK_VIRTUAL, true);
A
Andreas Färber 已提交
1290
    CPU_FOREACH(cpu) {
1291
        cpu_resume(cpu);
1292 1293 1294
    }
}

1295 1296 1297
/* For temporary buffers for forming a name */
#define VCPU_THREAD_NAME_SIZE 16

1298
static void qemu_tcg_init_vcpu(CPUState *cpu)
1299
{
1300
    char thread_name[VCPU_THREAD_NAME_SIZE];
1301 1302
    static QemuCond *tcg_halt_cond;
    static QemuThread *tcg_cpu_thread;
1303

1304 1305
    tcg_cpu_address_space_init(cpu, cpu->as);

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

1329
static void qemu_kvm_start_vcpu(CPUState *cpu)
1330
{
1331 1332
    char thread_name[VCPU_THREAD_NAME_SIZE];

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

1345
static void qemu_dummy_start_vcpu(CPUState *cpu)
A
Anthony Liguori 已提交
1346
{
1347 1348
    char thread_name[VCPU_THREAD_NAME_SIZE];

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

1361
void qemu_init_vcpu(CPUState *cpu)
1362
{
1363 1364
    cpu->nr_cores = smp_cores;
    cpu->nr_threads = smp_threads;
1365
    cpu->stopped = true;
1366
    if (kvm_enabled()) {
1367
        qemu_kvm_start_vcpu(cpu);
A
Anthony Liguori 已提交
1368
    } else if (tcg_enabled()) {
1369
        qemu_tcg_init_vcpu(cpu);
A
Anthony Liguori 已提交
1370
    } else {
1371
        qemu_dummy_start_vcpu(cpu);
1372
    }
1373 1374
}

1375
void cpu_stop_current(void)
1376
{
1377 1378 1379 1380
    if (current_cpu) {
        current_cpu->stop = false;
        current_cpu->stopped = true;
        cpu_exit(current_cpu);
1381
        qemu_cond_signal(&qemu_pause_cond);
1382
    }
1383 1384
}

1385
int vm_stop(RunState state)
1386
{
J
Juan Quintela 已提交
1387
    if (qemu_in_vcpu_thread()) {
1388
        qemu_system_vmstop_request_prepare();
1389
        qemu_system_vmstop_request(state);
1390 1391 1392 1393
        /*
         * FIXME: should not return to device code in case
         * vm_stop() has been requested.
         */
1394
        cpu_stop_current();
1395
        return 0;
1396
    }
1397 1398

    return do_vm_stop(state);
1399 1400
}

1401 1402
/* does a state transition even if the VM is already stopped,
   current state is forgotten forever */
1403
int vm_stop_force_state(RunState state)
1404 1405
{
    if (runstate_is_running()) {
1406
        return vm_stop(state);
1407 1408
    } else {
        runstate_set(state);
1409 1410 1411
        /* Make sure to return an error if the flush in a previous vm_stop()
         * failed. */
        return bdrv_flush_all();
1412 1413 1414
    }
}

1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436
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();
    }
}

1437
static int tcg_cpu_exec(CPUState *cpu)
1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449
{
    int ret;
#ifdef CONFIG_PROFILER
    int64_t ti;
#endif

#ifdef CONFIG_PROFILER
    ti = profile_getclock();
#endif
    if (use_icount) {
        int64_t count;
        int decr;
1450 1451
        timers_state.qemu_icount -= (cpu->icount_decr.u16.low
                                    + cpu->icount_extra);
1452
        cpu->icount_decr.u16.low = 0;
1453
        cpu->icount_extra = 0;
1454
        count = tcg_get_icount_limit();
1455
        timers_state.qemu_icount += count;
1456 1457
        decr = (count > 0xffff) ? 0xffff : count;
        count -= decr;
1458
        cpu->icount_decr.u16.low = decr;
1459
        cpu->icount_extra = count;
1460
    }
1461
    ret = cpu_exec(cpu);
1462
#ifdef CONFIG_PROFILER
1463
    tcg_time += profile_getclock() - ti;
1464 1465 1466 1467
#endif
    if (use_icount) {
        /* Fold pending instructions back into the
           instruction counter, and clear the interrupt flag.  */
1468 1469
        timers_state.qemu_icount -= (cpu->icount_decr.u16.low
                        + cpu->icount_extra);
1470
        cpu->icount_decr.u32 = 0;
1471
        cpu->icount_extra = 0;
1472
        replay_account_executed_instructions();
1473 1474 1475 1476
    }
    return ret;
}

J
Jan Kiszka 已提交
1477
static void tcg_exec_all(void)
1478
{
1479 1480
    int r;

1481 1482
    /* Account partial waits to QEMU_CLOCK_VIRTUAL.  */
    qemu_clock_warp(QEMU_CLOCK_VIRTUAL);
1483

1484
    if (next_cpu == NULL) {
1485
        next_cpu = first_cpu;
1486
    }
A
Andreas Färber 已提交
1487
    for (; next_cpu != NULL && !exit_request; next_cpu = CPU_NEXT(next_cpu)) {
1488
        CPUState *cpu = next_cpu;
1489

1490
        qemu_clock_enable(QEMU_CLOCK_VIRTUAL,
1491
                          (cpu->singlestep_enabled & SSTEP_NOTIMER) == 0);
1492

1493
        if (cpu_can_run(cpu)) {
1494
            r = tcg_cpu_exec(cpu);
1495
            if (r == EXCP_DEBUG) {
1496
                cpu_handle_guest_debug(cpu);
1497 1498
                break;
            }
1499
        } else if (cpu->stop || cpu->stopped) {
1500 1501 1502
            break;
        }
    }
1503 1504 1505

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

1508
void list_cpus(FILE *f, fprintf_function cpu_fprintf, const char *optarg)
1509 1510
{
    /* XXX: implement xxx_cpu_list for targets that still miss it */
P
Peter Maydell 已提交
1511 1512
#if defined(cpu_list)
    cpu_list(f, cpu_fprintf);
1513 1514
#endif
}
L
Luiz Capitulino 已提交
1515 1516 1517 1518

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

A
Andreas Färber 已提交
1521
    CPU_FOREACH(cpu) {
L
Luiz Capitulino 已提交
1522
        CpuInfoList *info;
1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534
#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;
1535 1536 1537
#elif defined(TARGET_TRICORE)
        TriCoreCPU *tricore_cpu = TRICORE_CPU(cpu);
        CPUTriCoreState *env = &tricore_cpu->env;
1538
#endif
L
Luiz Capitulino 已提交
1539

1540
        cpu_synchronize_state(cpu);
L
Luiz Capitulino 已提交
1541 1542 1543

        info = g_malloc0(sizeof(*info));
        info->value = g_malloc0(sizeof(*info->value));
1544
        info->value->CPU = cpu->cpu_index;
1545
        info->value->current = (cpu == first_cpu);
1546
        info->value->halted = cpu->halted;
1547
        info->value->qom_path = object_get_canonical_path(OBJECT(cpu));
A
Andreas Färber 已提交
1548
        info->value->thread_id = cpu->thread_id;
L
Luiz Capitulino 已提交
1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562
#if defined(TARGET_I386)
        info->value->has_pc = true;
        info->value->pc = env->eip + env->segs[R_CS].base;
#elif defined(TARGET_PPC)
        info->value->has_nip = true;
        info->value->nip = env->nip;
#elif defined(TARGET_SPARC)
        info->value->has_pc = true;
        info->value->pc = env->pc;
        info->value->has_npc = true;
        info->value->npc = env->npc;
#elif defined(TARGET_MIPS)
        info->value->has_PC = true;
        info->value->PC = env->active_tc.PC;
1563 1564 1565
#elif defined(TARGET_TRICORE)
        info->value->has_PC = true;
        info->value->PC = env->PC;
L
Luiz Capitulino 已提交
1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578
#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 已提交
1579 1580 1581 1582 1583 1584

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;
1585
    CPUState *cpu;
L
Luiz Capitulino 已提交
1586
    uint8_t buf[1024];
1587
    int64_t orig_addr = addr, orig_size = size;
L
Luiz Capitulino 已提交
1588 1589 1590 1591 1592

    if (!has_cpu) {
        cpu_index = 0;
    }

1593 1594
    cpu = qemu_get_cpu(cpu_index);
    if (cpu == NULL) {
1595 1596
        error_setg(errp, QERR_INVALID_PARAMETER_VALUE, "cpu-index",
                   "a CPU number");
L
Luiz Capitulino 已提交
1597 1598 1599 1600 1601
        return;
    }

    f = fopen(filename, "wb");
    if (!f) {
1602
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1603 1604 1605 1606 1607 1608 1609
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1610
        if (cpu_memory_rw_debug(cpu, addr, buf, l, 0) != 0) {
1611 1612
            error_setg(errp, "Invalid addr 0x%016" PRIx64 "/size %" PRId64
                             " specified", orig_addr, orig_size);
1613 1614
            goto exit;
        }
L
Luiz Capitulino 已提交
1615
        if (fwrite(buf, 1, l, f) != l) {
1616
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1617 1618 1619 1620 1621 1622 1623 1624 1625
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1626 1627 1628 1629 1630 1631 1632 1633 1634 1635

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) {
1636
        error_setg_file_open(errp, errno, filename);
L
Luiz Capitulino 已提交
1637 1638 1639 1640 1641 1642 1643
        return;
    }

    while (size != 0) {
        l = sizeof(buf);
        if (l > size)
            l = size;
1644
        cpu_physical_memory_read(addr, buf, l);
L
Luiz Capitulino 已提交
1645
        if (fwrite(buf, 1, l, f) != l) {
1646
            error_setg(errp, QERR_IO_ERROR);
L
Luiz Capitulino 已提交
1647 1648 1649 1650 1651 1652 1653 1654 1655
            goto exit;
        }
        addr += l;
        size -= l;
    }

exit:
    fclose(f);
}
L
Luiz Capitulino 已提交
1656 1657 1658 1659

void qmp_inject_nmi(Error **errp)
{
#if defined(TARGET_I386)
1660 1661
    CPUState *cs;

A
Andreas Färber 已提交
1662
    CPU_FOREACH(cs) {
1663
        X86CPU *cpu = X86_CPU(cs);
L
Luiz Capitulino 已提交
1664

1665
        if (!cpu->apic_state) {
1666
            cpu_interrupt(cs, CPU_INTERRUPT_NMI);
1667
        } else {
1668
            apic_deliver_nmi(cpu->apic_state);
1669
        }
L
Luiz Capitulino 已提交
1670 1671
    }
#else
1672
    nmi_monitor_handle(monitor_get_cpu_index(), errp);
L
Luiz Capitulino 已提交
1673 1674
#endif
}
1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691

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