target/mips/kvm.c

   1 /*
   2  * This file is subject to the terms and conditions of the GNU General Public
   3  * License.  See the file "COPYING" in the main directory of this archive
   4  * for more details.
   5  *
   6  * KVM/MIPS: MIPS specific KVM APIs
   7  *
   8  * Copyright (C) 2012-2014 Imagination Technologies Ltd.
   9  * Authors: Sanjay Lal <sanjayl@kymasys.com>
  10 */
  11
  12 #include "qemu/osdep.h"
  13 #include <sys/ioctl.h>
  14
  15 #include <linux/kvm.h>
  16
  17 #include "qemu-common.h"
  18 #include "cpu.h"
  19 #include "internal.h"
  20 #include "qemu/error-report.h"
  21 #include "qemu/main-loop.h"
  22 #include "sysemu/kvm.h"
  23 #include "sysemu/kvm_int.h"
  24 #include "sysemu/runstate.h"
  25 #include "kvm_mips.h"
  26 #include "hw/boards.h"
  27 #include "fpu_helper.h"
  28
  29 #define DEBUG_KVM 0
  30
  31 #define DPRINTF(fmt, ...) \
  32     do { if (DEBUG_KVM) { fprintf(stderr, fmt, ## __VA_ARGS__); } } while (0)
  33
  34 static int kvm_mips_fpu_cap;
  35 static int kvm_mips_msa_cap;
  36
  37 const KVMCapabilityInfo kvm_arch_required_capabilities[] = {
  38     KVM_CAP_LAST_INFO
  39 };
  40
  41 static void kvm_mips_update_state(void *opaque, int running, RunState state);
  42
  43 unsigned long kvm_arch_vcpu_id(CPUState *cs)
  44 {
  45     return cs->cpu_index;
  46 }
  47
  48 int kvm_arch_init(MachineState *ms, KVMState *s)
  49 {
  50     /* MIPS has 128 signals */
  51     kvm_set_sigmask_len(s, 16);
  52
  53     kvm_mips_fpu_cap = kvm_check_extension(s, KVM_CAP_MIPS_FPU);
  54     kvm_mips_msa_cap = kvm_check_extension(s, KVM_CAP_MIPS_MSA);
  55
  56     DPRINTF("%s\n", __func__);
  57     return 0;
  58 }
  59
  60 int kvm_arch_irqchip_create(KVMState *s)
  61 {
  62     return 0;
  63 }
  64
  65 int kvm_arch_init_vcpu(CPUState *cs)
  66 {
  67     MIPSCPU *cpu = MIPS_CPU(cs);
  68     CPUMIPSState *env = &cpu->env;
  69     int ret = 0;
  70
  71     qemu_add_vm_change_state_handler(kvm_mips_update_state, cs);
  72
  73     if (kvm_mips_fpu_cap && env->CP0_Config1 & (1 << CP0C1_FP)) {
  74         ret = kvm_vcpu_enable_cap(cs, KVM_CAP_MIPS_FPU, 0, 0);
  75         if (ret < 0) {
  76             /* mark unsupported so it gets disabled on reset */
  77             kvm_mips_fpu_cap = 0;
  78             ret = 0;
  79         }
  80     }
  81
  82     if (kvm_mips_msa_cap && env->CP0_Config3 & (1 << CP0C3_MSAP)) {
  83         ret = kvm_vcpu_enable_cap(cs, KVM_CAP_MIPS_MSA, 0, 0);
  84         if (ret < 0) {
  85             /* mark unsupported so it gets disabled on reset */
  86             kvm_mips_msa_cap = 0;
  87             ret = 0;
  88         }
  89     }
  90
  91     DPRINTF("%s\n", __func__);
  92     return ret;
  93 }
  94
  95 int kvm_arch_destroy_vcpu(CPUState *cs)
  96 {
  97     return 0;
  98 }
  99
 100 void kvm_mips_reset_vcpu(MIPSCPU *cpu)
 101 {
 102     CPUMIPSState *env = &cpu->env;
 103
 104     if (!kvm_mips_fpu_cap && env->CP0_Config1 & (1 << CP0C1_FP)) {
 105         warn_report("KVM does not support FPU, disabling");
 106         env->CP0_Config1 &= ~(1 << CP0C1_FP);
 107     }
 108     if (!kvm_mips_msa_cap && env->CP0_Config3 & (1 << CP0C3_MSAP)) {
 109         warn_report("KVM does not support MSA, disabling");
 110         env->CP0_Config3 &= ~(1 << CP0C3_MSAP);
 111     }
 112
 113     DPRINTF("%s\n", __func__);
 114 }
 115
 116 int kvm_arch_insert_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
 117 {
 118     DPRINTF("%s\n", __func__);
 119     return 0;
 120 }
 121
 122 int kvm_arch_remove_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp)
 123 {
 124     DPRINTF("%s\n", __func__);
 125     return 0;
 126 }
 127
 128 static inline int cpu_mips_io_interrupts_pending(MIPSCPU *cpu)
 129 {
 130     CPUMIPSState *env = &cpu->env;
 131
 132     return env->CP0_Cause & (0x1 << (2 + CP0Ca_IP));
 133 }
 134
 135
 136 void kvm_arch_pre_run(CPUState *cs, struct kvm_run *run)
 137 {
 138     MIPSCPU *cpu = MIPS_CPU(cs);
 139     int r;
 140     struct kvm_mips_interrupt intr;
 141
 142     qemu_mutex_lock_iothread();
 143
 144     if ((cs->interrupt_request & CPU_INTERRUPT_HARD) &&
 145             cpu_mips_io_interrupts_pending(cpu)) {
 146         intr.cpu = -1;
 147         intr.irq = 2;
 148         r = kvm_vcpu_ioctl(cs, KVM_INTERRUPT, &intr);
 149         if (r < 0) {
 150             error_report("%s: cpu %d: failed to inject IRQ %x",
 151                          __func__, cs->cpu_index, intr.irq);
 152         }
 153     }
 154
 155     qemu_mutex_unlock_iothread();
 156 }
 157
 158 MemTxAttrs kvm_arch_post_run(CPUState *cs, struct kvm_run *run)
 159 {
 160     return MEMTXATTRS_UNSPECIFIED;
 161 }
 162
 163 int kvm_arch_process_async_events(CPUState *cs)
 164 {
 165     return cs->halted;
 166 }
 167
 168 int kvm_arch_handle_exit(CPUState *cs, struct kvm_run *run)
 169 {
 170     int ret;
 171
 172     DPRINTF("%s\n", __func__);
 173     switch (run->exit_reason) {
 174     default:
 175         error_report("%s: unknown exit reason %d",
 176                      __func__, run->exit_reason);
 177         ret = -1;
 178         break;
 179     }
 180
 181     return ret;
 182 }
 183
 184 bool kvm_arch_stop_on_emulation_error(CPUState *cs)
 185 {
 186     DPRINTF("%s\n", __func__);
 187     return true;
 188 }
 189
 190 void kvm_arch_init_irq_routing(KVMState *s)
 191 {
 192 }
 193
 194 int kvm_mips_set_interrupt(MIPSCPU *cpu, int irq, int level)
 195 {
 196     CPUState *cs = CPU(cpu);
 197     struct kvm_mips_interrupt intr;
 198
 199     assert(kvm_enabled());
 200
 201     intr.cpu = -1;
 202
 203     if (level) {
 204         intr.irq = irq;
 205     } else {
 206         intr.irq = -irq;
 207     }
 208
 209     kvm_vcpu_ioctl(cs, KVM_INTERRUPT, &intr);
 210
 211     return 0;
 212 }
 213
 214 int kvm_mips_set_ipi_interrupt(MIPSCPU *cpu, int irq, int level)
 215 {
 216     CPUState *cs = current_cpu;
 217     CPUState *dest_cs = CPU(cpu);
 218     struct kvm_mips_interrupt intr;
 219
 220     assert(kvm_enabled());
 221
 222     intr.cpu = dest_cs->cpu_index;
 223
 224     if (level) {
 225         intr.irq = irq;
 226     } else {
 227         intr.irq = -irq;
 228     }
 229
 230     DPRINTF("%s: CPU %d, IRQ: %d\n", __func__, intr.cpu, intr.irq);
 231
 232     kvm_vcpu_ioctl(cs, KVM_INTERRUPT, &intr);
 233
 234     return 0;
 235 }
 236
 237 #define MIPS_CP0_32(_R, _S)                                     \
 238     (KVM_REG_MIPS_CP0 | KVM_REG_SIZE_U32 | (8 * (_R) + (_S)))
 239
 240 #define MIPS_CP0_64(_R, _S)                                     \
 241     (KVM_REG_MIPS_CP0 | KVM_REG_SIZE_U64 | (8 * (_R) + (_S)))
 242
 243 #define KVM_REG_MIPS_CP0_INDEX          MIPS_CP0_32(0, 0)
 244 #define KVM_REG_MIPS_CP0_RANDOM         MIPS_CP0_32(1, 0)
 245 #define KVM_REG_MIPS_CP0_CONTEXT        MIPS_CP0_64(4, 0)
 246 #define KVM_REG_MIPS_CP0_USERLOCAL      MIPS_CP0_64(4, 2)
 247 #define KVM_REG_MIPS_CP0_PAGEMASK       MIPS_CP0_32(5, 0)
 248 #define KVM_REG_MIPS_CP0_PAGEGRAIN      MIPS_CP0_32(5, 1)
 249 #define KVM_REG_MIPS_CP0_PWBASE         MIPS_CP0_64(5, 5)
 250 #define KVM_REG_MIPS_CP0_PWFIELD        MIPS_CP0_64(5, 6)
 251 #define KVM_REG_MIPS_CP0_PWSIZE         MIPS_CP0_64(5, 7)
 252 #define KVM_REG_MIPS_CP0_WIRED          MIPS_CP0_32(6, 0)
 253 #define KVM_REG_MIPS_CP0_PWCTL          MIPS_CP0_32(6, 6)
 254 #define KVM_REG_MIPS_CP0_HWRENA         MIPS_CP0_32(7, 0)
 255 #define KVM_REG_MIPS_CP0_BADVADDR       MIPS_CP0_64(8, 0)
 256 #define KVM_REG_MIPS_CP0_COUNT          MIPS_CP0_32(9, 0)
 257 #define KVM_REG_MIPS_CP0_ENTRYHI        MIPS_CP0_64(10, 0)
 258 #define KVM_REG_MIPS_CP0_COMPARE        MIPS_CP0_32(11, 0)
 259 #define KVM_REG_MIPS_CP0_STATUS         MIPS_CP0_32(12, 0)
 260 #define KVM_REG_MIPS_CP0_CAUSE          MIPS_CP0_32(13, 0)
 261 #define KVM_REG_MIPS_CP0_EPC            MIPS_CP0_64(14, 0)
 262 #define KVM_REG_MIPS_CP0_PRID           MIPS_CP0_32(15, 0)
 263 #define KVM_REG_MIPS_CP0_EBASE          MIPS_CP0_64(15, 1)
 264 #define KVM_REG_MIPS_CP0_CONFIG         MIPS_CP0_32(16, 0)
 265 #define KVM_REG_MIPS_CP0_CONFIG1        MIPS_CP0_32(16, 1)
 266 #define KVM_REG_MIPS_CP0_CONFIG2        MIPS_CP0_32(16, 2)
 267 #define KVM_REG_MIPS_CP0_CONFIG3        MIPS_CP0_32(16, 3)
 268 #define KVM_REG_MIPS_CP0_CONFIG4        MIPS_CP0_32(16, 4)
 269 #define KVM_REG_MIPS_CP0_CONFIG5        MIPS_CP0_32(16, 5)
 270 #define KVM_REG_MIPS_CP0_CONFIG6        MIPS_CP0_32(16, 6)
 271 #define KVM_REG_MIPS_CP0_XCONTEXT       MIPS_CP0_64(20, 0)
 272 #define KVM_REG_MIPS_CP0_ERROREPC       MIPS_CP0_64(30, 0)
 273 #define KVM_REG_MIPS_CP0_KSCRATCH1      MIPS_CP0_64(31, 2)
 274 #define KVM_REG_MIPS_CP0_KSCRATCH2      MIPS_CP0_64(31, 3)
 275 #define KVM_REG_MIPS_CP0_KSCRATCH3      MIPS_CP0_64(31, 4)
 276 #define KVM_REG_MIPS_CP0_KSCRATCH4      MIPS_CP0_64(31, 5)
 277 #define KVM_REG_MIPS_CP0_KSCRATCH5      MIPS_CP0_64(31, 6)
 278 #define KVM_REG_MIPS_CP0_KSCRATCH6      MIPS_CP0_64(31, 7)
 279
 280 static inline int kvm_mips_put_one_reg(CPUState *cs, uint64_t reg_id,
 281                                        int32_t *addr)
 282 {
 283     struct kvm_one_reg cp0reg = {
 284         .id = reg_id,
 285         .addr = (uintptr_t)addr
 286     };
 287
 288     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
 289 }
 290
 291 static inline int kvm_mips_put_one_ureg(CPUState *cs, uint64_t reg_id,
 292                                         uint32_t *addr)
 293 {
 294     struct kvm_one_reg cp0reg = {
 295         .id = reg_id,
 296         .addr = (uintptr_t)addr
 297     };
 298
 299     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
 300 }
 301
 302 static inline int kvm_mips_put_one_ulreg(CPUState *cs, uint64_t reg_id,
 303                                          target_ulong *addr)
 304 {
 305     uint64_t val64 = *addr;
 306     struct kvm_one_reg cp0reg = {
 307         .id = reg_id,
 308         .addr = (uintptr_t)&val64
 309     };
 310
 311     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
 312 }
 313
 314 static inline int kvm_mips_put_one_reg64(CPUState *cs, uint64_t reg_id,
 315                                          int64_t *addr)
 316 {
 317     struct kvm_one_reg cp0reg = {
 318         .id = reg_id,
 319         .addr = (uintptr_t)addr
 320     };
 321
 322     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
 323 }
 324
 325 static inline int kvm_mips_put_one_ureg64(CPUState *cs, uint64_t reg_id,
 326                                           uint64_t *addr)
 327 {
 328     struct kvm_one_reg cp0reg = {
 329         .id = reg_id,
 330         .addr = (uintptr_t)addr
 331     };
 332
 333     return kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &cp0reg);
 334 }
 335
 336 static inline int kvm_mips_get_one_reg(CPUState *cs, uint64_t reg_id,
 337                                        int32_t *addr)
 338 {
 339     struct kvm_one_reg cp0reg = {
 340         .id = reg_id,
 341         .addr = (uintptr_t)addr
 342     };
 343
 344     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
 345 }
 346
 347 static inline int kvm_mips_get_one_ureg(CPUState *cs, uint64_t reg_id,
 348                                         uint32_t *addr)
 349 {
 350     struct kvm_one_reg cp0reg = {
 351         .id = reg_id,
 352         .addr = (uintptr_t)addr
 353     };
 354
 355     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
 356 }
 357
 358 static inline int kvm_mips_get_one_ulreg(CPUState *cs, uint64_t reg_id,
 359                                          target_ulong *addr)
 360 {
 361     int ret;
 362     uint64_t val64 = 0;
 363     struct kvm_one_reg cp0reg = {
 364         .id = reg_id,
 365         .addr = (uintptr_t)&val64
 366     };
 367
 368     ret = kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
 369     if (ret >= 0) {
 370         *addr = val64;
 371     }
 372     return ret;
 373 }
 374
 375 static inline int kvm_mips_get_one_reg64(CPUState *cs, uint64_t reg_id,
 376                                          int64_t *addr)
 377 {
 378     struct kvm_one_reg cp0reg = {
 379         .id = reg_id,
 380         .addr = (uintptr_t)addr
 381     };
 382
 383     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
 384 }
 385
 386 static inline int kvm_mips_get_one_ureg64(CPUState *cs, uint64_t reg_id,
 387                                           uint64_t *addr)
 388 {
 389     struct kvm_one_reg cp0reg = {
 390         .id = reg_id,
 391         .addr = (uintptr_t)addr
 392     };
 393
 394     return kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &cp0reg);
 395 }
 396
 397 #define KVM_REG_MIPS_CP0_CONFIG_MASK    (1U << CP0C0_M)
 398 #define KVM_REG_MIPS_CP0_CONFIG1_MASK   ((1U << CP0C1_M) | \
 399                                          (1U << CP0C1_FP))
 400 #define KVM_REG_MIPS_CP0_CONFIG2_MASK   (1U << CP0C2_M)
 401 #define KVM_REG_MIPS_CP0_CONFIG3_MASK   ((1U << CP0C3_M) | \
 402                                          (1U << CP0C3_MSAP))
 403 #define KVM_REG_MIPS_CP0_CONFIG4_MASK   (1U << CP0C4_M)
 404 #define KVM_REG_MIPS_CP0_CONFIG5_MASK   ((1U << CP0C5_MSAEn) | \
 405                                          (1U << CP0C5_UFE) | \
 406                                          (1U << CP0C5_FRE) | \
 407                                          (1U << CP0C5_UFR))
 408 #define KVM_REG_MIPS_CP0_CONFIG6_MASK   ((1U << CP0C6_BPPASS) | \
 409                                          (0x3fU << CP0C6_KPOS) | \
 410                                          (1U << CP0C6_KE) | \
 411                                          (1U << CP0C6_VTLBONLY) | \
 412                                          (1U << CP0C6_LASX) | \
 413                                          (1U << CP0C6_SSEN) | \
 414                                          (1U << CP0C6_DISDRTIME) | \
 415                                          (1U << CP0C6_PIXNUEN) | \
 416                                          (1U << CP0C6_SCRAND) | \
 417                                          (1U << CP0C6_LLEXCEN) | \
 418                                          (1U << CP0C6_DISVC) | \
 419                                          (1U << CP0C6_VCLRU) | \
 420                                          (1U << CP0C6_DCLRU) | \
 421                                          (1U << CP0C6_PIXUEN) | \
 422                                          (1U << CP0C6_DISBLKLYEN) | \
 423                                          (1U << CP0C6_UMEMUALEN) | \
 424                                          (1U << CP0C6_SFBEN) | \
 425                                          (1U << CP0C6_FLTINT) | \
 426                                          (1U << CP0C6_VLTINT) | \
 427                                          (1U << CP0C6_DISBTB) | \
 428                                          (3U << CP0C6_STPREFCTL) | \
 429                                          (1U << CP0C6_INSTPREF) | \
 430                                          (1U << CP0C6_DATAPREF))
 431
 432 static inline int kvm_mips_change_one_reg(CPUState *cs, uint64_t reg_id,
 433                                           int32_t *addr, int32_t mask)
 434 {
 435     int err;
 436     int32_t tmp, change;
 437
 438     err = kvm_mips_get_one_reg(cs, reg_id, &tmp);
 439     if (err < 0) {
 440         return err;
 441     }
 442
 443     /* only change bits in mask */
 444     change = (*addr ^ tmp) & mask;
 445     if (!change) {
 446         return 0;
 447     }
 448
 449     tmp = tmp ^ change;
 450     return kvm_mips_put_one_reg(cs, reg_id, &tmp);
 451 }
 452
 453 /*
 454  * We freeze the KVM timer when either the VM clock is stopped or the state is
 455  * saved (the state is dirty).
 456  */
 457
 458 /*
 459  * Save the state of the KVM timer when VM clock is stopped or state is synced
 460  * to QEMU.
 461  */
 462 static int kvm_mips_save_count(CPUState *cs)
 463 {
 464     MIPSCPU *cpu = MIPS_CPU(cs);
 465     CPUMIPSState *env = &cpu->env;
 466     uint64_t count_ctl;
 467     int err, ret = 0;
 468
 469     /* freeze KVM timer */
 470     err = kvm_mips_get_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
 471     if (err < 0) {
 472         DPRINTF("%s: Failed to get COUNT_CTL (%d)\n", __func__, err);
 473         ret = err;
 474     } else if (!(count_ctl & KVM_REG_MIPS_COUNT_CTL_DC)) {
 475         count_ctl |= KVM_REG_MIPS_COUNT_CTL_DC;
 476         err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
 477         if (err < 0) {
 478             DPRINTF("%s: Failed to set COUNT_CTL.DC=1 (%d)\n", __func__, err);
 479             ret = err;
 480         }
 481     }
 482
 483     /* read CP0_Cause */
 484     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CAUSE, &env->CP0_Cause);
 485     if (err < 0) {
 486         DPRINTF("%s: Failed to get CP0_CAUSE (%d)\n", __func__, err);
 487         ret = err;
 488     }
 489
 490     /* read CP0_Count */
 491     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_COUNT, &env->CP0_Count);
 492     if (err < 0) {
 493         DPRINTF("%s: Failed to get CP0_COUNT (%d)\n", __func__, err);
 494         ret = err;
 495     }
 496
 497     return ret;
 498 }
 499
 500 /*
 501  * Restore the state of the KVM timer when VM clock is restarted or state is
 502  * synced to KVM.
 503  */
 504 static int kvm_mips_restore_count(CPUState *cs)
 505 {
 506     MIPSCPU *cpu = MIPS_CPU(cs);
 507     CPUMIPSState *env = &cpu->env;
 508     uint64_t count_ctl;
 509     int err_dc, err, ret = 0;
 510
 511     /* check the timer is frozen */
 512     err_dc = kvm_mips_get_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
 513     if (err_dc < 0) {
 514         DPRINTF("%s: Failed to get COUNT_CTL (%d)\n", __func__, err_dc);
 515         ret = err_dc;
 516     } else if (!(count_ctl & KVM_REG_MIPS_COUNT_CTL_DC)) {
 517         /* freeze timer (sets COUNT_RESUME for us) */
 518         count_ctl |= KVM_REG_MIPS_COUNT_CTL_DC;
 519         err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
 520         if (err < 0) {
 521             DPRINTF("%s: Failed to set COUNT_CTL.DC=1 (%d)\n", __func__, err);
 522             ret = err;
 523         }
 524     }
 525
 526     /* load CP0_Cause */
 527     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_CAUSE, &env->CP0_Cause);
 528     if (err < 0) {
 529         DPRINTF("%s: Failed to put CP0_CAUSE (%d)\n", __func__, err);
 530         ret = err;
 531     }
 532
 533     /* load CP0_Count */
 534     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_COUNT, &env->CP0_Count);
 535     if (err < 0) {
 536         DPRINTF("%s: Failed to put CP0_COUNT (%d)\n", __func__, err);
 537         ret = err;
 538     }
 539
 540     /* resume KVM timer */
 541     if (err_dc >= 0) {
 542         count_ctl &= ~KVM_REG_MIPS_COUNT_CTL_DC;
 543         err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_CTL, &count_ctl);
 544         if (err < 0) {
 545             DPRINTF("%s: Failed to set COUNT_CTL.DC=0 (%d)\n", __func__, err);
 546             ret = err;
 547         }
 548     }
 549
 550     return ret;
 551 }
 552
 553 /*
 554  * Handle the VM clock being started or stopped
 555  */
 556 static void kvm_mips_update_state(void *opaque, int running, RunState state)
 557 {
 558     CPUState *cs = opaque;
 559     int ret;
 560     uint64_t count_resume;
 561
 562     /*
 563      * If state is already dirty (synced to QEMU) then the KVM timer state is
 564      * already saved and can be restored when it is synced back to KVM.
 565      */
 566     if (!running) {
 567         if (!cs->vcpu_dirty) {
 568             ret = kvm_mips_save_count(cs);
 569             if (ret < 0) {
 570                 warn_report("Failed saving count");
 571             }
 572         }
 573     } else {
 574         /* Set clock restore time to now */
 575         count_resume = qemu_clock_get_ns(QEMU_CLOCK_REALTIME);
 576         ret = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_COUNT_RESUME,
 577                                       &count_resume);
 578         if (ret < 0) {
 579             warn_report("Failed setting COUNT_RESUME");
 580             return;
 581         }
 582
 583         if (!cs->vcpu_dirty) {
 584             ret = kvm_mips_restore_count(cs);
 585             if (ret < 0) {
 586                 warn_report("Failed restoring count");
 587             }
 588         }
 589     }
 590 }
 591
 592 static int kvm_mips_put_fpu_registers(CPUState *cs, int level)
 593 {
 594     MIPSCPU *cpu = MIPS_CPU(cs);
 595     CPUMIPSState *env = &cpu->env;
 596     int err, ret = 0;
 597     unsigned int i;
 598
 599     /* Only put FPU state if we're emulating a CPU with an FPU */
 600     if (env->CP0_Config1 & (1 << CP0C1_FP)) {
 601         /* FPU Control Registers */
 602         if (level == KVM_PUT_FULL_STATE) {
 603             err = kvm_mips_put_one_ureg(cs, KVM_REG_MIPS_FCR_IR,
 604                                         &env->active_fpu.fcr0);
 605             if (err < 0) {
 606                 DPRINTF("%s: Failed to put FCR_IR (%d)\n", __func__, err);
 607                 ret = err;
 608             }
 609         }
 610         err = kvm_mips_put_one_ureg(cs, KVM_REG_MIPS_FCR_CSR,
 611                                     &env->active_fpu.fcr31);
 612         if (err < 0) {
 613             DPRINTF("%s: Failed to put FCR_CSR (%d)\n", __func__, err);
 614             ret = err;
 615         }
 616
 617         /*
 618          * FPU register state is a subset of MSA vector state, so don't put FPU
 619          * registers if we're emulating a CPU with MSA.
 620          */
 621         if (!(env->CP0_Config3 & (1 << CP0C3_MSAP))) {
 622             /* Floating point registers */
 623             for (i = 0; i < 32; ++i) {
 624                 if (env->CP0_Status & (1 << CP0St_FR)) {
 625                     err = kvm_mips_put_one_ureg64(cs, KVM_REG_MIPS_FPR_64(i),
 626                                                   &env->active_fpu.fpr[i].d);
 627                 } else {
 628                     err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FPR_32(i),
 629                                     &env->active_fpu.fpr[i].w[FP_ENDIAN_IDX]);
 630                 }
 631                 if (err < 0) {
 632                     DPRINTF("%s: Failed to put FPR%u (%d)\n", __func__, i, err);
 633                     ret = err;
 634                 }
 635             }
 636         }
 637     }
 638
 639     /* Only put MSA state if we're emulating a CPU with MSA */
 640     if (env->CP0_Config3 & (1 << CP0C3_MSAP)) {
 641         /* MSA Control Registers */
 642         if (level == KVM_PUT_FULL_STATE) {
 643             err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_MSA_IR,
 644                                        &env->msair);
 645             if (err < 0) {
 646                 DPRINTF("%s: Failed to put MSA_IR (%d)\n", __func__, err);
 647                 ret = err;
 648             }
 649         }
 650         err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_MSA_CSR,
 651                                    &env->active_tc.msacsr);
 652         if (err < 0) {
 653             DPRINTF("%s: Failed to put MSA_CSR (%d)\n", __func__, err);
 654             ret = err;
 655         }
 656
 657         /* Vector registers (includes FP registers) */
 658         for (i = 0; i < 32; ++i) {
 659             /* Big endian MSA not supported by QEMU yet anyway */
 660             err = kvm_mips_put_one_reg64(cs, KVM_REG_MIPS_VEC_128(i),
 661                                          env->active_fpu.fpr[i].wr.d);
 662             if (err < 0) {
 663                 DPRINTF("%s: Failed to put VEC%u (%d)\n", __func__, i, err);
 664                 ret = err;
 665             }
 666         }
 667     }
 668
 669     return ret;
 670 }
 671
 672 static int kvm_mips_get_fpu_registers(CPUState *cs)
 673 {
 674     MIPSCPU *cpu = MIPS_CPU(cs);
 675     CPUMIPSState *env = &cpu->env;
 676     int err, ret = 0;
 677     unsigned int i;
 678
 679     /* Only get FPU state if we're emulating a CPU with an FPU */
 680     if (env->CP0_Config1 & (1 << CP0C1_FP)) {
 681         /* FPU Control Registers */
 682         err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FCR_IR,
 683                                     &env->active_fpu.fcr0);
 684         if (err < 0) {
 685             DPRINTF("%s: Failed to get FCR_IR (%d)\n", __func__, err);
 686             ret = err;
 687         }
 688         err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FCR_CSR,
 689                                     &env->active_fpu.fcr31);
 690         if (err < 0) {
 691             DPRINTF("%s: Failed to get FCR_CSR (%d)\n", __func__, err);
 692             ret = err;
 693         } else {
 694             restore_fp_status(env);
 695         }
 696
 697         /*
 698          * FPU register state is a subset of MSA vector state, so don't save FPU
 699          * registers if we're emulating a CPU with MSA.
 700          */
 701         if (!(env->CP0_Config3 & (1 << CP0C3_MSAP))) {
 702             /* Floating point registers */
 703             for (i = 0; i < 32; ++i) {
 704                 if (env->CP0_Status & (1 << CP0St_FR)) {
 705                     err = kvm_mips_get_one_ureg64(cs, KVM_REG_MIPS_FPR_64(i),
 706                                                   &env->active_fpu.fpr[i].d);
 707                 } else {
 708                     err = kvm_mips_get_one_ureg(cs, KVM_REG_MIPS_FPR_32(i),
 709                                     &env->active_fpu.fpr[i].w[FP_ENDIAN_IDX]);
 710                 }
 711                 if (err < 0) {
 712                     DPRINTF("%s: Failed to get FPR%u (%d)\n", __func__, i, err);
 713                     ret = err;
 714                 }
 715             }
 716         }
 717     }
 718
 719     /* Only get MSA state if we're emulating a CPU with MSA */
 720     if (env->CP0_Config3 & (1 << CP0C3_MSAP)) {
 721         /* MSA Control Registers */
 722         err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_MSA_IR,
 723                                    &env->msair);
 724         if (err < 0) {
 725             DPRINTF("%s: Failed to get MSA_IR (%d)\n", __func__, err);
 726             ret = err;
 727         }
 728         err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_MSA_CSR,
 729                                    &env->active_tc.msacsr);
 730         if (err < 0) {
 731             DPRINTF("%s: Failed to get MSA_CSR (%d)\n", __func__, err);
 732             ret = err;
 733         } else {
 734             restore_msa_fp_status(env);
 735         }
 736
 737         /* Vector registers (includes FP registers) */
 738         for (i = 0; i < 32; ++i) {
 739             /* Big endian MSA not supported by QEMU yet anyway */
 740             err = kvm_mips_get_one_reg64(cs, KVM_REG_MIPS_VEC_128(i),
 741                                          env->active_fpu.fpr[i].wr.d);
 742             if (err < 0) {
 743                 DPRINTF("%s: Failed to get VEC%u (%d)\n", __func__, i, err);
 744                 ret = err;
 745             }
 746         }
 747     }
 748
 749     return ret;
 750 }
 751
 752
 753 static int kvm_mips_put_cp0_registers(CPUState *cs, int level)
 754 {
 755     MIPSCPU *cpu = MIPS_CPU(cs);
 756     CPUMIPSState *env = &cpu->env;
 757     int err, ret = 0;
 758
 759     (void)level;
 760
 761     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_INDEX, &env->CP0_Index);
 762     if (err < 0) {
 763         DPRINTF("%s: Failed to put CP0_INDEX (%d)\n", __func__, err);
 764         ret = err;
 765     }
 766     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_RANDOM, &env->CP0_Random);
 767     if (err < 0) {
 768         DPRINTF("%s: Failed to put CP0_RANDOM (%d)\n", __func__, err);
 769         ret = err;
 770     }
 771     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_CONTEXT,
 772                                  &env->CP0_Context);
 773     if (err < 0) {
 774         DPRINTF("%s: Failed to put CP0_CONTEXT (%d)\n", __func__, err);
 775         ret = err;
 776     }
 777     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_USERLOCAL,
 778                                  &env->active_tc.CP0_UserLocal);
 779     if (err < 0) {
 780         DPRINTF("%s: Failed to put CP0_USERLOCAL (%d)\n", __func__, err);
 781         ret = err;
 782     }
 783     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PAGEMASK,
 784                                &env->CP0_PageMask);
 785     if (err < 0) {
 786         DPRINTF("%s: Failed to put CP0_PAGEMASK (%d)\n", __func__, err);
 787         ret = err;
 788     }
 789     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PAGEGRAIN,
 790                                &env->CP0_PageGrain);
 791     if (err < 0) {
 792         DPRINTF("%s: Failed to put CP0_PAGEGRAIN (%d)\n", __func__, err);
 793         ret = err;
 794     }
 795     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_PWBASE,
 796                                &env->CP0_PWBase);
 797     if (err < 0) {
 798         DPRINTF("%s: Failed to put CP0_PWBASE (%d)\n", __func__, err);
 799         ret = err;
 800     }
 801     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_PWFIELD,
 802                                &env->CP0_PWField);
 803     if (err < 0) {
 804         DPRINTF("%s: Failed to put CP0_PWField (%d)\n", __func__, err);
 805         ret = err;
 806     }
 807     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_PWSIZE,
 808                                &env->CP0_PWSize);
 809     if (err < 0) {
 810         DPRINTF("%s: Failed to put CP0_PWSIZE (%d)\n", __func__, err);
 811         ret = err;
 812     }
 813     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_WIRED, &env->CP0_Wired);
 814     if (err < 0) {
 815         DPRINTF("%s: Failed to put CP0_WIRED (%d)\n", __func__, err);
 816         ret = err;
 817     }
 818     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PWCTL, &env->CP0_PWCtl);
 819     if (err < 0) {
 820         DPRINTF("%s: Failed to put CP0_PWCTL (%d)\n", __func__, err);
 821         ret = err;
 822     }
 823     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_HWRENA, &env->CP0_HWREna);
 824     if (err < 0) {
 825         DPRINTF("%s: Failed to put CP0_HWRENA (%d)\n", __func__, err);
 826         ret = err;
 827     }
 828     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_BADVADDR,
 829                                  &env->CP0_BadVAddr);
 830     if (err < 0) {
 831         DPRINTF("%s: Failed to put CP0_BADVADDR (%d)\n", __func__, err);
 832         ret = err;
 833     }
 834
 835     /* If VM clock stopped then state will be restored when it is restarted */
 836     if (runstate_is_running()) {
 837         err = kvm_mips_restore_count(cs);
 838         if (err < 0) {
 839             ret = err;
 840         }
 841     }
 842
 843     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_ENTRYHI,
 844                                  &env->CP0_EntryHi);
 845     if (err < 0) {
 846         DPRINTF("%s: Failed to put CP0_ENTRYHI (%d)\n", __func__, err);
 847         ret = err;
 848     }
 849     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_COMPARE,
 850                                &env->CP0_Compare);
 851     if (err < 0) {
 852         DPRINTF("%s: Failed to put CP0_COMPARE (%d)\n", __func__, err);
 853         ret = err;
 854     }
 855     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_STATUS, &env->CP0_Status);
 856     if (err < 0) {
 857         DPRINTF("%s: Failed to put CP0_STATUS (%d)\n", __func__, err);
 858         ret = err;
 859     }
 860     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_EPC, &env->CP0_EPC);
 861     if (err < 0) {
 862         DPRINTF("%s: Failed to put CP0_EPC (%d)\n", __func__, err);
 863         ret = err;
 864     }
 865     err = kvm_mips_put_one_reg(cs, KVM_REG_MIPS_CP0_PRID, &env->CP0_PRid);
 866     if (err < 0) {
 867         DPRINTF("%s: Failed to put CP0_PRID (%d)\n", __func__, err);
 868         ret = err;
 869     }
 870     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_EBASE, &env->CP0_EBase);
 871     if (err < 0) {
 872         DPRINTF("%s: Failed to put CP0_EBASE (%d)\n", __func__, err);
 873         ret = err;
 874     }
 875     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG,
 876                                   &env->CP0_Config0,
 877                                   KVM_REG_MIPS_CP0_CONFIG_MASK);
 878     if (err < 0) {
 879         DPRINTF("%s: Failed to change CP0_CONFIG (%d)\n", __func__, err);
 880         ret = err;
 881     }
 882     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG1,
 883                                   &env->CP0_Config1,
 884                                   KVM_REG_MIPS_CP0_CONFIG1_MASK);
 885     if (err < 0) {
 886         DPRINTF("%s: Failed to change CP0_CONFIG1 (%d)\n", __func__, err);
 887         ret = err;
 888     }
 889     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG2,
 890                                   &env->CP0_Config2,
 891                                   KVM_REG_MIPS_CP0_CONFIG2_MASK);
 892     if (err < 0) {
 893         DPRINTF("%s: Failed to change CP0_CONFIG2 (%d)\n", __func__, err);
 894         ret = err;
 895     }
 896     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG3,
 897                                   &env->CP0_Config3,
 898                                   KVM_REG_MIPS_CP0_CONFIG3_MASK);
 899     if (err < 0) {
 900         DPRINTF("%s: Failed to change CP0_CONFIG3 (%d)\n", __func__, err);
 901         ret = err;
 902     }
 903     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG4,
 904                                   &env->CP0_Config4,
 905                                   KVM_REG_MIPS_CP0_CONFIG4_MASK);
 906     if (err < 0) {
 907         DPRINTF("%s: Failed to change CP0_CONFIG4 (%d)\n", __func__, err);
 908         ret = err;
 909     }
 910     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG5,
 911                                   &env->CP0_Config5,
 912                                   KVM_REG_MIPS_CP0_CONFIG5_MASK);
 913     if (err < 0) {
 914         DPRINTF("%s: Failed to change CP0_CONFIG5 (%d)\n", __func__, err);
 915         ret = err;
 916     }
 917     err = kvm_mips_change_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG6,
 918                                   &env->CP0_Config6,
 919                                   KVM_REG_MIPS_CP0_CONFIG6_MASK);
 920     if (err < 0) {
 921         DPRINTF("%s: Failed to change CP0_CONFIG6 (%d)\n", __func__, err);
 922         ret = err;
 923     }
 924     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_XCONTEXT,
 925                                  &env->CP0_XContext);
 926     if (err < 0) {
 927         DPRINTF("%s: Failed to put CP0_XCONTEXT (%d)\n", __func__, err);
 928         ret = err;
 929     }
 930     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_ERROREPC,
 931                                  &env->CP0_ErrorEPC);
 932     if (err < 0) {
 933         DPRINTF("%s: Failed to put CP0_ERROREPC (%d)\n", __func__, err);
 934         ret = err;
 935     }
 936     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH1,
 937                                  &env->CP0_KScratch[0]);
 938     if (err < 0) {
 939         DPRINTF("%s: Failed to put CP0_KSCRATCH1 (%d)\n", __func__, err);
 940         ret = err;
 941     }
 942     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH2,
 943                                  &env->CP0_KScratch[1]);
 944     if (err < 0) {
 945         DPRINTF("%s: Failed to put CP0_KSCRATCH2 (%d)\n", __func__, err);
 946         ret = err;
 947     }
 948     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH3,
 949                                  &env->CP0_KScratch[2]);
 950     if (err < 0) {
 951         DPRINTF("%s: Failed to put CP0_KSCRATCH3 (%d)\n", __func__, err);
 952         ret = err;
 953     }
 954     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH4,
 955                                  &env->CP0_KScratch[3]);
 956     if (err < 0) {
 957         DPRINTF("%s: Failed to put CP0_KSCRATCH4 (%d)\n", __func__, err);
 958         ret = err;
 959     }
 960     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH5,
 961                                  &env->CP0_KScratch[4]);
 962     if (err < 0) {
 963         DPRINTF("%s: Failed to put CP0_KSCRATCH5 (%d)\n", __func__, err);
 964         ret = err;
 965     }
 966     err = kvm_mips_put_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH6,
 967                                  &env->CP0_KScratch[5]);
 968     if (err < 0) {
 969         DPRINTF("%s: Failed to put CP0_KSCRATCH6 (%d)\n", __func__, err);
 970         ret = err;
 971     }
 972
 973     return ret;
 974 }
 975
 976 static int kvm_mips_get_cp0_registers(CPUState *cs)
 977 {
 978     MIPSCPU *cpu = MIPS_CPU(cs);
 979     CPUMIPSState *env = &cpu->env;
 980     int err, ret = 0;
 981
 982     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_INDEX, &env->CP0_Index);
 983     if (err < 0) {
 984         DPRINTF("%s: Failed to get CP0_INDEX (%d)\n", __func__, err);
 985         ret = err;
 986     }
 987     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_RANDOM, &env->CP0_Random);
 988     if (err < 0) {
 989         DPRINTF("%s: Failed to get CP0_RANDOM (%d)\n", __func__, err);
 990         ret = err;
 991     }
 992     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_CONTEXT,
 993                                  &env->CP0_Context);
 994     if (err < 0) {
 995         DPRINTF("%s: Failed to get CP0_CONTEXT (%d)\n", __func__, err);
 996         ret = err;
 997     }
 998     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_USERLOCAL,
 999                                  &env->active_tc.CP0_UserLocal);
1000     if (err < 0) {
1001         DPRINTF("%s: Failed to get CP0_USERLOCAL (%d)\n", __func__, err);
1002         ret = err;
1003     }
1004     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PAGEMASK,
1005                                &env->CP0_PageMask);
1006     if (err < 0) {
1007         DPRINTF("%s: Failed to get CP0_PAGEMASK (%d)\n", __func__, err);
1008         ret = err;
1009     }
1010     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PAGEGRAIN,
1011                                &env->CP0_PageGrain);
1012     if (err < 0) {
1013         DPRINTF("%s: Failed to get CP0_PAGEGRAIN (%d)\n", __func__, err);
1014         ret = err;
1015     }
1016     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_PWBASE,
1017                                &env->CP0_PWBase);
1018     if (err < 0) {
1019         DPRINTF("%s: Failed to get CP0_PWBASE (%d)\n", __func__, err);
1020         ret = err;
1021     }
1022     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_PWFIELD,
1023                                &env->CP0_PWField);
1024     if (err < 0) {
1025         DPRINTF("%s: Failed to get CP0_PWFIELD (%d)\n", __func__, err);
1026         ret = err;
1027     }
1028     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_PWSIZE,
1029                                &env->CP0_PWSize);
1030     if (err < 0) {
1031         DPRINTF("%s: Failed to get CP0_PWSIZE (%d)\n", __func__, err);
1032         ret = err;
1033     }
1034     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_WIRED, &env->CP0_Wired);
1035     if (err < 0) {
1036         DPRINTF("%s: Failed to get CP0_WIRED (%d)\n", __func__, err);
1037         ret = err;
1038     }
1039     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PWCTL, &env->CP0_PWCtl);
1040     if (err < 0) {
1041         DPRINTF("%s: Failed to get CP0_PWCtl (%d)\n", __func__, err);
1042         ret = err;
1043     }
1044     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_HWRENA, &env->CP0_HWREna);
1045     if (err < 0) {
1046         DPRINTF("%s: Failed to get CP0_HWRENA (%d)\n", __func__, err);
1047         ret = err;
1048     }
1049     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_BADVADDR,
1050                                  &env->CP0_BadVAddr);
1051     if (err < 0) {
1052         DPRINTF("%s: Failed to get CP0_BADVADDR (%d)\n", __func__, err);
1053         ret = err;
1054     }
1055     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_ENTRYHI,
1056                                  &env->CP0_EntryHi);
1057     if (err < 0) {
1058         DPRINTF("%s: Failed to get CP0_ENTRYHI (%d)\n", __func__, err);
1059         ret = err;
1060     }
1061     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_COMPARE,
1062                                &env->CP0_Compare);
1063     if (err < 0) {
1064         DPRINTF("%s: Failed to get CP0_COMPARE (%d)\n", __func__, err);
1065         ret = err;
1066     }
1067     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_STATUS, &env->CP0_Status);
1068     if (err < 0) {
1069         DPRINTF("%s: Failed to get CP0_STATUS (%d)\n", __func__, err);
1070         ret = err;
1071     }
1072
1073     /* If VM clock stopped then state was already saved when it was stopped */
1074     if (runstate_is_running()) {
1075         err = kvm_mips_save_count(cs);
1076         if (err < 0) {
1077             ret = err;
1078         }
1079     }
1080
1081     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_EPC, &env->CP0_EPC);
1082     if (err < 0) {
1083         DPRINTF("%s: Failed to get CP0_EPC (%d)\n", __func__, err);
1084         ret = err;
1085     }
1086     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_PRID, &env->CP0_PRid);
1087     if (err < 0) {
1088         DPRINTF("%s: Failed to get CP0_PRID (%d)\n", __func__, err);
1089         ret = err;
1090     }
1091     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_EBASE, &env->CP0_EBase);
1092     if (err < 0) {
1093         DPRINTF("%s: Failed to get CP0_EBASE (%d)\n", __func__, err);
1094         ret = err;
1095     }
1096     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG, &env->CP0_Config0);
1097     if (err < 0) {
1098         DPRINTF("%s: Failed to get CP0_CONFIG (%d)\n", __func__, err);
1099         ret = err;
1100     }
1101     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG1, &env->CP0_Config1);
1102     if (err < 0) {
1103         DPRINTF("%s: Failed to get CP0_CONFIG1 (%d)\n", __func__, err);
1104         ret = err;
1105     }
1106     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG2, &env->CP0_Config2);
1107     if (err < 0) {
1108         DPRINTF("%s: Failed to get CP0_CONFIG2 (%d)\n", __func__, err);
1109         ret = err;
1110     }
1111     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG3, &env->CP0_Config3);
1112     if (err < 0) {
1113         DPRINTF("%s: Failed to get CP0_CONFIG3 (%d)\n", __func__, err);
1114         ret = err;
1115     }
1116     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG4, &env->CP0_Config4);
1117     if (err < 0) {
1118         DPRINTF("%s: Failed to get CP0_CONFIG4 (%d)\n", __func__, err);
1119         ret = err;
1120     }
1121     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG5, &env->CP0_Config5);
1122     if (err < 0) {
1123         DPRINTF("%s: Failed to get CP0_CONFIG5 (%d)\n", __func__, err);
1124         ret = err;
1125     }
1126     err = kvm_mips_get_one_reg(cs, KVM_REG_MIPS_CP0_CONFIG6, &env->CP0_Config6);
1127     if (err < 0) {
1128         DPRINTF("%s: Failed to get CP0_CONFIG6 (%d)\n", __func__, err);
1129         ret = err;
1130     }
1131     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_XCONTEXT,
1132                                  &env->CP0_XContext);
1133     if (err < 0) {
1134         DPRINTF("%s: Failed to get CP0_XCONTEXT (%d)\n", __func__, err);
1135         ret = err;
1136     }
1137     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_ERROREPC,
1138                                  &env->CP0_ErrorEPC);
1139     if (err < 0) {
1140         DPRINTF("%s: Failed to get CP0_ERROREPC (%d)\n", __func__, err);
1141         ret = err;
1142     }
1143     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH1,
1144                                  &env->CP0_KScratch[0]);
1145     if (err < 0) {
1146         DPRINTF("%s: Failed to get CP0_KSCRATCH1 (%d)\n", __func__, err);
1147         ret = err;
1148     }
1149     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH2,
1150                                  &env->CP0_KScratch[1]);
1151     if (err < 0) {
1152         DPRINTF("%s: Failed to get CP0_KSCRATCH2 (%d)\n", __func__, err);
1153         ret = err;
1154     }
1155     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH3,
1156                                  &env->CP0_KScratch[2]);
1157     if (err < 0) {
1158         DPRINTF("%s: Failed to get CP0_KSCRATCH3 (%d)\n", __func__, err);
1159         ret = err;
1160     }
1161     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH4,
1162                                  &env->CP0_KScratch[3]);
1163     if (err < 0) {
1164         DPRINTF("%s: Failed to get CP0_KSCRATCH4 (%d)\n", __func__, err);
1165         ret = err;
1166     }
1167     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH5,
1168                                  &env->CP0_KScratch[4]);
1169     if (err < 0) {
1170         DPRINTF("%s: Failed to get CP0_KSCRATCH5 (%d)\n", __func__, err);
1171         ret = err;
1172     }
1173     err = kvm_mips_get_one_ulreg(cs, KVM_REG_MIPS_CP0_KSCRATCH6,
1174                                  &env->CP0_KScratch[5]);
1175     if (err < 0) {
1176         DPRINTF("%s: Failed to get CP0_KSCRATCH6 (%d)\n", __func__, err);
1177         ret = err;
1178     }
1179
1180     return ret;
1181 }
1182
1183 int kvm_arch_put_registers(CPUState *cs, int level)
1184 {
1185     MIPSCPU *cpu = MIPS_CPU(cs);
1186     CPUMIPSState *env = &cpu->env;
1187     struct kvm_regs regs;
1188     int ret;
1189     int i;
1190
1191     /* Set the registers based on QEMU's view of things */
1192     for (i = 0; i < 32; i++) {
1193         regs.gpr[i] = (int64_t)(target_long)env->active_tc.gpr[i];
1194     }
1195
1196     regs.hi = (int64_t)(target_long)env->active_tc.HI[0];
1197     regs.lo = (int64_t)(target_long)env->active_tc.LO[0];
1198     regs.pc = (int64_t)(target_long)env->active_tc.PC;
1199
1200     ret = kvm_vcpu_ioctl(cs, KVM_SET_REGS, &regs);
1201
1202     if (ret < 0) {
1203         return ret;
1204     }
1205
1206     ret = kvm_mips_put_cp0_registers(cs, level);
1207     if (ret < 0) {
1208         return ret;
1209     }
1210
1211     ret = kvm_mips_put_fpu_registers(cs, level);
1212     if (ret < 0) {
1213         return ret;
1214     }
1215
1216     return ret;
1217 }
1218
1219 int kvm_arch_get_registers(CPUState *cs)
1220 {
1221     MIPSCPU *cpu = MIPS_CPU(cs);
1222     CPUMIPSState *env = &cpu->env;
1223     int ret = 0;
1224     struct kvm_regs regs;
1225     int i;
1226
1227     /* Get the current register set as KVM seems it */
1228     ret = kvm_vcpu_ioctl(cs, KVM_GET_REGS, &regs);
1229
1230     if (ret < 0) {
1231         return ret;
1232     }
1233
1234     for (i = 0; i < 32; i++) {
1235         env->active_tc.gpr[i] = regs.gpr[i];
1236     }
1237
1238     env->active_tc.HI[0] = regs.hi;
1239     env->active_tc.LO[0] = regs.lo;
1240     env->active_tc.PC = regs.pc;
1241
1242     kvm_mips_get_cp0_registers(cs);
1243     kvm_mips_get_fpu_registers(cs);
1244
1245     return ret;
1246 }
1247
1248 int kvm_arch_fixup_msi_route(struct kvm_irq_routing_entry *route,
1249                              uint64_t address, uint32_t data, PCIDevice *dev)
1250 {
1251     return 0;
1252 }
1253
1254 int kvm_arch_add_msi_route_post(struct kvm_irq_routing_entry *route,
1255                                 int vector, PCIDevice *dev)
1256 {
1257     return 0;
1258 }
1259
1260 int kvm_arch_release_virq_post(int virq)
1261 {
1262     return 0;
1263 }
1264
1265 int kvm_arch_msi_data_to_gsi(uint32_t data)
1266 {
1267     abort();
1268 }
1269
1270 int mips_kvm_type(MachineState *machine, const char *vm_type)
1271 {
1272 #if defined(KVM_CAP_MIPS_VZ) || defined(KVM_CAP_MIPS_TE)
1273     int r;
1274     KVMState *s = KVM_STATE(machine->accelerator);
1275 #endif
1276
1277 #if defined(KVM_CAP_MIPS_VZ)
1278     r = kvm_check_extension(s, KVM_CAP_MIPS_VZ);
1279     if (r > 0) {
1280         return KVM_VM_MIPS_VZ;
1281     }
1282 #endif
1283
1284 #if defined(KVM_CAP_MIPS_TE)
1285     r = kvm_check_extension(s, KVM_CAP_MIPS_TE);
1286     if (r > 0) {
1287         return KVM_VM_MIPS_TE;
1288     }
1289 #endif
1290
1291     return -1;
1292 }