Statistics
| Branch: | Revision:

root / cpus.c @ f2c1cc81

History | View | Annotate | Download (25 kB)

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

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

    
28
#include "monitor.h"
29
#include "sysemu.h"
30
#include "gdbstub.h"
31
#include "dma.h"
32
#include "kvm.h"
33
#include "exec-all.h"
34

    
35
#include "qemu-thread.h"
36
#include "cpus.h"
37
#include "compatfd.h"
38

    
39
#ifdef SIGRTMIN
40
#define SIG_IPI (SIGRTMIN+4)
41
#else
42
#define SIG_IPI SIGUSR1
43
#endif
44

    
45
#ifdef CONFIG_LINUX
46

    
47
#include <sys/prctl.h>
48

    
49
#ifndef PR_MCE_KILL
50
#define PR_MCE_KILL 33
51
#endif
52

    
53
#ifndef PR_MCE_KILL_SET
54
#define PR_MCE_KILL_SET 1
55
#endif
56

    
57
#ifndef PR_MCE_KILL_EARLY
58
#define PR_MCE_KILL_EARLY 1
59
#endif
60

    
61
#endif /* CONFIG_LINUX */
62

    
63
static CPUState *next_cpu;
64

    
65
/***********************************************************/
66
void hw_error(const char *fmt, ...)
67
{
68
    va_list ap;
69
    CPUState *env;
70

    
71
    va_start(ap, fmt);
72
    fprintf(stderr, "qemu: hardware error: ");
73
    vfprintf(stderr, fmt, ap);
74
    fprintf(stderr, "\n");
75
    for(env = first_cpu; env != NULL; env = env->next_cpu) {
76
        fprintf(stderr, "CPU #%d:\n", env->cpu_index);
77
#ifdef TARGET_I386
78
        cpu_dump_state(env, stderr, fprintf, X86_DUMP_FPU);
79
#else
80
        cpu_dump_state(env, stderr, fprintf, 0);
81
#endif
82
    }
83
    va_end(ap);
84
    abort();
85
}
86

    
87
void cpu_synchronize_all_states(void)
88
{
89
    CPUState *cpu;
90

    
91
    for (cpu = first_cpu; cpu; cpu = cpu->next_cpu) {
92
        cpu_synchronize_state(cpu);
93
    }
94
}
95

    
96
void cpu_synchronize_all_post_reset(void)
97
{
98
    CPUState *cpu;
99

    
100
    for (cpu = first_cpu; cpu; cpu = cpu->next_cpu) {
101
        cpu_synchronize_post_reset(cpu);
102
    }
103
}
104

    
105
void cpu_synchronize_all_post_init(void)
106
{
107
    CPUState *cpu;
108

    
109
    for (cpu = first_cpu; cpu; cpu = cpu->next_cpu) {
110
        cpu_synchronize_post_init(cpu);
111
    }
112
}
113

    
114
int cpu_is_stopped(CPUState *env)
115
{
116
    return !vm_running || env->stopped;
117
}
118

    
119
static void do_vm_stop(int reason)
120
{
121
    if (vm_running) {
122
        cpu_disable_ticks();
123
        vm_running = 0;
124
        pause_all_vcpus();
125
        vm_state_notify(0, reason);
126
        qemu_aio_flush();
127
        bdrv_flush_all();
128
        monitor_protocol_event(QEVENT_STOP, NULL);
129
    }
130
}
131

    
132
static int cpu_can_run(CPUState *env)
133
{
134
    if (env->stop) {
135
        return 0;
136
    }
137
    if (env->stopped || !vm_running) {
138
        return 0;
139
    }
140
    return 1;
141
}
142

    
143
static bool cpu_thread_is_idle(CPUState *env)
144
{
145
    if (env->stop || env->queued_work_first) {
146
        return false;
147
    }
148
    if (env->stopped || !vm_running) {
149
        return true;
150
    }
151
    if (!env->halted || qemu_cpu_has_work(env) ||
152
        (kvm_enabled() && kvm_irqchip_in_kernel())) {
153
        return false;
154
    }
155
    return true;
156
}
157

    
158
static bool all_cpu_threads_idle(void)
159
{
160
    CPUState *env;
161

    
162
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
163
        if (!cpu_thread_is_idle(env)) {
164
            return false;
165
        }
166
    }
167
    return true;
168
}
169

    
170
static void cpu_handle_guest_debug(CPUState *env)
171
{
172
    gdb_set_stop_cpu(env);
173
    qemu_system_debug_request();
174
#ifdef CONFIG_IOTHREAD
175
    env->stopped = 1;
176
#endif
177
}
178

    
179
#ifdef CONFIG_IOTHREAD
180
static void cpu_signal(int sig)
181
{
182
    if (cpu_single_env) {
183
        cpu_exit(cpu_single_env);
184
    }
185
    exit_request = 1;
186
}
187
#endif
188

    
189
#ifdef CONFIG_LINUX
190
static void sigbus_reraise(void)
191
{
192
    sigset_t set;
193
    struct sigaction action;
194

    
195
    memset(&action, 0, sizeof(action));
196
    action.sa_handler = SIG_DFL;
197
    if (!sigaction(SIGBUS, &action, NULL)) {
198
        raise(SIGBUS);
199
        sigemptyset(&set);
200
        sigaddset(&set, SIGBUS);
201
        sigprocmask(SIG_UNBLOCK, &set, NULL);
202
    }
203
    perror("Failed to re-raise SIGBUS!\n");
204
    abort();
205
}
206

    
207
static void sigbus_handler(int n, struct qemu_signalfd_siginfo *siginfo,
208
                           void *ctx)
209
{
210
    if (kvm_on_sigbus(siginfo->ssi_code,
211
                      (void *)(intptr_t)siginfo->ssi_addr)) {
212
        sigbus_reraise();
213
    }
214
}
215

    
216
static void qemu_init_sigbus(void)
217
{
218
    struct sigaction action;
219

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

    
225
    prctl(PR_MCE_KILL, PR_MCE_KILL_SET, PR_MCE_KILL_EARLY, 0, 0);
226
}
227

    
228
static void qemu_kvm_eat_signals(CPUState *env)
229
{
230
    struct timespec ts = { 0, 0 };
231
    siginfo_t siginfo;
232
    sigset_t waitset;
233
    sigset_t chkset;
234
    int r;
235

    
236
    sigemptyset(&waitset);
237
    sigaddset(&waitset, SIG_IPI);
238
    sigaddset(&waitset, SIGBUS);
239

    
240
    do {
241
        r = sigtimedwait(&waitset, &siginfo, &ts);
242
        if (r == -1 && !(errno == EAGAIN || errno == EINTR)) {
243
            perror("sigtimedwait");
244
            exit(1);
245
        }
246

    
247
        switch (r) {
248
        case SIGBUS:
249
            if (kvm_on_sigbus_vcpu(env, siginfo.si_code, siginfo.si_addr)) {
250
                sigbus_reraise();
251
            }
252
            break;
253
        default:
254
            break;
255
        }
256

    
257
        r = sigpending(&chkset);
258
        if (r == -1) {
259
            perror("sigpending");
260
            exit(1);
261
        }
262
    } while (sigismember(&chkset, SIG_IPI) || sigismember(&chkset, SIGBUS));
263

    
264
#ifndef CONFIG_IOTHREAD
265
    if (sigismember(&chkset, SIGIO) || sigismember(&chkset, SIGALRM)) {
266
        qemu_notify_event();
267
    }
268
#endif
269
}
270

    
271
#else /* !CONFIG_LINUX */
272

    
273
static void qemu_init_sigbus(void)
274
{
275
}
276

    
277
static void qemu_kvm_eat_signals(CPUState *env)
278
{
279
}
280
#endif /* !CONFIG_LINUX */
281

    
282
#ifndef _WIN32
283
static int io_thread_fd = -1;
284

    
285
static void qemu_event_increment(void)
286
{
287
    /* Write 8 bytes to be compatible with eventfd.  */
288
    static const uint64_t val = 1;
289
    ssize_t ret;
290

    
291
    if (io_thread_fd == -1) {
292
        return;
293
    }
294
    do {
295
        ret = write(io_thread_fd, &val, sizeof(val));
296
    } while (ret < 0 && errno == EINTR);
297

    
298
    /* EAGAIN is fine, a read must be pending.  */
299
    if (ret < 0 && errno != EAGAIN) {
300
        fprintf(stderr, "qemu_event_increment: write() filed: %s\n",
301
                strerror(errno));
302
        exit (1);
303
    }
304
}
305

    
306
static void qemu_event_read(void *opaque)
307
{
308
    int fd = (unsigned long)opaque;
309
    ssize_t len;
310
    char buffer[512];
311

    
312
    /* Drain the notify pipe.  For eventfd, only 8 bytes will be read.  */
313
    do {
314
        len = read(fd, buffer, sizeof(buffer));
315
    } while ((len == -1 && errno == EINTR) || len == sizeof(buffer));
316
}
317

    
318
static int qemu_event_init(void)
319
{
320
    int err;
321
    int fds[2];
322

    
323
    err = qemu_eventfd(fds);
324
    if (err == -1) {
325
        return -errno;
326
    }
327
    err = fcntl_setfl(fds[0], O_NONBLOCK);
328
    if (err < 0) {
329
        goto fail;
330
    }
331
    err = fcntl_setfl(fds[1], O_NONBLOCK);
332
    if (err < 0) {
333
        goto fail;
334
    }
335
    qemu_set_fd_handler2(fds[0], NULL, qemu_event_read, NULL,
336
                         (void *)(unsigned long)fds[0]);
337

    
338
    io_thread_fd = fds[1];
339
    return 0;
340

    
341
fail:
342
    close(fds[0]);
343
    close(fds[1]);
344
    return err;
345
}
346

    
347
static void dummy_signal(int sig)
348
{
349
}
350

    
351
/* If we have signalfd, we mask out the signals we want to handle and then
352
 * use signalfd to listen for them.  We rely on whatever the current signal
353
 * handler is to dispatch the signals when we receive them.
354
 */
355
static void sigfd_handler(void *opaque)
356
{
357
    int fd = (unsigned long) opaque;
358
    struct qemu_signalfd_siginfo info;
359
    struct sigaction action;
360
    ssize_t len;
361

    
362
    while (1) {
363
        do {
364
            len = read(fd, &info, sizeof(info));
365
        } while (len == -1 && errno == EINTR);
366

    
367
        if (len == -1 && errno == EAGAIN) {
368
            break;
369
        }
370

    
371
        if (len != sizeof(info)) {
372
            printf("read from sigfd returned %zd: %m\n", len);
373
            return;
374
        }
375

    
376
        sigaction(info.ssi_signo, NULL, &action);
377
        if ((action.sa_flags & SA_SIGINFO) && action.sa_sigaction) {
378
            action.sa_sigaction(info.ssi_signo,
379
                                (siginfo_t *)&info, NULL);
380
        } else if (action.sa_handler) {
381
            action.sa_handler(info.ssi_signo);
382
        }
383
    }
384
}
385

    
386
static int qemu_signal_init(void)
387
{
388
    int sigfd;
389
    sigset_t set;
390

    
391
#ifdef CONFIG_IOTHREAD
392
    /* SIGUSR2 used by posix-aio-compat.c */
393
    sigemptyset(&set);
394
    sigaddset(&set, SIGUSR2);
395
    pthread_sigmask(SIG_UNBLOCK, &set, NULL);
396

    
397
    sigemptyset(&set);
398
    sigaddset(&set, SIGIO);
399
    sigaddset(&set, SIGALRM);
400
    sigaddset(&set, SIG_IPI);
401
    sigaddset(&set, SIGBUS);
402
    pthread_sigmask(SIG_BLOCK, &set, NULL);
403
#else
404
    sigemptyset(&set);
405
    sigaddset(&set, SIGBUS);
406
    if (kvm_enabled()) {
407
        /*
408
         * We need to process timer signals synchronously to avoid a race
409
         * between exit_request check and KVM vcpu entry.
410
         */
411
        sigaddset(&set, SIGIO);
412
        sigaddset(&set, SIGALRM);
413
    }
414
#endif
415

    
416
    sigfd = qemu_signalfd(&set);
417
    if (sigfd == -1) {
418
        fprintf(stderr, "failed to create signalfd\n");
419
        return -errno;
420
    }
421

    
422
    fcntl_setfl(sigfd, O_NONBLOCK);
423

    
424
    qemu_set_fd_handler2(sigfd, NULL, sigfd_handler, NULL,
425
                         (void *)(unsigned long) sigfd);
426

    
427
    return 0;
428
}
429

    
430
static void qemu_kvm_init_cpu_signals(CPUState *env)
431
{
432
    int r;
433
    sigset_t set;
434
    struct sigaction sigact;
435

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

    
440
#ifdef CONFIG_IOTHREAD
441
    pthread_sigmask(SIG_BLOCK, NULL, &set);
442
    sigdelset(&set, SIG_IPI);
443
    sigdelset(&set, SIGBUS);
444
    r = kvm_set_signal_mask(env, &set);
445
    if (r) {
446
        fprintf(stderr, "kvm_set_signal_mask: %s\n", strerror(-r));
447
        exit(1);
448
    }
449
#else
450
    sigemptyset(&set);
451
    sigaddset(&set, SIG_IPI);
452
    sigaddset(&set, SIGIO);
453
    sigaddset(&set, SIGALRM);
454
    pthread_sigmask(SIG_BLOCK, &set, NULL);
455

    
456
    pthread_sigmask(SIG_BLOCK, NULL, &set);
457
    sigdelset(&set, SIGIO);
458
    sigdelset(&set, SIGALRM);
459
#endif
460
    sigdelset(&set, SIG_IPI);
461
    sigdelset(&set, SIGBUS);
462
    r = kvm_set_signal_mask(env, &set);
463
    if (r) {
464
        fprintf(stderr, "kvm_set_signal_mask: %s\n", strerror(-r));
465
        exit(1);
466
    }
467
}
468

    
469
static void qemu_tcg_init_cpu_signals(void)
470
{
471
#ifdef CONFIG_IOTHREAD
472
    sigset_t set;
473
    struct sigaction sigact;
474

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

    
479
    sigemptyset(&set);
480
    sigaddset(&set, SIG_IPI);
481
    pthread_sigmask(SIG_UNBLOCK, &set, NULL);
482
#endif
483
}
484

    
485
#else /* _WIN32 */
486

    
487
HANDLE qemu_event_handle;
488

    
489
static void dummy_event_handler(void *opaque)
490
{
491
}
492

    
493
static int qemu_event_init(void)
494
{
495
    qemu_event_handle = CreateEvent(NULL, FALSE, FALSE, NULL);
496
    if (!qemu_event_handle) {
497
        fprintf(stderr, "Failed CreateEvent: %ld\n", GetLastError());
498
        return -1;
499
    }
500
    qemu_add_wait_object(qemu_event_handle, dummy_event_handler, NULL);
501
    return 0;
502
}
503

    
504
static void qemu_event_increment(void)
505
{
506
    if (!SetEvent(qemu_event_handle)) {
507
        fprintf(stderr, "qemu_event_increment: SetEvent failed: %ld\n",
508
                GetLastError());
509
        exit (1);
510
    }
511
}
512

    
513
static int qemu_signal_init(void)
514
{
515
    return 0;
516
}
517

    
518
static void qemu_kvm_init_cpu_signals(CPUState *env)
519
{
520
    abort();
521
}
522

    
523
static void qemu_tcg_init_cpu_signals(void)
524
{
525
}
526
#endif /* _WIN32 */
527

    
528
#ifndef CONFIG_IOTHREAD
529
int qemu_init_main_loop(void)
530
{
531
    int ret;
532

    
533
    ret = qemu_signal_init();
534
    if (ret) {
535
        return ret;
536
    }
537

    
538
    qemu_init_sigbus();
539

    
540
    return qemu_event_init();
541
}
542

    
543
void qemu_main_loop_start(void)
544
{
545
}
546

    
547
void qemu_init_vcpu(void *_env)
548
{
549
    CPUState *env = _env;
550
    int r;
551

    
552
    env->nr_cores = smp_cores;
553
    env->nr_threads = smp_threads;
554

    
555
    if (kvm_enabled()) {
556
        r = kvm_init_vcpu(env);
557
        if (r < 0) {
558
            fprintf(stderr, "kvm_init_vcpu failed: %s\n", strerror(-r));
559
            exit(1);
560
        }
561
        qemu_kvm_init_cpu_signals(env);
562
    } else {
563
        qemu_tcg_init_cpu_signals();
564
    }
565
}
566

    
567
int qemu_cpu_is_self(void *env)
568
{
569
    return 1;
570
}
571

    
572
void run_on_cpu(CPUState *env, void (*func)(void *data), void *data)
573
{
574
    func(data);
575
}
576

    
577
void resume_all_vcpus(void)
578
{
579
}
580

    
581
void pause_all_vcpus(void)
582
{
583
}
584

    
585
void qemu_cpu_kick(void *env)
586
{
587
}
588

    
589
void qemu_cpu_kick_self(void)
590
{
591
#ifndef _WIN32
592
    assert(cpu_single_env);
593

    
594
    raise(SIG_IPI);
595
#else
596
    abort();
597
#endif
598
}
599

    
600
void qemu_notify_event(void)
601
{
602
    CPUState *env = cpu_single_env;
603

    
604
    qemu_event_increment ();
605
    if (env) {
606
        cpu_exit(env);
607
    }
608
    if (next_cpu && env != next_cpu) {
609
        cpu_exit(next_cpu);
610
    }
611
    exit_request = 1;
612
}
613

    
614
void qemu_mutex_lock_iothread(void) {}
615
void qemu_mutex_unlock_iothread(void) {}
616

    
617
void cpu_stop_current(void)
618
{
619
}
620

    
621
void vm_stop(int reason)
622
{
623
    do_vm_stop(reason);
624
}
625

    
626
#else /* CONFIG_IOTHREAD */
627

    
628
QemuMutex qemu_global_mutex;
629
static QemuMutex qemu_fair_mutex;
630

    
631
static QemuThread io_thread;
632

    
633
static QemuThread *tcg_cpu_thread;
634
static QemuCond *tcg_halt_cond;
635

    
636
static int qemu_system_ready;
637
/* cpu creation */
638
static QemuCond qemu_cpu_cond;
639
/* system init */
640
static QemuCond qemu_system_cond;
641
static QemuCond qemu_pause_cond;
642
static QemuCond qemu_work_cond;
643

    
644
int qemu_init_main_loop(void)
645
{
646
    int ret;
647

    
648
    qemu_init_sigbus();
649

    
650
    ret = qemu_signal_init();
651
    if (ret) {
652
        return ret;
653
    }
654

    
655
    /* Note eventfd must be drained before signalfd handlers run */
656
    ret = qemu_event_init();
657
    if (ret) {
658
        return ret;
659
    }
660

    
661
    qemu_cond_init(&qemu_cpu_cond);
662
    qemu_cond_init(&qemu_system_cond);
663
    qemu_cond_init(&qemu_pause_cond);
664
    qemu_cond_init(&qemu_work_cond);
665
    qemu_mutex_init(&qemu_fair_mutex);
666
    qemu_mutex_init(&qemu_global_mutex);
667
    qemu_mutex_lock(&qemu_global_mutex);
668

    
669
    qemu_thread_get_self(&io_thread);
670

    
671
    return 0;
672
}
673

    
674
void qemu_main_loop_start(void)
675
{
676
    qemu_system_ready = 1;
677
    qemu_cond_broadcast(&qemu_system_cond);
678
}
679

    
680
void run_on_cpu(CPUState *env, void (*func)(void *data), void *data)
681
{
682
    struct qemu_work_item wi;
683

    
684
    if (qemu_cpu_is_self(env)) {
685
        func(data);
686
        return;
687
    }
688

    
689
    wi.func = func;
690
    wi.data = data;
691
    if (!env->queued_work_first) {
692
        env->queued_work_first = &wi;
693
    } else {
694
        env->queued_work_last->next = &wi;
695
    }
696
    env->queued_work_last = &wi;
697
    wi.next = NULL;
698
    wi.done = false;
699

    
700
    qemu_cpu_kick(env);
701
    while (!wi.done) {
702
        CPUState *self_env = cpu_single_env;
703

    
704
        qemu_cond_wait(&qemu_work_cond, &qemu_global_mutex);
705
        cpu_single_env = self_env;
706
    }
707
}
708

    
709
static void flush_queued_work(CPUState *env)
710
{
711
    struct qemu_work_item *wi;
712

    
713
    if (!env->queued_work_first) {
714
        return;
715
    }
716

    
717
    while ((wi = env->queued_work_first)) {
718
        env->queued_work_first = wi->next;
719
        wi->func(wi->data);
720
        wi->done = true;
721
    }
722
    env->queued_work_last = NULL;
723
    qemu_cond_broadcast(&qemu_work_cond);
724
}
725

    
726
static void qemu_wait_io_event_common(CPUState *env)
727
{
728
    if (env->stop) {
729
        env->stop = 0;
730
        env->stopped = 1;
731
        qemu_cond_signal(&qemu_pause_cond);
732
    }
733
    flush_queued_work(env);
734
    env->thread_kicked = false;
735
}
736

    
737
static void qemu_tcg_wait_io_event(void)
738
{
739
    CPUState *env;
740

    
741
    while (all_cpu_threads_idle()) {
742
        qemu_cond_wait(tcg_halt_cond, &qemu_global_mutex);
743
    }
744

    
745
    qemu_mutex_unlock(&qemu_global_mutex);
746

    
747
    /*
748
     * Users of qemu_global_mutex can be starved, having no chance
749
     * to acquire it since this path will get to it first.
750
     * So use another lock to provide fairness.
751
     */
752
    qemu_mutex_lock(&qemu_fair_mutex);
753
    qemu_mutex_unlock(&qemu_fair_mutex);
754

    
755
    qemu_mutex_lock(&qemu_global_mutex);
756

    
757
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
758
        qemu_wait_io_event_common(env);
759
    }
760
}
761

    
762
static void qemu_kvm_wait_io_event(CPUState *env)
763
{
764
    while (cpu_thread_is_idle(env)) {
765
        qemu_cond_wait(env->halt_cond, &qemu_global_mutex);
766
    }
767

    
768
    qemu_kvm_eat_signals(env);
769
    qemu_wait_io_event_common(env);
770
}
771

    
772
static void *qemu_kvm_cpu_thread_fn(void *arg)
773
{
774
    CPUState *env = arg;
775
    int r;
776

    
777
    qemu_mutex_lock(&qemu_global_mutex);
778
    qemu_thread_get_self(env->thread);
779

    
780
    r = kvm_init_vcpu(env);
781
    if (r < 0) {
782
        fprintf(stderr, "kvm_init_vcpu failed: %s\n", strerror(-r));
783
        exit(1);
784
    }
785

    
786
    qemu_kvm_init_cpu_signals(env);
787

    
788
    /* signal CPU creation */
789
    env->created = 1;
790
    qemu_cond_signal(&qemu_cpu_cond);
791

    
792
    /* and wait for machine initialization */
793
    while (!qemu_system_ready) {
794
        qemu_cond_wait(&qemu_system_cond, &qemu_global_mutex);
795
    }
796

    
797
    while (1) {
798
        if (cpu_can_run(env)) {
799
            r = kvm_cpu_exec(env);
800
            if (r == EXCP_DEBUG) {
801
                cpu_handle_guest_debug(env);
802
            }
803
        }
804
        qemu_kvm_wait_io_event(env);
805
    }
806

    
807
    return NULL;
808
}
809

    
810
static void *qemu_tcg_cpu_thread_fn(void *arg)
811
{
812
    CPUState *env = arg;
813

    
814
    qemu_tcg_init_cpu_signals();
815
    qemu_thread_get_self(env->thread);
816

    
817
    /* signal CPU creation */
818
    qemu_mutex_lock(&qemu_global_mutex);
819
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
820
        env->created = 1;
821
    }
822
    qemu_cond_signal(&qemu_cpu_cond);
823

    
824
    /* and wait for machine initialization */
825
    while (!qemu_system_ready) {
826
        qemu_cond_wait(&qemu_system_cond, &qemu_global_mutex);
827
    }
828

    
829
    while (1) {
830
        cpu_exec_all();
831
        qemu_tcg_wait_io_event();
832
    }
833

    
834
    return NULL;
835
}
836

    
837
static void qemu_cpu_kick_thread(CPUState *env)
838
{
839
#ifndef _WIN32
840
    int err;
841

    
842
    err = pthread_kill(env->thread->thread, SIG_IPI);
843
    if (err) {
844
        fprintf(stderr, "qemu:%s: %s", __func__, strerror(err));
845
        exit(1);
846
    }
847
#else /* _WIN32 */
848
    if (!qemu_cpu_is_self(env)) {
849
        SuspendThread(env->thread->thread);
850
        cpu_signal(0);
851
        ResumeThread(env->thread->thread);
852
    }
853
#endif
854
}
855

    
856
void qemu_cpu_kick(void *_env)
857
{
858
    CPUState *env = _env;
859

    
860
    qemu_cond_broadcast(env->halt_cond);
861
    if (!env->thread_kicked) {
862
        qemu_cpu_kick_thread(env);
863
        env->thread_kicked = true;
864
    }
865
}
866

    
867
void qemu_cpu_kick_self(void)
868
{
869
#ifndef _WIN32
870
    assert(cpu_single_env);
871

    
872
    if (!cpu_single_env->thread_kicked) {
873
        qemu_cpu_kick_thread(cpu_single_env);
874
        cpu_single_env->thread_kicked = true;
875
    }
876
#else
877
    abort();
878
#endif
879
}
880

    
881
int qemu_cpu_is_self(void *_env)
882
{
883
    CPUState *env = _env;
884

    
885
    return qemu_thread_is_self(env->thread);
886
}
887

    
888
void qemu_mutex_lock_iothread(void)
889
{
890
    if (kvm_enabled()) {
891
        qemu_mutex_lock(&qemu_global_mutex);
892
    } else {
893
        qemu_mutex_lock(&qemu_fair_mutex);
894
        if (qemu_mutex_trylock(&qemu_global_mutex)) {
895
            qemu_cpu_kick_thread(first_cpu);
896
            qemu_mutex_lock(&qemu_global_mutex);
897
        }
898
        qemu_mutex_unlock(&qemu_fair_mutex);
899
    }
900
}
901

    
902
void qemu_mutex_unlock_iothread(void)
903
{
904
    qemu_mutex_unlock(&qemu_global_mutex);
905
}
906

    
907
static int all_vcpus_paused(void)
908
{
909
    CPUState *penv = first_cpu;
910

    
911
    while (penv) {
912
        if (!penv->stopped) {
913
            return 0;
914
        }
915
        penv = (CPUState *)penv->next_cpu;
916
    }
917

    
918
    return 1;
919
}
920

    
921
void pause_all_vcpus(void)
922
{
923
    CPUState *penv = first_cpu;
924

    
925
    while (penv) {
926
        penv->stop = 1;
927
        qemu_cpu_kick(penv);
928
        penv = (CPUState *)penv->next_cpu;
929
    }
930

    
931
    while (!all_vcpus_paused()) {
932
        qemu_cond_wait(&qemu_pause_cond, &qemu_global_mutex);
933
        penv = first_cpu;
934
        while (penv) {
935
            qemu_cpu_kick(penv);
936
            penv = (CPUState *)penv->next_cpu;
937
        }
938
    }
939
}
940

    
941
void resume_all_vcpus(void)
942
{
943
    CPUState *penv = first_cpu;
944

    
945
    while (penv) {
946
        penv->stop = 0;
947
        penv->stopped = 0;
948
        qemu_cpu_kick(penv);
949
        penv = (CPUState *)penv->next_cpu;
950
    }
951
}
952

    
953
static void qemu_tcg_init_vcpu(void *_env)
954
{
955
    CPUState *env = _env;
956

    
957
    /* share a single thread for all cpus with TCG */
958
    if (!tcg_cpu_thread) {
959
        env->thread = qemu_mallocz(sizeof(QemuThread));
960
        env->halt_cond = qemu_mallocz(sizeof(QemuCond));
961
        qemu_cond_init(env->halt_cond);
962
        qemu_thread_create(env->thread, qemu_tcg_cpu_thread_fn, env);
963
        while (env->created == 0) {
964
            qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
965
        }
966
        tcg_cpu_thread = env->thread;
967
        tcg_halt_cond = env->halt_cond;
968
    } else {
969
        env->thread = tcg_cpu_thread;
970
        env->halt_cond = tcg_halt_cond;
971
    }
972
}
973

    
974
static void qemu_kvm_start_vcpu(CPUState *env)
975
{
976
    env->thread = qemu_mallocz(sizeof(QemuThread));
977
    env->halt_cond = qemu_mallocz(sizeof(QemuCond));
978
    qemu_cond_init(env->halt_cond);
979
    qemu_thread_create(env->thread, qemu_kvm_cpu_thread_fn, env);
980
    while (env->created == 0) {
981
        qemu_cond_wait(&qemu_cpu_cond, &qemu_global_mutex);
982
    }
983
}
984

    
985
void qemu_init_vcpu(void *_env)
986
{
987
    CPUState *env = _env;
988

    
989
    env->nr_cores = smp_cores;
990
    env->nr_threads = smp_threads;
991
    if (kvm_enabled()) {
992
        qemu_kvm_start_vcpu(env);
993
    } else {
994
        qemu_tcg_init_vcpu(env);
995
    }
996
}
997

    
998
void qemu_notify_event(void)
999
{
1000
    qemu_event_increment();
1001
}
1002

    
1003
void cpu_stop_current(void)
1004
{
1005
    if (cpu_single_env) {
1006
        cpu_single_env->stop = 0;
1007
        cpu_single_env->stopped = 1;
1008
        cpu_exit(cpu_single_env);
1009
        qemu_cond_signal(&qemu_pause_cond);
1010
    }
1011
}
1012

    
1013
void vm_stop(int reason)
1014
{
1015
    if (!qemu_thread_is_self(&io_thread)) {
1016
        qemu_system_vmstop_request(reason);
1017
        /*
1018
         * FIXME: should not return to device code in case
1019
         * vm_stop() has been requested.
1020
         */
1021
        cpu_stop_current();
1022
        return;
1023
    }
1024
    do_vm_stop(reason);
1025
}
1026

    
1027
#endif
1028

    
1029
static int tcg_cpu_exec(CPUState *env)
1030
{
1031
    int ret;
1032
#ifdef CONFIG_PROFILER
1033
    int64_t ti;
1034
#endif
1035

    
1036
#ifdef CONFIG_PROFILER
1037
    ti = profile_getclock();
1038
#endif
1039
    if (use_icount) {
1040
        int64_t count;
1041
        int decr;
1042
        qemu_icount -= (env->icount_decr.u16.low + env->icount_extra);
1043
        env->icount_decr.u16.low = 0;
1044
        env->icount_extra = 0;
1045
        count = qemu_icount_round (qemu_next_deadline());
1046
        qemu_icount += count;
1047
        decr = (count > 0xffff) ? 0xffff : count;
1048
        count -= decr;
1049
        env->icount_decr.u16.low = decr;
1050
        env->icount_extra = count;
1051
    }
1052
    ret = cpu_exec(env);
1053
#ifdef CONFIG_PROFILER
1054
    qemu_time += profile_getclock() - ti;
1055
#endif
1056
    if (use_icount) {
1057
        /* Fold pending instructions back into the
1058
           instruction counter, and clear the interrupt flag.  */
1059
        qemu_icount -= (env->icount_decr.u16.low
1060
                        + env->icount_extra);
1061
        env->icount_decr.u32 = 0;
1062
        env->icount_extra = 0;
1063
    }
1064
    return ret;
1065
}
1066

    
1067
bool cpu_exec_all(void)
1068
{
1069
    int r;
1070

    
1071
    if (next_cpu == NULL) {
1072
        next_cpu = first_cpu;
1073
    }
1074
    for (; next_cpu != NULL && !exit_request; next_cpu = next_cpu->next_cpu) {
1075
        CPUState *env = next_cpu;
1076

    
1077
        qemu_clock_enable(vm_clock,
1078
                          (env->singlestep_enabled & SSTEP_NOTIMER) == 0);
1079

    
1080
#ifndef CONFIG_IOTHREAD
1081
        if (qemu_alarm_pending()) {
1082
            break;
1083
        }
1084
#endif
1085
        if (cpu_can_run(env)) {
1086
            if (kvm_enabled()) {
1087
                r = kvm_cpu_exec(env);
1088
                qemu_kvm_eat_signals(env);
1089
            } else {
1090
                r = tcg_cpu_exec(env);
1091
            }
1092
            if (r == EXCP_DEBUG) {
1093
                cpu_handle_guest_debug(env);
1094
                break;
1095
            }
1096
        } else if (env->stop || env->stopped) {
1097
            break;
1098
        }
1099
    }
1100
    exit_request = 0;
1101
    return !all_cpu_threads_idle();
1102
}
1103

    
1104
void set_numa_modes(void)
1105
{
1106
    CPUState *env;
1107
    int i;
1108

    
1109
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1110
        for (i = 0; i < nb_numa_nodes; i++) {
1111
            if (node_cpumask[i] & (1 << env->cpu_index)) {
1112
                env->numa_node = i;
1113
            }
1114
        }
1115
    }
1116
}
1117

    
1118
void set_cpu_log(const char *optarg)
1119
{
1120
    int mask;
1121
    const CPULogItem *item;
1122

    
1123
    mask = cpu_str_to_log_mask(optarg);
1124
    if (!mask) {
1125
        printf("Log items (comma separated):\n");
1126
        for (item = cpu_log_items; item->mask != 0; item++) {
1127
            printf("%-10s %s\n", item->name, item->help);
1128
        }
1129
        exit(1);
1130
    }
1131
    cpu_set_log(mask);
1132
}
1133

    
1134
/* Return the virtual CPU time, based on the instruction counter.  */
1135
int64_t cpu_get_icount(void)
1136
{
1137
    int64_t icount;
1138
    CPUState *env = cpu_single_env;;
1139

    
1140
    icount = qemu_icount;
1141
    if (env) {
1142
        if (!can_do_io(env)) {
1143
            fprintf(stderr, "Bad clock read\n");
1144
        }
1145
        icount -= (env->icount_decr.u16.low + env->icount_extra);
1146
    }
1147
    return qemu_icount_bias + (icount << icount_time_shift);
1148
}
1149

    
1150
void list_cpus(FILE *f, fprintf_function cpu_fprintf, const char *optarg)
1151
{
1152
    /* XXX: implement xxx_cpu_list for targets that still miss it */
1153
#if defined(cpu_list_id)
1154
    cpu_list_id(f, cpu_fprintf, optarg);
1155
#elif defined(cpu_list)
1156
    cpu_list(f, cpu_fprintf); /* deprecated */
1157
#endif
1158
}