1e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger/* 2a53c8fab3f87c995c30ac226a03af95361243144Heiko Carstens * handling diagnose instructions 3e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * 4a53c8fab3f87c995c30ac226a03af95361243144Heiko Carstens * Copyright IBM Corp. 2008, 2011 5e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * 6e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * This program is free software; you can redistribute it and/or modify 7e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * it under the terms of the GNU General Public License (version 2 only) 8e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * as published by the Free Software Foundation. 9e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * 10e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * Author(s): Carsten Otte <cotte@de.ibm.com> 11e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger * Christian Borntraeger <borntraeger@de.ibm.com> 12e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger */ 13e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger 14e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger#include <linux/kvm.h> 15e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger#include <linux/kvm_host.h> 16deedabb2b4a68a63351a949b1abcf73fc97eb406Martin Schwidefsky#include <asm/pgalloc.h> 1710ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck#include <asm/virtio-ccw.h> 18e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger#include "kvm-s390.h" 195786fffa96ae7c3f8111e29fb62e073a45efc557Cornelia Huck#include "trace.h" 20ade38c311a0ad8c32e902fe1d0ae74d0d44bc71eCornelia Huck#include "trace-s390.h" 213c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel#include "gaccess.h" 22e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger 23388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraegerstatic int diag_release_pages(struct kvm_vcpu *vcpu) 24388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger{ 25388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger unsigned long start, end; 26fda902cb8347da121025c4079b9e87748228a27eMichael Mueller unsigned long prefix = kvm_s390_get_prefix(vcpu); 27388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger 285a32c1af56b3c74212b1de2a1d1658c303dd3516Christian Borntraeger start = vcpu->run->s.regs.gprs[(vcpu->arch.sie_block->ipa & 0xf0) >> 4]; 295a32c1af56b3c74212b1de2a1d1658c303dd3516Christian Borntraeger end = vcpu->run->s.regs.gprs[vcpu->arch.sie_block->ipa & 0xf] + 4096; 30388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger 31f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger if (start & ~PAGE_MASK || end & ~PAGE_MASK || start >= end 32388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger || start < 2 * PAGE_SIZE) 33388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION); 34388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger 35388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger VCPU_EVENT(vcpu, 5, "diag release pages %lX %lX", start, end); 36388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger vcpu->stat.diagnose_10++; 37388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger 38f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger /* 39f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger * We checked for start >= end above, so lets check for the 40f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger * fast path (no prefix swap page involved) 41f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger */ 42f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger if (end <= prefix || start >= prefix + 2 * PAGE_SIZE) { 436e0a0431bf7d90ed0b8a0a974ad219617a70cc22Martin Schwidefsky gmap_discard(vcpu->arch.gmap, start, end); 44388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger } else { 45f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger /* 46f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger * This is slow path. gmap_discard will check for start 47f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger * so lets split this into before prefix, prefix, after 48f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger * prefix and let gmap_discard make some of these calls 49f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger * NOPs. 50f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger */ 51f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger gmap_discard(vcpu->arch.gmap, start, prefix); 52f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger if (start <= prefix) 53f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger gmap_discard(vcpu->arch.gmap, 0, 4096); 54f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger if (end > prefix + 4096) 55f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger gmap_discard(vcpu->arch.gmap, 4096, 8192); 56f7a960affc6e5a33e8c7fcef065affc4f0461041Christian Borntraeger gmap_discard(vcpu->arch.gmap, prefix + 2 * PAGE_SIZE, end); 57388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger } 58388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger return 0; 59388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger} 60388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger 613c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingelstatic int __diag_page_ref_service(struct kvm_vcpu *vcpu) 623c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel{ 633c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel struct prs_parm { 643c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u16 code; 653c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u16 subcode; 663c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u16 parm_len; 673c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u16 parm_version; 683c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u64 token_addr; 693c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u64 select_mask; 703c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u64 compare_mask; 713c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u64 zarch; 723c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel }; 733c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel struct prs_parm parm; 743c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel int rc; 753c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u16 rx = (vcpu->arch.sie_block->ipa & 0xf0) >> 4; 763c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel u16 ry = (vcpu->arch.sie_block->ipa & 0x0f); 773c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 783c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel if (vcpu->run->s.regs.gprs[rx] & 7) 793c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION); 8081480cc19c56efb573c63d89c46797d34fe58f27Heiko Carstens rc = read_guest(vcpu, vcpu->run->s.regs.gprs[rx], &parm, sizeof(parm)); 8181480cc19c56efb573c63d89c46797d34fe58f27Heiko Carstens if (rc) 8281480cc19c56efb573c63d89c46797d34fe58f27Heiko Carstens return kvm_s390_inject_prog_cond(vcpu, rc); 833c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel if (parm.parm_version != 2 || parm.parm_len < 5 || parm.code != 0x258) 843c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION); 853c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 863c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel switch (parm.subcode) { 873c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel case 0: /* TOKEN */ 883c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel if (vcpu->arch.pfault_token != KVM_S390_PFAULT_TOKEN_INVALID) { 893c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel /* 903c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * If the pagefault handshake is already activated, 913c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * the token must not be changed. We have to return 923c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * decimal 8 instead, as mandated in SC24-6084. 933c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel */ 943c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->run->s.regs.gprs[ry] = 8; 953c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return 0; 963c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel } 973c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 983c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel if ((parm.compare_mask & parm.select_mask) != parm.compare_mask || 993c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel parm.token_addr & 7 || parm.zarch != 0x8000000000000000ULL) 1003c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION); 1013c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 10281480cc19c56efb573c63d89c46797d34fe58f27Heiko Carstens if (kvm_is_error_gpa(vcpu->kvm, parm.token_addr)) 1033c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING); 1043c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 1053c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->arch.pfault_token = parm.token_addr; 1063c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->arch.pfault_select = parm.select_mask; 1073c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->arch.pfault_compare = parm.compare_mask; 1083c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->run->s.regs.gprs[ry] = 0; 1093c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel rc = 0; 1103c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel break; 1113c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel case 1: /* 1123c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * CANCEL 1133c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * Specification allows to let already pending tokens survive 1143c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * the cancel, therefore to reduce code complexity, we assume 1153c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * all outstanding tokens are already pending. 1163c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel */ 1173c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel if (parm.token_addr || parm.select_mask || 1183c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel parm.compare_mask || parm.zarch) 1193c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION); 1203c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 1213c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->run->s.regs.gprs[ry] = 0; 1223c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel /* 1233c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * If the pfault handling was not established or is already 1243c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel * canceled SC24-6084 requests to return decimal 4. 1253c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel */ 1263c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel if (vcpu->arch.pfault_token == KVM_S390_PFAULT_TOKEN_INVALID) 1273c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->run->s.regs.gprs[ry] = 4; 1283c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel else 1293c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel vcpu->arch.pfault_token = KVM_S390_PFAULT_TOKEN_INVALID; 1303c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 1313c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel rc = 0; 1323c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel break; 1333c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel default: 1343c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel rc = -EOPNOTSUPP; 1353c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel break; 1363c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel } 1373c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 1383c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return rc; 1393c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel} 1403c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel 141e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraegerstatic int __diag_time_slice_end(struct kvm_vcpu *vcpu) 142e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger{ 143e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger VCPU_EVENT(vcpu, 5, "%s", "diag time slice end"); 144e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->stat.diagnose_44++; 1458733ac36fc37fe055a7d7daadf5451b4231f0214Christian Borntraeger kvm_vcpu_on_spin(vcpu); 146e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger return 0; 147e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger} 148e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger 14941628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitzstatic int __diag_time_slice_end_directed(struct kvm_vcpu *vcpu) 15041628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz{ 15141628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz struct kvm *kvm = vcpu->kvm; 15241628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz struct kvm_vcpu *tcpu; 15341628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz int tid; 15441628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz int i; 15541628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz 15641628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz tid = vcpu->run->s.regs.gprs[(vcpu->arch.sie_block->ipa & 0xf0) >> 4]; 15741628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz vcpu->stat.diagnose_9c++; 15841628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz VCPU_EVENT(vcpu, 5, "diag time slice end directed to %d", tid); 15941628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz 16041628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz if (tid == vcpu->vcpu_id) 16141628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz return 0; 16241628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz 16341628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz kvm_for_each_vcpu(i, tcpu, kvm) 16441628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz if (tcpu->vcpu_id == tid) { 16541628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz kvm_vcpu_yield_to(tcpu); 16641628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz break; 16741628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz } 16841628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz 16941628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz return 0; 17041628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz} 17141628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz 172e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraegerstatic int __diag_ipl_functions(struct kvm_vcpu *vcpu) 173e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger{ 174e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger unsigned int reg = vcpu->arch.sie_block->ipa & 0xf; 1755a32c1af56b3c74212b1de2a1d1658c303dd3516Christian Borntraeger unsigned long subcode = vcpu->run->s.regs.gprs[reg] & 0xffff; 176e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger 177e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger VCPU_EVENT(vcpu, 5, "diag ipl functions, subcode %lx", subcode); 178e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger switch (subcode) { 179e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger case 3: 180e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->run->s390_reset_flags = KVM_S390_RESET_CLEAR; 181e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger break; 182e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger case 4: 183e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->run->s390_reset_flags = 0; 184e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger break; 185e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger default: 186b8e660b83d505148c83ddc6d5ba69c29d0eab1e3Heiko Carstens return -EOPNOTSUPP; 187e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger } 188e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger 1896352e4d2dd9a349024a41356148eced553e1dce4David Hildenbrand if (!kvm_s390_user_cpu_state_ctrl(vcpu->kvm)) 1906352e4d2dd9a349024a41356148eced553e1dce4David Hildenbrand kvm_s390_vcpu_stop(vcpu); 191e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->run->s390_reset_flags |= KVM_S390_RESET_SUBSYSTEM; 192e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->run->s390_reset_flags |= KVM_S390_RESET_IPL; 193e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->run->s390_reset_flags |= KVM_S390_RESET_CPU_INIT; 194e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->run->exit_reason = KVM_EXIT_S390_RESET; 19533e1911566183ac32baac35163c0962302e40f5fHeiko Carstens VCPU_EVENT(vcpu, 3, "requesting userspace resets %llx", 196e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger vcpu->run->s390_reset_flags); 197ade38c311a0ad8c32e902fe1d0ae74d0d44bc71eCornelia Huck trace_kvm_s390_request_resets(vcpu->run->s390_reset_flags); 198e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger return -EREMOTE; 199e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger} 200e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger 20110ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huckstatic int __diag_virtio_hypercall(struct kvm_vcpu *vcpu) 20210ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck{ 203800c1065c3207a1b04d4ac457a57a37ce19eeb21Thomas Huth int ret; 20410ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck 20510ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck /* No virtio-ccw notification? Get out quickly. */ 20610ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck if (!vcpu->kvm->arch.css_support || 20710ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck (vcpu->run->s.regs.gprs[1] != KVM_S390_VIRTIO_CCW_NOTIFY)) 20810ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck return -EOPNOTSUPP; 20910ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck 21010ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck /* 21110ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck * The layout is as follows: 21210ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck * - gpr 2 contains the subchannel id (passed as addr) 21310ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck * - gpr 3 contains the virtqueue index (passed as datamatch) 21485dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck * - gpr 4 contains the index on the bus (optionally) 21510ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck */ 21685dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck ret = kvm_io_bus_write_cookie(vcpu->kvm, KVM_VIRTIO_CCW_NOTIFY_BUS, 217ff1f3cb4b3ac5d039f02679f34cb1498d110d241Dominik Dingel vcpu->run->s.regs.gprs[2] & 0xffffffff, 21885dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck 8, &vcpu->run->s.regs.gprs[3], 21985dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck vcpu->run->s.regs.gprs[4]); 22085dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck 22185dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck /* 22285dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck * Return cookie in gpr 2, but don't overwrite the register if the 22385dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck * diagnose will be handled by userspace. 22485dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck */ 22585dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck if (ret != -EOPNOTSUPP) 22685dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck vcpu->run->s.regs.gprs[2] = ret; 22785dfe87e24326c472454cc92313ba8c3b4efe53bCornelia Huck /* kvm_io_bus_write_cookie returns -EOPNOTSUPP if it found no match. */ 22810ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck return ret < 0 ? ret : 0; 22910ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck} 23010ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck 231e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraegerint kvm_s390_handle_diag(struct kvm_vcpu *vcpu) 232e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger{ 233743db27c526e0f31cc507959d662e97e2048a86fHeiko Carstens int code = kvm_s390_get_base_disp_rs(vcpu) & 0xffff; 234e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger 23593e1750f5ee8417e015bcb0bf2c37bf07b5ff647Thomas Huth if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE) 23693e1750f5ee8417e015bcb0bf2c37bf07b5ff647Thomas Huth return kvm_s390_inject_program_int(vcpu, PGM_PRIVILEGED_OP); 23793e1750f5ee8417e015bcb0bf2c37bf07b5ff647Thomas Huth 2385786fffa96ae7c3f8111e29fb62e073a45efc557Cornelia Huck trace_kvm_s390_handle_diag(vcpu, code); 239e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger switch (code) { 240388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger case 0x10: 241388186bc920d9200202e4d25de66fa95b1b8fc68Christian Borntraeger return diag_release_pages(vcpu); 242e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger case 0x44: 243e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger return __diag_time_slice_end(vcpu); 24441628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz case 0x9c: 24541628d334361670d825fb03c04568f5ef9f084dcKonstantin Weitz return __diag_time_slice_end_directed(vcpu); 2463c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel case 0x258: 2473c038e6be0e299d4d3762d0a9a29f02de6e04991Dominik Dingel return __diag_page_ref_service(vcpu); 248e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger case 0x308: 249e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger return __diag_ipl_functions(vcpu); 25010ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck case 0x500: 25110ccaa1e7057d8a9dc3e9ce833af40ec8187b25eCornelia Huck return __diag_virtio_hypercall(vcpu); 252e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger default: 253b8e660b83d505148c83ddc6d5ba69c29d0eab1e3Heiko Carstens return -EOPNOTSUPP; 254e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger } 255e28acfea5dd9dbc67c2594cbefc140129dbd0e3fChristian Borntraeger} 256