kvm.c 41.3 KB
Newer Older
A
Alexander Graf 已提交
1 2 3 4
/*
 * QEMU S390x KVM implementation
 *
 * Copyright (c) 2009 Alexander Graf <agraf@suse.de>
5
 * Copyright IBM Corp. 2012
A
Alexander Graf 已提交
6 7 8 9 10 11 12 13 14 15 16
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
17 18 19 20
 * Contributions after 2012-10-29 are licensed under the terms of the
 * GNU GPL, version 2 or (at your option) any later version.
 *
 * You should have received a copy of the GNU (Lesser) General Public
A
Alexander Graf 已提交
21 22 23 24 25 26 27 28 29 30 31
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
 */

#include <sys/types.h>
#include <sys/ioctl.h>
#include <sys/mman.h>

#include <linux/kvm.h>
#include <asm/ptrace.h>

#include "qemu-common.h"
32
#include "qemu/timer.h"
33 34
#include "sysemu/sysemu.h"
#include "sysemu/kvm.h"
35
#include "hw/hw.h"
A
Alexander Graf 已提交
36
#include "cpu.h"
37
#include "sysemu/device_tree.h"
38 39
#include "qapi/qmp/qjson.h"
#include "monitor/monitor.h"
40
#include "exec/gdbstub.h"
41
#include "trace.h"
W
Wenchao Xia 已提交
42
#include "qapi-event.h"
43
#include "hw/s390x/s390-pci-inst.h"
A
Alexander Graf 已提交
44 45 46 47

/* #define DEBUG_KVM */

#ifdef DEBUG_KVM
48
#define DPRINTF(fmt, ...) \
A
Alexander Graf 已提交
49 50
    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
#else
51
#define DPRINTF(fmt, ...) \
A
Alexander Graf 已提交
52 53 54 55 56
    do { } while (0)
#endif

#define IPA0_DIAG                       0x8300
#define IPA0_SIGP                       0xae00
57 58 59
#define IPA0_B2                         0xb200
#define IPA0_B9                         0xb900
#define IPA0_EB                         0xeb00
60
#define IPA0_E3                         0xe300
A
Alexander Graf 已提交
61

62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80
#define PRIV_B2_SCLP_CALL               0x20
#define PRIV_B2_CSCH                    0x30
#define PRIV_B2_HSCH                    0x31
#define PRIV_B2_MSCH                    0x32
#define PRIV_B2_SSCH                    0x33
#define PRIV_B2_STSCH                   0x34
#define PRIV_B2_TSCH                    0x35
#define PRIV_B2_TPI                     0x36
#define PRIV_B2_SAL                     0x37
#define PRIV_B2_RSCH                    0x38
#define PRIV_B2_STCRW                   0x39
#define PRIV_B2_STCPS                   0x3a
#define PRIV_B2_RCHP                    0x3b
#define PRIV_B2_SCHM                    0x3c
#define PRIV_B2_CHSC                    0x5f
#define PRIV_B2_SIGA                    0x74
#define PRIV_B2_XSCH                    0x76

#define PRIV_EB_SQBS                    0x8a
81 82
#define PRIV_EB_PCISTB                  0xd0
#define PRIV_EB_SIC                     0xd1
83 84

#define PRIV_B9_EQBS                    0x9c
85 86 87 88 89 90 91
#define PRIV_B9_CLP                     0xa0
#define PRIV_B9_PCISTG                  0xd0
#define PRIV_B9_PCILG                   0xd2
#define PRIV_B9_RPCIT                   0xd3

#define PRIV_E3_MPCIFC                  0xd0
#define PRIV_E3_STPCIFC                 0xd4
92

93
#define DIAG_IPL                        0x308
A
Alexander Graf 已提交
94 95 96 97
#define DIAG_KVM_HYPERCALL              0x500
#define DIAG_KVM_BREAKPOINT             0x501

#define ICPT_INSTRUCTION                0x04
98
#define ICPT_PROGRAM                    0x08
99
#define ICPT_EXT_INT                    0x14
A
Alexander Graf 已提交
100 101 102 103 104
#define ICPT_WAITPSW                    0x1c
#define ICPT_SOFT_INTERCEPT             0x24
#define ICPT_CPU_STOP                   0x28
#define ICPT_IO                         0x40

105 106 107 108 109 110 111 112
static CPUWatchpoint hw_watchpoint;
/*
 * We don't use a list because this structure is also used to transmit the
 * hardware breakpoints to the kernel.
 */
static struct kvm_hw_breakpoint *hw_breakpoints;
static int nb_hw_breakpoints;

113 114 115 116
const KVMCapabilityInfo kvm_arch_required_capabilities[] = {
    KVM_CAP_LAST_INFO
};

117
static int cap_sync_regs;
118
static int cap_async_pf;
119

120
static void *legacy_s390_alloc(size_t size, uint64_t *align);
121

122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173
static int kvm_s390_check_clear_cmma(KVMState *s)
{
    struct kvm_device_attr attr = {
        .group = KVM_S390_VM_MEM_CTRL,
        .attr = KVM_S390_VM_MEM_CLR_CMMA,
    };

    return kvm_vm_ioctl(s, KVM_HAS_DEVICE_ATTR, &attr);
}

static int kvm_s390_check_enable_cmma(KVMState *s)
{
    struct kvm_device_attr attr = {
        .group = KVM_S390_VM_MEM_CTRL,
        .attr = KVM_S390_VM_MEM_ENABLE_CMMA,
    };

    return kvm_vm_ioctl(s, KVM_HAS_DEVICE_ATTR, &attr);
}

void kvm_s390_clear_cmma_callback(void *opaque)
{
    int rc;
    KVMState *s = opaque;
    struct kvm_device_attr attr = {
        .group = KVM_S390_VM_MEM_CTRL,
        .attr = KVM_S390_VM_MEM_CLR_CMMA,
    };

    rc = kvm_vm_ioctl(s, KVM_SET_DEVICE_ATTR, &attr);
    trace_kvm_clear_cmma(rc);
}

static void kvm_s390_enable_cmma(KVMState *s)
{
    int rc;
    struct kvm_device_attr attr = {
        .group = KVM_S390_VM_MEM_CTRL,
        .attr = KVM_S390_VM_MEM_ENABLE_CMMA,
    };

    if (kvm_s390_check_enable_cmma(s) || kvm_s390_check_clear_cmma(s)) {
        return;
    }

    rc = kvm_vm_ioctl(s, KVM_SET_DEVICE_ATTR, &attr);
    if (!rc) {
        qemu_register_reset(kvm_s390_clear_cmma_callback, s);
    }
    trace_kvm_enable_cmma(rc);
}

174
int kvm_arch_init(KVMState *s)
A
Alexander Graf 已提交
175
{
176
    cap_sync_regs = kvm_check_extension(s, KVM_CAP_SYNC_REGS);
177
    cap_async_pf = kvm_check_extension(s, KVM_CAP_ASYNC_PF);
178 179 180 181 182

    if (kvm_check_extension(s, KVM_CAP_VM_ATTRIBUTES)) {
        kvm_s390_enable_cmma(s);
    }

183 184 185 186
    if (!kvm_check_extension(s, KVM_CAP_S390_GMAP)
        || !kvm_check_extension(s, KVM_CAP_S390_COW)) {
        phys_mem_set_alloc(legacy_s390_alloc);
    }
A
Alexander Graf 已提交
187 188 189
    return 0;
}

190 191 192 193 194
unsigned long kvm_arch_vcpu_id(CPUState *cpu)
{
    return cpu->cpu_index;
}

195
int kvm_arch_init_vcpu(CPUState *cs)
A
Alexander Graf 已提交
196
{
197 198
    S390CPU *cpu = S390_CPU(cs);
    kvm_s390_set_cpu_state(cpu, cpu->env.cpu_state);
199
    return 0;
A
Alexander Graf 已提交
200 201
}

202
void kvm_s390_reset_vcpu(S390CPU *cpu)
A
Alexander Graf 已提交
203
{
204 205
    CPUState *cs = CPU(cpu);

A
Alexander Graf 已提交
206 207 208 209 210
    /* The initial reset call is needed here to reset in-kernel
     * vcpu data that we can't access directly from QEMU
     * (i.e. with older kernels which don't support sync_regs/ONE_REG).
     * Before this ioctl cpu_synchronize_state() is called in common kvm
     * code (kvm-all) */
211
    if (kvm_vcpu_ioctl(cs, KVM_S390_INITIAL_RESET, NULL)) {
212
        error_report("Initial CPU reset failed on CPU %i\n", cs->cpu_index);
J
Jens Freimann 已提交
213
    }
A
Alexander Graf 已提交
214 215
}

216 217 218 219 220
static int can_sync_regs(CPUState *cs, int regs)
{
    return cap_sync_regs && (cs->kvm_run->kvm_valid_regs & regs) == regs;
}

A
Andreas Färber 已提交
221
int kvm_arch_put_registers(CPUState *cs, int level)
A
Alexander Graf 已提交
222
{
A
Andreas Färber 已提交
223 224
    S390CPU *cpu = S390_CPU(cs);
    CPUS390XState *env = &cpu->env;
225
    struct kvm_sregs sregs;
A
Alexander Graf 已提交
226
    struct kvm_regs regs;
227
    struct kvm_fpu fpu = {};
228
    int r;
A
Alexander Graf 已提交
229 230
    int i;

231
    /* always save the PSW  and the GPRS*/
A
Andreas Färber 已提交
232 233
    cs->kvm_run->psw_addr = env->psw.addr;
    cs->kvm_run->psw_mask = env->psw.mask;
A
Alexander Graf 已提交
234

235
    if (can_sync_regs(cs, KVM_SYNC_GPRS)) {
236
        for (i = 0; i < 16; i++) {
A
Andreas Färber 已提交
237 238
            cs->kvm_run->s.regs.gprs[i] = env->regs[i];
            cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_GPRS;
239 240 241 242 243
        }
    } else {
        for (i = 0; i < 16; i++) {
            regs.gprs[i] = env->regs[i];
        }
244 245 246
        r = kvm_vcpu_ioctl(cs, KVM_SET_REGS, &regs);
        if (r < 0) {
            return r;
247
        }
A
Alexander Graf 已提交
248 249
    }

250 251 252 253 254 255 256 257 258 259 260
    /* Floating point */
    for (i = 0; i < 16; i++) {
        fpu.fprs[i] = env->fregs[i].ll;
    }
    fpu.fpc = env->fpc;

    r = kvm_vcpu_ioctl(cs, KVM_SET_FPU, &fpu);
    if (r < 0) {
        return r;
    }

261 262 263 264
    /* Do we need to save more than that? */
    if (level == KVM_PUT_RUNTIME_STATE) {
        return 0;
    }
265

266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292
    if (can_sync_regs(cs, KVM_SYNC_ARCH0)) {
        cs->kvm_run->s.regs.cputm = env->cputm;
        cs->kvm_run->s.regs.ckc = env->ckc;
        cs->kvm_run->s.regs.todpr = env->todpr;
        cs->kvm_run->s.regs.gbea = env->gbea;
        cs->kvm_run->s.regs.pp = env->pp;
        cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_ARCH0;
    } else {
        /*
         * These ONE_REGS are not protected by a capability. As they are only
         * necessary for migration we just trace a possible error, but don't
         * return with an error return code.
         */
        kvm_set_one_reg(cs, KVM_REG_S390_CPU_TIMER, &env->cputm);
        kvm_set_one_reg(cs, KVM_REG_S390_CLOCK_COMP, &env->ckc);
        kvm_set_one_reg(cs, KVM_REG_S390_TODPR, &env->todpr);
        kvm_set_one_reg(cs, KVM_REG_S390_GBEA, &env->gbea);
        kvm_set_one_reg(cs, KVM_REG_S390_PP, &env->pp);
    }

    /* pfault parameters */
    if (can_sync_regs(cs, KVM_SYNC_PFAULT)) {
        cs->kvm_run->s.regs.pft = env->pfault_token;
        cs->kvm_run->s.regs.pfs = env->pfault_select;
        cs->kvm_run->s.regs.pfc = env->pfault_compare;
        cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_PFAULT;
    } else if (cap_async_pf) {
293 294 295
        r = kvm_set_one_reg(cs, KVM_REG_S390_PFTOKEN, &env->pfault_token);
        if (r < 0) {
            return r;
296
        }
297 298 299
        r = kvm_set_one_reg(cs, KVM_REG_S390_PFCOMPARE, &env->pfault_compare);
        if (r < 0) {
            return r;
300
        }
301 302 303
        r = kvm_set_one_reg(cs, KVM_REG_S390_PFSELECT, &env->pfault_select);
        if (r < 0) {
            return r;
304 305 306
        }
    }

307 308
    /* access registers and control registers*/
    if (can_sync_regs(cs, KVM_SYNC_ACRS | KVM_SYNC_CRS)) {
309
        for (i = 0; i < 16; i++) {
A
Andreas Färber 已提交
310 311
            cs->kvm_run->s.regs.acrs[i] = env->aregs[i];
            cs->kvm_run->s.regs.crs[i] = env->cregs[i];
312
        }
A
Andreas Färber 已提交
313 314
        cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_ACRS;
        cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_CRS;
315 316 317 318 319
    } else {
        for (i = 0; i < 16; i++) {
            sregs.acrs[i] = env->aregs[i];
            sregs.crs[i] = env->cregs[i];
        }
320 321 322
        r = kvm_vcpu_ioctl(cs, KVM_SET_SREGS, &sregs);
        if (r < 0) {
            return r;
323 324
        }
    }
A
Alexander Graf 已提交
325

326
    /* Finally the prefix */
327
    if (can_sync_regs(cs, KVM_SYNC_PREFIX)) {
A
Andreas Färber 已提交
328 329
        cs->kvm_run->s.regs.prefix = env->psa;
        cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_PREFIX;
330 331 332 333
    } else {
        /* prefix is only supported via sync regs */
    }
    return 0;
A
Alexander Graf 已提交
334 335
}

A
Andreas Färber 已提交
336
int kvm_arch_get_registers(CPUState *cs)
337 338 339
{
    S390CPU *cpu = S390_CPU(cs);
    CPUS390XState *env = &cpu->env;
340
    struct kvm_sregs sregs;
A
Alexander Graf 已提交
341
    struct kvm_regs regs;
342
    struct kvm_fpu fpu;
343
    int i, r;
344

345
    /* get the PSW */
A
Andreas Färber 已提交
346 347
    env->psw.addr = cs->kvm_run->psw_addr;
    env->psw.mask = cs->kvm_run->psw_mask;
348 349

    /* the GPRS */
350
    if (can_sync_regs(cs, KVM_SYNC_GPRS)) {
351
        for (i = 0; i < 16; i++) {
A
Andreas Färber 已提交
352
            env->regs[i] = cs->kvm_run->s.regs.gprs[i];
353 354
        }
    } else {
355 356 357
        r = kvm_vcpu_ioctl(cs, KVM_GET_REGS, &regs);
        if (r < 0) {
            return r;
358 359 360 361
        }
         for (i = 0; i < 16; i++) {
            env->regs[i] = regs.gprs[i];
        }
A
Alexander Graf 已提交
362 363
    }

364
    /* The ACRS and CRS */
365
    if (can_sync_regs(cs, KVM_SYNC_ACRS | KVM_SYNC_CRS)) {
366
        for (i = 0; i < 16; i++) {
A
Andreas Färber 已提交
367 368
            env->aregs[i] = cs->kvm_run->s.regs.acrs[i];
            env->cregs[i] = cs->kvm_run->s.regs.crs[i];
369 370
        }
    } else {
371 372 373
        r = kvm_vcpu_ioctl(cs, KVM_GET_SREGS, &sregs);
        if (r < 0) {
            return r;
374 375 376 377 378
        }
         for (i = 0; i < 16; i++) {
            env->aregs[i] = sregs.acrs[i];
            env->cregs[i] = sregs.crs[i];
        }
A
Alexander Graf 已提交
379 380
    }

381 382 383 384 385 386 387 388 389 390
    /* Floating point */
    r = kvm_vcpu_ioctl(cs, KVM_GET_FPU, &fpu);
    if (r < 0) {
        return r;
    }
    for (i = 0; i < 16; i++) {
        env->fregs[i].ll = fpu.fprs[i];
    }
    env->fpc = fpu.fpc;

391
    /* The prefix */
392
    if (can_sync_regs(cs, KVM_SYNC_PREFIX)) {
A
Andreas Färber 已提交
393
        env->psa = cs->kvm_run->s.regs.prefix;
394
    }
A
Alexander Graf 已提交
395

396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420
    if (can_sync_regs(cs, KVM_SYNC_ARCH0)) {
        env->cputm = cs->kvm_run->s.regs.cputm;
        env->ckc = cs->kvm_run->s.regs.ckc;
        env->todpr = cs->kvm_run->s.regs.todpr;
        env->gbea = cs->kvm_run->s.regs.gbea;
        env->pp = cs->kvm_run->s.regs.pp;
    } else {
        /*
         * These ONE_REGS are not protected by a capability. As they are only
         * necessary for migration we just trace a possible error, but don't
         * return with an error return code.
         */
        kvm_get_one_reg(cs, KVM_REG_S390_CPU_TIMER, &env->cputm);
        kvm_get_one_reg(cs, KVM_REG_S390_CLOCK_COMP, &env->ckc);
        kvm_get_one_reg(cs, KVM_REG_S390_TODPR, &env->todpr);
        kvm_get_one_reg(cs, KVM_REG_S390_GBEA, &env->gbea);
        kvm_get_one_reg(cs, KVM_REG_S390_PP, &env->pp);
    }

    /* pfault parameters */
    if (can_sync_regs(cs, KVM_SYNC_PFAULT)) {
        env->pfault_token = cs->kvm_run->s.regs.pft;
        env->pfault_select = cs->kvm_run->s.regs.pfs;
        env->pfault_compare = cs->kvm_run->s.regs.pfc;
    } else if (cap_async_pf) {
421
        r = kvm_get_one_reg(cs, KVM_REG_S390_PFTOKEN, &env->pfault_token);
422 423 424
        if (r < 0) {
            return r;
        }
425
        r = kvm_get_one_reg(cs, KVM_REG_S390_PFCOMPARE, &env->pfault_compare);
426 427 428
        if (r < 0) {
            return r;
        }
429
        r = kvm_get_one_reg(cs, KVM_REG_S390_PFSELECT, &env->pfault_select);
430 431 432 433 434
        if (r < 0) {
            return r;
        }
    }

A
Alexander Graf 已提交
435 436 437
    return 0;
}

438 439 440 441 442 443 444 445 446 447
/*
 * Legacy layout for s390:
 * Older S390 KVM requires the topmost vma of the RAM to be
 * smaller than an system defined value, which is at least 256GB.
 * Larger systems have larger values. We put the guest between
 * the end of data segment (system break) and this value. We
 * use 32GB as a base to have enough room for the system break
 * to grow. We also have to use MAP parameters that avoid
 * read-only mapping of guest pages.
 */
448
static void *legacy_s390_alloc(size_t size, uint64_t *align)
449 450 451 452 453 454
{
    void *mem;

    mem = mmap((void *) 0x800000000ULL, size,
               PROT_EXEC|PROT_READ|PROT_WRITE,
               MAP_SHARED | MAP_ANONYMOUS | MAP_FIXED, -1, 0);
455
    return mem == MAP_FAILED ? NULL : mem;
456 457
}

458 459 460
/* DIAG 501 is used for sw breakpoints */
static const uint8_t diag_501[] = {0x83, 0x24, 0x05, 0x01};

A
Andreas Färber 已提交
461
int kvm_arch_insert_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
A
Alexander Graf 已提交
462 463
{

464 465 466 467
    if (cpu_memory_rw_debug(cs, bp->pc, (uint8_t *)&bp->saved_insn,
                            sizeof(diag_501), 0) ||
        cpu_memory_rw_debug(cs, bp->pc, (uint8_t *)diag_501,
                            sizeof(diag_501), 1)) {
A
Alexander Graf 已提交
468 469 470 471 472
        return -EINVAL;
    }
    return 0;
}

A
Andreas Färber 已提交
473
int kvm_arch_remove_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
A
Alexander Graf 已提交
474
{
475
    uint8_t t[sizeof(diag_501)];
A
Alexander Graf 已提交
476

477
    if (cpu_memory_rw_debug(cs, bp->pc, t, sizeof(diag_501), 0)) {
A
Alexander Graf 已提交
478
        return -EINVAL;
479
    } else if (memcmp(t, diag_501, sizeof(diag_501))) {
A
Alexander Graf 已提交
480
        return -EINVAL;
481 482
    } else if (cpu_memory_rw_debug(cs, bp->pc, (uint8_t *)&bp->saved_insn,
                                   sizeof(diag_501), 1)) {
A
Alexander Graf 已提交
483 484 485 486 487 488
        return -EINVAL;
    }

    return 0;
}

489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535
static struct kvm_hw_breakpoint *find_hw_breakpoint(target_ulong addr,
                                                    int len, int type)
{
    int n;

    for (n = 0; n < nb_hw_breakpoints; n++) {
        if (hw_breakpoints[n].addr == addr && hw_breakpoints[n].type == type &&
            (hw_breakpoints[n].len == len || len == -1)) {
            return &hw_breakpoints[n];
        }
    }

    return NULL;
}

static int insert_hw_breakpoint(target_ulong addr, int len, int type)
{
    int size;

    if (find_hw_breakpoint(addr, len, type)) {
        return -EEXIST;
    }

    size = (nb_hw_breakpoints + 1) * sizeof(struct kvm_hw_breakpoint);

    if (!hw_breakpoints) {
        nb_hw_breakpoints = 0;
        hw_breakpoints = (struct kvm_hw_breakpoint *)g_try_malloc(size);
    } else {
        hw_breakpoints =
            (struct kvm_hw_breakpoint *)g_try_realloc(hw_breakpoints, size);
    }

    if (!hw_breakpoints) {
        nb_hw_breakpoints = 0;
        return -ENOMEM;
    }

    hw_breakpoints[nb_hw_breakpoints].addr = addr;
    hw_breakpoints[nb_hw_breakpoints].len = len;
    hw_breakpoints[nb_hw_breakpoints].type = type;

    nb_hw_breakpoints++;

    return 0;
}

536 537 538
int kvm_arch_insert_hw_breakpoint(target_ulong addr,
                                  target_ulong len, int type)
{
539 540 541 542 543 544 545 546 547 548 549 550 551 552
    switch (type) {
    case GDB_BREAKPOINT_HW:
        type = KVM_HW_BP;
        break;
    case GDB_WATCHPOINT_WRITE:
        if (len < 1) {
            return -EINVAL;
        }
        type = KVM_HW_WP_WRITE;
        break;
    default:
        return -ENOSYS;
    }
    return insert_hw_breakpoint(addr, len, type);
553 554 555 556 557
}

int kvm_arch_remove_hw_breakpoint(target_ulong addr,
                                  target_ulong len, int type)
{
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
    int size;
    struct kvm_hw_breakpoint *bp = find_hw_breakpoint(addr, len, type);

    if (bp == NULL) {
        return -ENOENT;
    }

    nb_hw_breakpoints--;
    if (nb_hw_breakpoints > 0) {
        /*
         * In order to trim the array, move the last element to the position to
         * be removed - if necessary.
         */
        if (bp != &hw_breakpoints[nb_hw_breakpoints]) {
            *bp = hw_breakpoints[nb_hw_breakpoints];
        }
        size = nb_hw_breakpoints * sizeof(struct kvm_hw_breakpoint);
        hw_breakpoints =
             (struct kvm_hw_breakpoint *)g_realloc(hw_breakpoints, size);
    } else {
        g_free(hw_breakpoints);
        hw_breakpoints = NULL;
    }

    return 0;
583 584 585 586
}

void kvm_arch_remove_all_hw_breakpoints(void)
{
587 588 589
    nb_hw_breakpoints = 0;
    g_free(hw_breakpoints);
    hw_breakpoints = NULL;
590 591 592 593
}

void kvm_arch_update_guest_debug(CPUState *cpu, struct kvm_guest_debug *dbg)
{
594 595 596 597 598 599 600 601 602 603 604 605 606 607 608
    int i;

    if (nb_hw_breakpoints > 0) {
        dbg->arch.nr_hw_bp = nb_hw_breakpoints;
        dbg->arch.hw_bp = hw_breakpoints;

        for (i = 0; i < nb_hw_breakpoints; ++i) {
            hw_breakpoints[i].phys_addr = s390_cpu_get_phys_addr_debug(cpu,
                                                       hw_breakpoints[i].addr);
        }
        dbg->control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_USE_HW_BP;
    } else {
        dbg->arch.nr_hw_bp = 0;
        dbg->arch.hw_bp = NULL;
    }
609 610
}

A
Andreas Färber 已提交
611
void kvm_arch_pre_run(CPUState *cpu, struct kvm_run *run)
A
Alexander Graf 已提交
612 613 614
{
}

A
Andreas Färber 已提交
615
void kvm_arch_post_run(CPUState *cpu, struct kvm_run *run)
A
Alexander Graf 已提交
616 617 618
{
}

A
Andreas Färber 已提交
619
int kvm_arch_process_async_events(CPUState *cs)
M
Marcelo Tosatti 已提交
620
{
621
    return cs->halted;
M
Marcelo Tosatti 已提交
622 623
}

624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691
static int s390_kvm_irq_to_interrupt(struct kvm_s390_irq *irq,
                                     struct kvm_s390_interrupt *interrupt)
{
    int r = 0;

    interrupt->type = irq->type;
    switch (irq->type) {
    case KVM_S390_INT_VIRTIO:
        interrupt->parm = irq->u.ext.ext_params;
        /* fall through */
    case KVM_S390_INT_PFAULT_INIT:
    case KVM_S390_INT_PFAULT_DONE:
        interrupt->parm64 = irq->u.ext.ext_params2;
        break;
    case KVM_S390_PROGRAM_INT:
        interrupt->parm = irq->u.pgm.code;
        break;
    case KVM_S390_SIGP_SET_PREFIX:
        interrupt->parm = irq->u.prefix.address;
        break;
    case KVM_S390_INT_SERVICE:
        interrupt->parm = irq->u.ext.ext_params;
        break;
    case KVM_S390_MCHK:
        interrupt->parm = irq->u.mchk.cr14;
        interrupt->parm64 = irq->u.mchk.mcic;
        break;
    case KVM_S390_INT_EXTERNAL_CALL:
        interrupt->parm = irq->u.extcall.code;
        break;
    case KVM_S390_INT_EMERGENCY:
        interrupt->parm = irq->u.emerg.code;
        break;
    case KVM_S390_SIGP_STOP:
    case KVM_S390_RESTART:
        break; /* These types have no parameters */
    case KVM_S390_INT_IO_MIN...KVM_S390_INT_IO_MAX:
        interrupt->parm = irq->u.io.subchannel_id << 16;
        interrupt->parm |= irq->u.io.subchannel_nr;
        interrupt->parm64 = (uint64_t)irq->u.io.io_int_parm << 32;
        interrupt->parm64 |= irq->u.io.io_int_word;
        break;
    default:
        r = -EINVAL;
        break;
    }
    return r;
}

void kvm_s390_vcpu_interrupt(S390CPU *cpu, struct kvm_s390_irq *irq)
{
    struct kvm_s390_interrupt kvmint = {};
    CPUState *cs = CPU(cpu);
    int r;

    r = s390_kvm_irq_to_interrupt(irq, &kvmint);
    if (r < 0) {
        fprintf(stderr, "%s called with bogus interrupt\n", __func__);
        exit(1);
    }

    r = kvm_vcpu_ioctl(cs, KVM_S390_INTERRUPT, &kvmint);
    if (r < 0) {
        fprintf(stderr, "KVM failed to inject interrupt\n");
        exit(1);
    }
}

C
Cornelia Huck 已提交
692
static void __kvm_s390_floating_interrupt(struct kvm_s390_irq *irq)
693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709
{
    struct kvm_s390_interrupt kvmint = {};
    int r;

    r = s390_kvm_irq_to_interrupt(irq, &kvmint);
    if (r < 0) {
        fprintf(stderr, "%s called with bogus interrupt\n", __func__);
        exit(1);
    }

    r = kvm_vm_ioctl(kvm_state, KVM_S390_INTERRUPT, &kvmint);
    if (r < 0) {
        fprintf(stderr, "KVM failed to inject interrupt\n");
        exit(1);
    }
}

C
Cornelia Huck 已提交
710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726
void kvm_s390_floating_interrupt(struct kvm_s390_irq *irq)
{
    static bool use_flic = true;
    int r;

    if (use_flic) {
        r = kvm_s390_inject_flic(irq);
        if (r == -ENOSYS) {
            use_flic = false;
        }
        if (!r) {
            return;
        }
    }
    __kvm_s390_floating_interrupt(irq);
}

727
void kvm_s390_virtio_irq(int config_change, uint64_t token)
A
Alexander Graf 已提交
728
{
729 730 731 732 733
    struct kvm_s390_irq irq = {
        .type = KVM_S390_INT_VIRTIO,
        .u.ext.ext_params = config_change,
        .u.ext.ext_params2 = token,
    };
A
Alexander Graf 已提交
734

735
    kvm_s390_floating_interrupt(&irq);
A
Alexander Graf 已提交
736 737
}

738
void kvm_s390_service_interrupt(uint32_t parm)
A
Alexander Graf 已提交
739
{
740 741 742 743
    struct kvm_s390_irq irq = {
        .type = KVM_S390_INT_SERVICE,
        .u.ext.ext_params = parm,
    };
A
Alexander Graf 已提交
744

745
    kvm_s390_floating_interrupt(&irq);
746 747
}

748
static void enter_pgmcheck(S390CPU *cpu, uint16_t code)
A
Alexander Graf 已提交
749
{
750 751 752 753 754 755
    struct kvm_s390_irq irq = {
        .type = KVM_S390_PROGRAM_INT,
        .u.pgm.code = code,
    };

    kvm_s390_vcpu_interrupt(cpu, &irq);
A
Alexander Graf 已提交
756 757
}

758
static int kvm_sclp_service_call(S390CPU *cpu, struct kvm_run *run,
759
                                 uint16_t ipbh0)
A
Alexander Graf 已提交
760
{
761
    CPUS390XState *env = &cpu->env;
762 763
    uint64_t sccb;
    uint32_t code;
A
Alexander Graf 已提交
764 765
    int r = 0;

766
    cpu_synchronize_state(CPU(cpu));
A
Alexander Graf 已提交
767 768 769
    sccb = env->regs[ipbh0 & 0xf];
    code = env->regs[(ipbh0 & 0xf0) >> 4];

770
    r = sclp_service_call(env, sccb, code);
771
    if (r < 0) {
772
        enter_pgmcheck(cpu, -r);
773 774
    } else {
        setcc(cpu, r);
A
Alexander Graf 已提交
775
    }
A
Alexander Graf 已提交
776

A
Alexander Graf 已提交
777 778 779
    return 0;
}

780
static int handle_b2(S390CPU *cpu, struct kvm_run *run, uint8_t ipa1)
781 782
{
    CPUS390XState *env = &cpu->env;
783 784
    int rc = 0;
    uint16_t ipbh0 = (run->s390_sieic.ipb & 0xffff0000) >> 16;
785

786
    cpu_synchronize_state(CPU(cpu));
787

788
    switch (ipa1) {
789
    case PRIV_B2_XSCH:
790
        ioinst_handle_xsch(cpu, env->regs[1]);
791
        break;
792
    case PRIV_B2_CSCH:
793
        ioinst_handle_csch(cpu, env->regs[1]);
794
        break;
795
    case PRIV_B2_HSCH:
796
        ioinst_handle_hsch(cpu, env->regs[1]);
797
        break;
798
    case PRIV_B2_MSCH:
799
        ioinst_handle_msch(cpu, env->regs[1], run->s390_sieic.ipb);
800
        break;
801
    case PRIV_B2_SSCH:
802
        ioinst_handle_ssch(cpu, env->regs[1], run->s390_sieic.ipb);
803
        break;
804
    case PRIV_B2_STCRW:
805
        ioinst_handle_stcrw(cpu, run->s390_sieic.ipb);
806
        break;
807
    case PRIV_B2_STSCH:
808
        ioinst_handle_stsch(cpu, env->regs[1], run->s390_sieic.ipb);
809
        break;
810
    case PRIV_B2_TSCH:
811 812 813
        /* We should only get tsch via KVM_EXIT_S390_TSCH. */
        fprintf(stderr, "Spurious tsch intercept\n");
        break;
814
    case PRIV_B2_CHSC:
815
        ioinst_handle_chsc(cpu, run->s390_sieic.ipb);
816
        break;
817
    case PRIV_B2_TPI:
818 819 820
        /* This should have been handled by kvm already. */
        fprintf(stderr, "Spurious tpi intercept\n");
        break;
821
    case PRIV_B2_SCHM:
822 823
        ioinst_handle_schm(cpu, env->regs[1], env->regs[2],
                           run->s390_sieic.ipb);
824
        break;
825
    case PRIV_B2_RSCH:
826
        ioinst_handle_rsch(cpu, env->regs[1]);
827
        break;
828
    case PRIV_B2_RCHP:
829
        ioinst_handle_rchp(cpu, env->regs[1]);
830
        break;
831
    case PRIV_B2_STCPS:
832 833
        /* We do not provide this instruction, it is suppressed. */
        break;
834
    case PRIV_B2_SAL:
835
        ioinst_handle_sal(cpu, env->regs[1]);
836
        break;
837
    case PRIV_B2_SIGA:
838
        /* Not provided, set CC = 3 for subchannel not operational */
839
        setcc(cpu, 3);
840
        break;
841 842 843
    case PRIV_B2_SCLP_CALL:
        rc = kvm_sclp_service_call(cpu, run, ipbh0);
        break;
844
    default:
845 846 847
        rc = -1;
        DPRINTF("KVM: unhandled PRIV: 0xb2%x\n", ipa1);
        break;
848 849
    }

850
    return rc;
851 852
}

853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953
static uint64_t get_base_disp_rxy(S390CPU *cpu, struct kvm_run *run)
{
    CPUS390XState *env = &cpu->env;
    uint32_t x2 = (run->s390_sieic.ipa & 0x000f);
    uint32_t base2 = run->s390_sieic.ipb >> 28;
    uint32_t disp2 = ((run->s390_sieic.ipb & 0x0fff0000) >> 16) +
                     ((run->s390_sieic.ipb & 0xff00) << 4);

    if (disp2 & 0x80000) {
        disp2 += 0xfff00000;
    }

    return (base2 ? env->regs[base2] : 0) +
           (x2 ? env->regs[x2] : 0) + (long)(int)disp2;
}

static uint64_t get_base_disp_rsy(S390CPU *cpu, struct kvm_run *run)
{
    CPUS390XState *env = &cpu->env;
    uint32_t base2 = run->s390_sieic.ipb >> 28;
    uint32_t disp2 = ((run->s390_sieic.ipb & 0x0fff0000) >> 16) +
                     ((run->s390_sieic.ipb & 0xff00) << 4);

    if (disp2 & 0x80000) {
        disp2 += 0xfff00000;
    }

    return (base2 ? env->regs[base2] : 0) + (long)(int)disp2;
}

static int kvm_clp_service_call(S390CPU *cpu, struct kvm_run *run)
{
    uint8_t r2 = (run->s390_sieic.ipb & 0x000f0000) >> 16;

    return clp_service_call(cpu, r2);
}

static int kvm_pcilg_service_call(S390CPU *cpu, struct kvm_run *run)
{
    uint8_t r1 = (run->s390_sieic.ipb & 0x00f00000) >> 20;
    uint8_t r2 = (run->s390_sieic.ipb & 0x000f0000) >> 16;

    return pcilg_service_call(cpu, r1, r2);
}

static int kvm_pcistg_service_call(S390CPU *cpu, struct kvm_run *run)
{
    uint8_t r1 = (run->s390_sieic.ipb & 0x00f00000) >> 20;
    uint8_t r2 = (run->s390_sieic.ipb & 0x000f0000) >> 16;

    return pcistg_service_call(cpu, r1, r2);
}

static int kvm_stpcifc_service_call(S390CPU *cpu, struct kvm_run *run)
{
    uint8_t r1 = (run->s390_sieic.ipa & 0x00f0) >> 4;
    uint64_t fiba;

    cpu_synchronize_state(CPU(cpu));
    fiba = get_base_disp_rxy(cpu, run);

    return stpcifc_service_call(cpu, r1, fiba);
}

static int kvm_sic_service_call(S390CPU *cpu, struct kvm_run *run)
{
    /* NOOP */
    return 0;
}

static int kvm_rpcit_service_call(S390CPU *cpu, struct kvm_run *run)
{
    uint8_t r1 = (run->s390_sieic.ipb & 0x00f00000) >> 20;
    uint8_t r2 = (run->s390_sieic.ipb & 0x000f0000) >> 16;

    return rpcit_service_call(cpu, r1, r2);
}

static int kvm_pcistb_service_call(S390CPU *cpu, struct kvm_run *run)
{
    uint8_t r1 = (run->s390_sieic.ipa & 0x00f0) >> 4;
    uint8_t r3 = run->s390_sieic.ipa & 0x000f;
    uint64_t gaddr;

    cpu_synchronize_state(CPU(cpu));
    gaddr = get_base_disp_rsy(cpu, run);

    return pcistb_service_call(cpu, r1, r3, gaddr);
}

static int kvm_mpcifc_service_call(S390CPU *cpu, struct kvm_run *run)
{
    uint8_t r1 = (run->s390_sieic.ipa & 0x00f0) >> 4;
    uint64_t fiba;

    cpu_synchronize_state(CPU(cpu));
    fiba = get_base_disp_rxy(cpu, run);

    return mpcifc_service_call(cpu, r1, fiba);
}

954
static int handle_b9(S390CPU *cpu, struct kvm_run *run, uint8_t ipa1)
A
Alexander Graf 已提交
955 956 957 958
{
    int r = 0;

    switch (ipa1) {
959 960 961 962 963 964 965 966 967 968 969 970
    case PRIV_B9_CLP:
        r = kvm_clp_service_call(cpu, run);
        break;
    case PRIV_B9_PCISTG:
        r = kvm_pcistg_service_call(cpu, run);
        break;
    case PRIV_B9_PCILG:
        r = kvm_pcilg_service_call(cpu, run);
        break;
    case PRIV_B9_RPCIT:
        r = kvm_rpcit_service_call(cpu, run);
        break;
971 972 973 974 975 976 977 978 979 980 981 982 983
    case PRIV_B9_EQBS:
        /* just inject exception */
        r = -1;
        break;
    default:
        r = -1;
        DPRINTF("KVM: unhandled PRIV: 0xb9%x\n", ipa1);
        break;
    }

    return r;
}

984
static int handle_eb(S390CPU *cpu, struct kvm_run *run, uint8_t ipbl)
985 986 987
{
    int r = 0;

988
    switch (ipbl) {
989 990 991 992 993 994
    case PRIV_EB_PCISTB:
        r = kvm_pcistb_service_call(cpu, run);
        break;
    case PRIV_EB_SIC:
        r = kvm_sic_service_call(cpu, run);
        break;
995 996 997 998 999 1000
    case PRIV_EB_SQBS:
        /* just inject exception */
        r = -1;
        break;
    default:
        r = -1;
1001
        DPRINTF("KVM: unhandled PRIV: 0xeb%x\n", ipbl);
1002
        break;
A
Alexander Graf 已提交
1003 1004 1005 1006 1007
    }

    return r;
}

1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027
static int handle_e3(S390CPU *cpu, struct kvm_run *run, uint8_t ipbl)
{
    int r = 0;

    switch (ipbl) {
    case PRIV_E3_MPCIFC:
        r = kvm_mpcifc_service_call(cpu, run);
        break;
    case PRIV_E3_STPCIFC:
        r = kvm_stpcifc_service_call(cpu, run);
        break;
    default:
        r = -1;
        DPRINTF("KVM: unhandled PRIV: 0xe3%x\n", ipbl);
        break;
    }

    return r;
}

1028
static int handle_hypercall(S390CPU *cpu, struct kvm_run *run)
A
Alexander Graf 已提交
1029
{
1030
    CPUS390XState *env = &cpu->env;
1031
    int ret;
1032

1033
    cpu_synchronize_state(CPU(cpu));
1034 1035 1036 1037 1038
    ret = s390_virtio_hypercall(env);
    if (ret == -EINVAL) {
        enter_pgmcheck(cpu, PGM_SPECIFICATION);
        return 0;
    }
A
Alexander Graf 已提交
1039

1040
    return ret;
A
Alexander Graf 已提交
1041 1042
}

1043 1044 1045 1046 1047 1048 1049 1050 1051 1052
static void kvm_handle_diag_308(S390CPU *cpu, struct kvm_run *run)
{
    uint64_t r1, r3;

    cpu_synchronize_state(CPU(cpu));
    r1 = (run->s390_sieic.ipa & 0x00f0) >> 8;
    r3 = run->s390_sieic.ipa & 0x000f;
    handle_diag_308(&cpu->env, r1, r3);
}

1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068
static int handle_sw_breakpoint(S390CPU *cpu, struct kvm_run *run)
{
    CPUS390XState *env = &cpu->env;
    unsigned long pc;

    cpu_synchronize_state(CPU(cpu));

    pc = env->psw.addr - 4;
    if (kvm_find_sw_breakpoint(CPU(cpu), pc)) {
        env->psw.addr = pc;
        return EXCP_DEBUG;
    }

    return -ENOENT;
}

C
Cornelia Huck 已提交
1069 1070 1071
#define DIAG_KVM_CODE_MASK 0x000000000000ffff

static int handle_diag(S390CPU *cpu, struct kvm_run *run, uint32_t ipb)
A
Alexander Graf 已提交
1072 1073
{
    int r = 0;
C
Cornelia Huck 已提交
1074 1075 1076 1077 1078 1079 1080 1081
    uint16_t func_code;

    /*
     * For any diagnose call we support, bits 48-63 of the resulting
     * address specify the function code; the remainder is ignored.
     */
    func_code = decode_basedisp_rs(&cpu->env, ipb) & DIAG_KVM_CODE_MASK;
    switch (func_code) {
1082 1083 1084
    case DIAG_IPL:
        kvm_handle_diag_308(cpu, run);
        break;
1085 1086 1087 1088
    case DIAG_KVM_HYPERCALL:
        r = handle_hypercall(cpu, run);
        break;
    case DIAG_KVM_BREAKPOINT:
1089
        r = handle_sw_breakpoint(cpu, run);
1090 1091
        break;
    default:
C
Cornelia Huck 已提交
1092
        DPRINTF("KVM: unknown DIAG: 0x%x\n", func_code);
1093 1094
        r = -1;
        break;
A
Alexander Graf 已提交
1095 1096 1097 1098 1099
    }

    return r;
}

1100
static void sigp_cpu_start(void *arg)
T
Thomas Huth 已提交
1101
{
1102 1103 1104
    CPUState *cs = arg;
    S390CPU *cpu = S390_CPU(cs);

1105
    s390_cpu_set_state(CPU_STATE_OPERATING, cpu);
T
Thomas Huth 已提交
1106 1107 1108
    DPRINTF("DONE: KVM cpu start: %p\n", &cpu->env);
}

1109
static void sigp_cpu_restart(void *arg)
A
Alexander Graf 已提交
1110
{
1111 1112
    CPUState *cs = arg;
    S390CPU *cpu = S390_CPU(cs);
1113 1114 1115 1116 1117
    struct kvm_s390_irq irq = {
        .type = KVM_S390_RESTART,
    };

    kvm_s390_vcpu_interrupt(cpu, &irq);
1118
    s390_cpu_set_state(CPU_STATE_OPERATING, cpu);
1119 1120 1121 1122 1123
}

int kvm_s390_cpu_restart(S390CPU *cpu)
{
    run_on_cpu(CPU(cpu), sigp_cpu_restart, CPU(cpu));
1124
    DPRINTF("DONE: KVM cpu restart: %p\n", &cpu->env);
A
Alexander Graf 已提交
1125 1126 1127
    return 0;
}

1128
static void sigp_initial_cpu_reset(void *arg)
A
Alexander Graf 已提交
1129
{
1130 1131
    CPUState *cpu = arg;
    S390CPUClass *scc = S390_CPU_GET_CLASS(cpu);
1132

1133 1134
    cpu_synchronize_state(cpu);
    scc->initial_cpu_reset(cpu);
1135
    cpu_synchronize_post_reset(cpu);
A
Alexander Graf 已提交
1136 1137
}

1138 1139 1140 1141 1142 1143 1144
static void sigp_cpu_reset(void *arg)
{
    CPUState *cpu = arg;
    S390CPUClass *scc = S390_CPU_GET_CLASS(cpu);

    cpu_synchronize_state(cpu);
    scc->cpu_reset(cpu);
1145
    cpu_synchronize_post_reset(cpu);
1146 1147
}

1148 1149
#define SIGP_ORDER_MASK 0x000000ff

A
Andreas Färber 已提交
1150
static int handle_sigp(S390CPU *cpu, struct kvm_run *run, uint8_t ipa1)
A
Alexander Graf 已提交
1151
{
A
Andreas Färber 已提交
1152
    CPUS390XState *env = &cpu->env;
A
Alexander Graf 已提交
1153 1154
    uint8_t order_code;
    uint16_t cpu_addr;
1155
    S390CPU *target_cpu;
1156 1157
    uint64_t *statusreg = &env->regs[ipa1 >> 4];
    int cc;
A
Alexander Graf 已提交
1158

1159
    cpu_synchronize_state(CPU(cpu));
A
Alexander Graf 已提交
1160 1161

    /* get order code */
1162
    order_code = decode_basedisp_rs(env, run->s390_sieic.ipb) & SIGP_ORDER_MASK;
A
Alexander Graf 已提交
1163 1164

    cpu_addr = env->regs[ipa1 & 0x0f];
1165 1166
    target_cpu = s390_cpu_addr2state(cpu_addr);
    if (target_cpu == NULL) {
1167
        cc = 3;    /* not operational */
A
Alexander Graf 已提交
1168 1169 1170 1171
        goto out;
    }

    switch (order_code) {
T
Thomas Huth 已提交
1172
    case SIGP_START:
1173 1174
        run_on_cpu(CPU(target_cpu), sigp_cpu_start, CPU(target_cpu));
        cc = 0;
T
Thomas Huth 已提交
1175
        break;
1176
    case SIGP_RESTART:
1177 1178
        run_on_cpu(CPU(target_cpu), sigp_cpu_restart, CPU(target_cpu));
        cc = 0;
1179 1180
        break;
    case SIGP_SET_ARCH:
1181 1182 1183 1184
        *statusreg &= 0xffffffff00000000UL;
        *statusreg |= SIGP_STAT_INVALID_PARAMETER;
        cc = 1;   /* status stored */
        break;
1185
    case SIGP_INITIAL_CPU_RESET:
1186 1187
        run_on_cpu(CPU(target_cpu), sigp_initial_cpu_reset, CPU(target_cpu));
        cc = 0;
1188
        break;
1189 1190 1191 1192
    case SIGP_CPU_RESET:
        run_on_cpu(CPU(target_cpu), sigp_cpu_reset, CPU(target_cpu));
        cc = 0;
        break;
1193
    default:
1194 1195 1196 1197
        DPRINTF("KVM: unknown SIGP: 0x%x\n", order_code);
        *statusreg &= 0xffffffff00000000UL;
        *statusreg |= SIGP_STAT_INVALID_ORDER;
        cc = 1;   /* status stored */
1198
        break;
A
Alexander Graf 已提交
1199 1200 1201
    }

out:
1202
    setcc(cpu, cc);
A
Alexander Graf 已提交
1203 1204 1205
    return 0;
}

1206
static int handle_instruction(S390CPU *cpu, struct kvm_run *run)
A
Alexander Graf 已提交
1207 1208 1209
{
    unsigned int ipa0 = (run->s390_sieic.ipa & 0xff00);
    uint8_t ipa1 = run->s390_sieic.ipa & 0x00ff;
1210
    int r = -1;
A
Alexander Graf 已提交
1211

1212 1213
    DPRINTF("handle_instruction 0x%x 0x%x\n",
            run->s390_sieic.ipa, run->s390_sieic.ipb);
A
Alexander Graf 已提交
1214
    switch (ipa0) {
1215
    case IPA0_B2:
1216 1217
        r = handle_b2(cpu, run, ipa1);
        break;
1218
    case IPA0_B9:
1219 1220
        r = handle_b9(cpu, run, ipa1);
        break;
1221
    case IPA0_EB:
1222
        r = handle_eb(cpu, run, run->s390_sieic.ipb & 0xff);
1223
        break;
1224 1225 1226
    case IPA0_E3:
        r = handle_e3(cpu, run, run->s390_sieic.ipb & 0xff);
        break;
1227
    case IPA0_DIAG:
C
Cornelia Huck 已提交
1228
        r = handle_diag(cpu, run, run->s390_sieic.ipb);
1229 1230 1231 1232
        break;
    case IPA0_SIGP:
        r = handle_sigp(cpu, run, ipa1);
        break;
A
Alexander Graf 已提交
1233 1234 1235
    }

    if (r < 0) {
1236
        r = 0;
1237
        enter_pgmcheck(cpu, 0x0001);
A
Alexander Graf 已提交
1238
    }
1239 1240

    return r;
A
Alexander Graf 已提交
1241 1242
}

A
Andreas Färber 已提交
1243
static bool is_special_wait_psw(CPUState *cs)
1244 1245
{
    /* signal quiesce */
A
Andreas Färber 已提交
1246
    return cs->kvm_run->psw_addr == 0xfffUL;
1247 1248
}

1249 1250
static void guest_panicked(void)
{
W
Wenchao Xia 已提交
1251 1252
    qapi_event_send_guest_panicked(GUEST_PANIC_ACTION_PAUSE,
                                   &error_abort);
1253 1254 1255 1256 1257 1258 1259 1260 1261 1262
    vm_stop(RUN_STATE_GUEST_PANICKED);
}

static void unmanageable_intercept(S390CPU *cpu, const char *str, int pswoffset)
{
    CPUState *cs = CPU(cpu);

    error_report("Unmanageable %s! CPU%i new PSW: 0x%016lx:%016lx",
                 str, cs->cpu_index, ldq_phys(cs->as, cpu->env.psa + pswoffset),
                 ldq_phys(cs->as, cpu->env.psa + pswoffset + 8));
1263
    s390_cpu_halt(cpu);
1264 1265 1266
    guest_panicked();
}

1267
static int handle_intercept(S390CPU *cpu)
A
Alexander Graf 已提交
1268
{
A
Andreas Färber 已提交
1269 1270
    CPUState *cs = CPU(cpu);
    struct kvm_run *run = cs->kvm_run;
A
Alexander Graf 已提交
1271 1272 1273
    int icpt_code = run->s390_sieic.icptcode;
    int r = 0;

1274
    DPRINTF("intercept: 0x%x (at 0x%lx)\n", icpt_code,
A
Andreas Färber 已提交
1275
            (long)cs->kvm_run->psw_addr);
A
Alexander Graf 已提交
1276 1277
    switch (icpt_code) {
        case ICPT_INSTRUCTION:
1278
            r = handle_instruction(cpu, run);
A
Alexander Graf 已提交
1279
            break;
1280 1281 1282 1283 1284
        case ICPT_PROGRAM:
            unmanageable_intercept(cpu, "program interrupt",
                                   offsetof(LowCore, program_new_psw));
            r = EXCP_HALTED;
            break;
1285 1286 1287 1288 1289
        case ICPT_EXT_INT:
            unmanageable_intercept(cpu, "external interrupt",
                                   offsetof(LowCore, external_new_psw));
            r = EXCP_HALTED;
            break;
A
Alexander Graf 已提交
1290
        case ICPT_WAITPSW:
1291
            /* disabled wait, since enabled wait is handled in kernel */
1292 1293
            cpu_synchronize_state(cs);
            if (s390_cpu_halt(cpu) == 0) {
1294 1295 1296
                if (is_special_wait_psw(cs)) {
                    qemu_system_shutdown_request();
                } else {
1297
                    guest_panicked();
1298
                }
1299 1300 1301
            }
            r = EXCP_HALTED;
            break;
1302
        case ICPT_CPU_STOP:
1303
            if (s390_cpu_set_state(CPU_STATE_STOPPED, cpu) == 0) {
1304 1305 1306
                qemu_system_shutdown_request();
            }
            r = EXCP_HALTED;
A
Alexander Graf 已提交
1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324
            break;
        case ICPT_SOFT_INTERCEPT:
            fprintf(stderr, "KVM unimplemented icpt SOFT\n");
            exit(1);
            break;
        case ICPT_IO:
            fprintf(stderr, "KVM unimplemented icpt IO\n");
            exit(1);
            break;
        default:
            fprintf(stderr, "Unknown intercept code: %d\n", icpt_code);
            exit(1);
            break;
    }

    return r;
}

1325 1326 1327 1328 1329 1330 1331
static int handle_tsch(S390CPU *cpu)
{
    CPUS390XState *env = &cpu->env;
    CPUState *cs = CPU(cpu);
    struct kvm_run *run = cs->kvm_run;
    int ret;

1332
    cpu_synchronize_state(cs);
1333

1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344
    ret = ioinst_handle_tsch(env, env->regs[1], run->s390_tsch.ipb);
    if (ret >= 0) {
        /* Success; set condition code. */
        setcc(cpu, ret);
        ret = 0;
    } else if (ret < -1) {
        /*
         * Failure.
         * If an I/O interrupt had been dequeued, we have to reinject it.
         */
        if (run->s390_tsch.dequeued) {
1345 1346 1347 1348
            kvm_s390_io_interrupt(run->s390_tsch.subchannel_id,
                                  run->s390_tsch.subchannel_nr,
                                  run->s390_tsch.io_int_parm,
                                  run->s390_tsch.io_int_word);
1349 1350 1351 1352 1353 1354
        }
        ret = 0;
    }
    return ret;
}

1355 1356
static int kvm_arch_handle_debug_exit(S390CPU *cpu)
{
1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386
    CPUState *cs = CPU(cpu);
    struct kvm_run *run = cs->kvm_run;

    int ret = 0;
    struct kvm_debug_exit_arch *arch_info = &run->debug.arch;

    switch (arch_info->type) {
    case KVM_HW_WP_WRITE:
        if (find_hw_breakpoint(arch_info->addr, -1, arch_info->type)) {
            cs->watchpoint_hit = &hw_watchpoint;
            hw_watchpoint.vaddr = arch_info->addr;
            hw_watchpoint.flags = BP_MEM_WRITE;
            ret = EXCP_DEBUG;
        }
        break;
    case KVM_HW_BP:
        if (find_hw_breakpoint(arch_info->addr, -1, arch_info->type)) {
            ret = EXCP_DEBUG;
        }
        break;
    case KVM_SINGLESTEP:
        if (cs->singlestep_enabled) {
            ret = EXCP_DEBUG;
        }
        break;
    default:
        ret = -ENOSYS;
    }

    return ret;
1387 1388
}

A
Andreas Färber 已提交
1389
int kvm_arch_handle_exit(CPUState *cs, struct kvm_run *run)
A
Alexander Graf 已提交
1390
{
A
Andreas Färber 已提交
1391
    S390CPU *cpu = S390_CPU(cs);
A
Alexander Graf 已提交
1392 1393 1394 1395
    int ret = 0;

    switch (run->exit_reason) {
        case KVM_EXIT_S390_SIEIC:
1396
            ret = handle_intercept(cpu);
A
Alexander Graf 已提交
1397 1398
            break;
        case KVM_EXIT_S390_RESET:
1399
            qemu_system_reset_request();
A
Alexander Graf 已提交
1400
            break;
1401 1402 1403
        case KVM_EXIT_S390_TSCH:
            ret = handle_tsch(cpu);
            break;
1404 1405 1406
        case KVM_EXIT_DEBUG:
            ret = kvm_arch_handle_debug_exit(cpu);
            break;
A
Alexander Graf 已提交
1407 1408 1409 1410 1411
        default:
            fprintf(stderr, "Unknown KVM exit: %d\n", run->exit_reason);
            break;
    }

1412 1413 1414
    if (ret == 0) {
        ret = EXCP_INTERRUPT;
    }
A
Alexander Graf 已提交
1415 1416
    return ret;
}
1417

A
Andreas Färber 已提交
1418
bool kvm_arch_stop_on_emulation_error(CPUState *cpu)
1419 1420 1421
{
    return true;
}
1422

A
Andreas Färber 已提交
1423
int kvm_arch_on_sigbus_vcpu(CPUState *cpu, int code, void *addr)
1424 1425 1426 1427 1428 1429 1430 1431
{
    return 1;
}

int kvm_arch_on_sigbus(int code, void *addr)
{
    return 1;
}
1432

1433
void kvm_s390_io_interrupt(uint16_t subchannel_id,
1434 1435 1436
                           uint16_t subchannel_nr, uint32_t io_int_parm,
                           uint32_t io_int_word)
{
1437 1438 1439 1440 1441 1442
    struct kvm_s390_irq irq = {
        .u.io.subchannel_id = subchannel_id,
        .u.io.subchannel_nr = subchannel_nr,
        .u.io.io_int_parm = io_int_parm,
        .u.io.io_int_word = io_int_word,
    };
1443

1444
    if (io_int_word & IO_INT_WORD_AI) {
1445
        irq.type = KVM_S390_INT_IO(1, 0, 0, 0);
1446
    } else {
1447
        irq.type = ((subchannel_id & 0xff00) << 24) |
1448 1449
            ((subchannel_id & 0x00060) << 22) | (subchannel_nr << 16);
    }
1450
    kvm_s390_floating_interrupt(&irq);
1451 1452
}

1453
void kvm_s390_crw_mchk(void)
1454
{
1455 1456 1457
    struct kvm_s390_irq irq = {
        .type = KVM_S390_MCHK,
        .u.mchk.cr14 = 1 << 28,
T
Thomas Huth 已提交
1458
        .u.mchk.mcic = 0x00400f1d40330000ULL,
1459 1460
    };
    kvm_s390_floating_interrupt(&irq);
1461 1462 1463 1464 1465 1466 1467
}

void kvm_s390_enable_css_support(S390CPU *cpu)
{
    int r;

    /* Activate host kernel channel subsystem support. */
C
Cornelia Huck 已提交
1468
    r = kvm_vcpu_enable_cap(CPU(cpu), KVM_CAP_S390_CSS_SUPPORT, 0);
1469 1470
    assert(r == 0);
}
1471 1472 1473

void kvm_arch_init_irq_routing(KVMState *s)
{
1474 1475 1476 1477 1478 1479 1480 1481 1482
    /*
     * Note that while irqchip capabilities generally imply that cpustates
     * are handled in-kernel, it is not true for s390 (yet); therefore, we
     * have to override the common code kvm_halt_in_kernel_allowed setting.
     */
    if (kvm_check_extension(s, KVM_CAP_IRQ_ROUTING)) {
        kvm_gsi_routing_allowed = true;
        kvm_halt_in_kernel_allowed = false;
    }
1483
}
C
Cornelia Huck 已提交
1484

1485 1486
int kvm_s390_assign_subch_ioeventfd(EventNotifier *notifier, uint32_t sch,
                                    int vq, bool assign)
C
Cornelia Huck 已提交
1487 1488 1489 1490
{
    struct kvm_ioeventfd kick = {
        .flags = KVM_IOEVENTFD_FLAG_VIRTIO_CCW_NOTIFY |
        KVM_IOEVENTFD_FLAG_DATAMATCH,
1491
        .fd = event_notifier_get_fd(notifier),
C
Cornelia Huck 已提交
1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503
        .datamatch = vq,
        .addr = sch,
        .len = 8,
    };
    if (!kvm_check_extension(kvm_state, KVM_CAP_IOEVENTFD)) {
        return -ENOSYS;
    }
    if (!assign) {
        kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
    }
    return kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
}
1504 1505 1506 1507 1508

int kvm_s390_get_memslot_count(KVMState *s)
{
    return kvm_check_extension(s, KVM_CAP_NR_MEMSLOTS);
}
1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546

int kvm_s390_set_cpu_state(S390CPU *cpu, uint8_t cpu_state)
{
    struct kvm_mp_state mp_state = {};
    int ret;

    /* the kvm part might not have been initialized yet */
    if (CPU(cpu)->kvm_state == NULL) {
        return 0;
    }

    switch (cpu_state) {
    case CPU_STATE_STOPPED:
        mp_state.mp_state = KVM_MP_STATE_STOPPED;
        break;
    case CPU_STATE_CHECK_STOP:
        mp_state.mp_state = KVM_MP_STATE_CHECK_STOP;
        break;
    case CPU_STATE_OPERATING:
        mp_state.mp_state = KVM_MP_STATE_OPERATING;
        break;
    case CPU_STATE_LOAD:
        mp_state.mp_state = KVM_MP_STATE_LOAD;
        break;
    default:
        error_report("Requested CPU state is not a valid S390 CPU state: %u",
                     cpu_state);
        exit(1);
    }

    ret = kvm_vcpu_ioctl(CPU(cpu), KVM_SET_MP_STATE, &mp_state);
    if (ret) {
        trace_kvm_failed_cpu_state_set(CPU(cpu)->cpu_index, cpu_state,
                                       strerror(-ret));
    }

    return ret;
}