arch/s390/kvm/gaccess.c

   1 /*
   2  * guest access functions
   3  *
   4  * Copyright IBM Corp. 2014
   5  *
   6  */
   7
   8 #include <linux/vmalloc.h>
   9 #include <linux/err.h>
  10 #include <asm/pgtable.h>
  11 #include "kvm-s390.h"
  12 #include "gaccess.h"
  13 #include <asm/switch_to.h>
  14
  15 union asce {
  16         unsigned long val;
  17         struct {
  18                 unsigned long origin : 52; /* Region- or Segment-Table Origin */
  19                 unsigned long    : 2;
  20                 unsigned long g  : 1; /* Subspace Group Control */
  21                 unsigned long p  : 1; /* Private Space Control */
  22                 unsigned long s  : 1; /* Storage-Alteration-Event Control */
  23                 unsigned long x  : 1; /* Space-Switch-Event Control */
  24                 unsigned long r  : 1; /* Real-Space Control */
  25                 unsigned long    : 1;
  26                 unsigned long dt : 2; /* Designation-Type Control */
  27                 unsigned long tl : 2; /* Region- or Segment-Table Length */
  28         };
  29 };
  30
  31 enum {
  32         ASCE_TYPE_SEGMENT = 0,
  33         ASCE_TYPE_REGION3 = 1,
  34         ASCE_TYPE_REGION2 = 2,
  35         ASCE_TYPE_REGION1 = 3
  36 };
  37
  38 union region1_table_entry {
  39         unsigned long val;
  40         struct {
  41                 unsigned long rto: 52;/* Region-Table Origin */
  42                 unsigned long    : 2;
  43                 unsigned long p  : 1; /* DAT-Protection Bit */
  44                 unsigned long    : 1;
  45                 unsigned long tf : 2; /* Region-Second-Table Offset */
  46                 unsigned long i  : 1; /* Region-Invalid Bit */
  47                 unsigned long    : 1;
  48                 unsigned long tt : 2; /* Table-Type Bits */
  49                 unsigned long tl : 2; /* Region-Second-Table Length */
  50         };
  51 };
  52
  53 union region2_table_entry {
  54         unsigned long val;
  55         struct {
  56                 unsigned long rto: 52;/* Region-Table Origin */
  57                 unsigned long    : 2;
  58                 unsigned long p  : 1; /* DAT-Protection Bit */
  59                 unsigned long    : 1;
  60                 unsigned long tf : 2; /* Region-Third-Table Offset */
  61                 unsigned long i  : 1; /* Region-Invalid Bit */
  62                 unsigned long    : 1;
  63                 unsigned long tt : 2; /* Table-Type Bits */
  64                 unsigned long tl : 2; /* Region-Third-Table Length */
  65         };
  66 };
  67
  68 struct region3_table_entry_fc0 {
  69         unsigned long sto: 52;/* Segment-Table Origin */
  70         unsigned long    : 1;
  71         unsigned long fc : 1; /* Format-Control */
  72         unsigned long p  : 1; /* DAT-Protection Bit */
  73         unsigned long    : 1;
  74         unsigned long tf : 2; /* Segment-Table Offset */
  75         unsigned long i  : 1; /* Region-Invalid Bit */
  76         unsigned long cr : 1; /* Common-Region Bit */
  77         unsigned long tt : 2; /* Table-Type Bits */
  78         unsigned long tl : 2; /* Segment-Table Length */
  79 };
  80
  81 struct region3_table_entry_fc1 {
  82         unsigned long rfaa : 33; /* Region-Frame Absolute Address */
  83         unsigned long    : 14;
  84         unsigned long av : 1; /* ACCF-Validity Control */
  85         unsigned long acc: 4; /* Access-Control Bits */
  86         unsigned long f  : 1; /* Fetch-Protection Bit */
  87         unsigned long fc : 1; /* Format-Control */
  88         unsigned long p  : 1; /* DAT-Protection Bit */
  89         unsigned long co : 1; /* Change-Recording Override */
  90         unsigned long    : 2;
  91         unsigned long i  : 1; /* Region-Invalid Bit */
  92         unsigned long cr : 1; /* Common-Region Bit */
  93         unsigned long tt : 2; /* Table-Type Bits */
  94         unsigned long    : 2;
  95 };
  96
  97 union region3_table_entry {
  98         unsigned long val;
  99         struct region3_table_entry_fc0 fc0;
 100         struct region3_table_entry_fc1 fc1;
 101         struct {
 102                 unsigned long    : 53;
 103                 unsigned long fc : 1; /* Format-Control */
 104                 unsigned long    : 4;
 105                 unsigned long i  : 1; /* Region-Invalid Bit */
 106                 unsigned long cr : 1; /* Common-Region Bit */
 107                 unsigned long tt : 2; /* Table-Type Bits */
 108                 unsigned long    : 2;
 109         };
 110 };
 111
 112 struct segment_entry_fc0 {
 113         unsigned long pto: 53;/* Page-Table Origin */
 114         unsigned long fc : 1; /* Format-Control */
 115         unsigned long p  : 1; /* DAT-Protection Bit */
 116         unsigned long    : 3;
 117         unsigned long i  : 1; /* Segment-Invalid Bit */
 118         unsigned long cs : 1; /* Common-Segment Bit */
 119         unsigned long tt : 2; /* Table-Type Bits */
 120         unsigned long    : 2;
 121 };
 122
 123 struct segment_entry_fc1 {
 124         unsigned long sfaa : 44; /* Segment-Frame Absolute Address */
 125         unsigned long    : 3;
 126         unsigned long av : 1; /* ACCF-Validity Control */
 127         unsigned long acc: 4; /* Access-Control Bits */
 128         unsigned long f  : 1; /* Fetch-Protection Bit */
 129         unsigned long fc : 1; /* Format-Control */
 130         unsigned long p  : 1; /* DAT-Protection Bit */
 131         unsigned long co : 1; /* Change-Recording Override */
 132         unsigned long    : 2;
 133         unsigned long i  : 1; /* Segment-Invalid Bit */
 134         unsigned long cs : 1; /* Common-Segment Bit */
 135         unsigned long tt : 2; /* Table-Type Bits */
 136         unsigned long    : 2;
 137 };
 138
 139 union segment_table_entry {
 140         unsigned long val;
 141         struct segment_entry_fc0 fc0;
 142         struct segment_entry_fc1 fc1;
 143         struct {
 144                 unsigned long    : 53;
 145                 unsigned long fc : 1; /* Format-Control */
 146                 unsigned long    : 4;
 147                 unsigned long i  : 1; /* Segment-Invalid Bit */
 148                 unsigned long cs : 1; /* Common-Segment Bit */
 149                 unsigned long tt : 2; /* Table-Type Bits */
 150                 unsigned long    : 2;
 151         };
 152 };
 153
 154 enum {
 155         TABLE_TYPE_SEGMENT = 0,
 156         TABLE_TYPE_REGION3 = 1,
 157         TABLE_TYPE_REGION2 = 2,
 158         TABLE_TYPE_REGION1 = 3
 159 };
 160
 161 union page_table_entry {
 162         unsigned long val;
 163         struct {
 164                 unsigned long pfra : 52; /* Page-Frame Real Address */
 165                 unsigned long z  : 1; /* Zero Bit */
 166                 unsigned long i  : 1; /* Page-Invalid Bit */
 167                 unsigned long p  : 1; /* DAT-Protection Bit */
 168                 unsigned long co : 1; /* Change-Recording Override */
 169                 unsigned long    : 8;
 170         };
 171 };
 172
 173 /*
 174  * vaddress union in order to easily decode a virtual address into its
 175  * region first index, region second index etc. parts.
 176  */
 177 union vaddress {
 178         unsigned long addr;
 179         struct {
 180                 unsigned long rfx : 11;
 181                 unsigned long rsx : 11;
 182                 unsigned long rtx : 11;
 183                 unsigned long sx  : 11;
 184                 unsigned long px  : 8;
 185                 unsigned long bx  : 12;
 186         };
 187         struct {
 188                 unsigned long rfx01 : 2;
 189                 unsigned long       : 9;
 190                 unsigned long rsx01 : 2;
 191                 unsigned long       : 9;
 192                 unsigned long rtx01 : 2;
 193                 unsigned long       : 9;
 194                 unsigned long sx01  : 2;
 195                 unsigned long       : 29;
 196         };
 197 };
 198
 199 /*
 200  * raddress union which will contain the result (real or absolute address)
 201  * after a page table walk. The rfaa, sfaa and pfra members are used to
 202  * simply assign them the value of a region, segment or page table entry.
 203  */
 204 union raddress {
 205         unsigned long addr;
 206         unsigned long rfaa : 33; /* Region-Frame Absolute Address */
 207         unsigned long sfaa : 44; /* Segment-Frame Absolute Address */
 208         unsigned long pfra : 52; /* Page-Frame Real Address */
 209 };
 210
 211 union alet {
 212         u32 val;
 213         struct {
 214                 u32 reserved : 7;
 215                 u32 p        : 1;
 216                 u32 alesn    : 8;
 217                 u32 alen     : 16;
 218         };
 219 };
 220
 221 union ald {
 222         u32 val;
 223         struct {
 224                 u32     : 1;
 225                 u32 alo : 24;
 226                 u32 all : 7;
 227         };
 228 };
 229
 230 struct ale {
 231         unsigned long i      : 1; /* ALEN-Invalid Bit */
 232         unsigned long        : 5;
 233         unsigned long fo     : 1; /* Fetch-Only Bit */
 234         unsigned long p      : 1; /* Private Bit */
 235         unsigned long alesn  : 8; /* Access-List-Entry Sequence Number */
 236         unsigned long aleax  : 16; /* Access-List-Entry Authorization Index */
 237         unsigned long        : 32;
 238         unsigned long        : 1;
 239         unsigned long asteo  : 25; /* ASN-Second-Table-Entry Origin */
 240         unsigned long        : 6;
 241         unsigned long astesn : 32; /* ASTE Sequence Number */
 242 } __packed;
 243
 244 struct aste {
 245         unsigned long i      : 1; /* ASX-Invalid Bit */
 246         unsigned long ato    : 29; /* Authority-Table Origin */
 247         unsigned long        : 1;
 248         unsigned long b      : 1; /* Base-Space Bit */
 249         unsigned long ax     : 16; /* Authorization Index */
 250         unsigned long atl    : 12; /* Authority-Table Length */
 251         unsigned long        : 2;
 252         unsigned long ca     : 1; /* Controlled-ASN Bit */
 253         unsigned long ra     : 1; /* Reusable-ASN Bit */
 254         unsigned long asce   : 64; /* Address-Space-Control Element */
 255         unsigned long ald    : 32;
 256         unsigned long astesn : 32;
 257         /* .. more fields there */
 258 } __packed;
 259
 260 int ipte_lock_held(struct kvm_vcpu *vcpu)
 261 {
 262         if (vcpu->arch.sie_block->eca & 1) {
 263                 int rc;
 264
 265                 read_lock(&vcpu->kvm->arch.sca_lock);
 266                 rc = kvm_s390_get_ipte_control(vcpu->kvm)->kh != 0;
 267                 read_unlock(&vcpu->kvm->arch.sca_lock);
 268                 return rc;
 269         }
 270         return vcpu->kvm->arch.ipte_lock_count != 0;
 271 }
 272
 273 static void ipte_lock_simple(struct kvm_vcpu *vcpu)
 274 {
 275         union ipte_control old, new, *ic;
 276
 277         mutex_lock(&vcpu->kvm->arch.ipte_mutex);
 278         vcpu->kvm->arch.ipte_lock_count++;
 279         if (vcpu->kvm->arch.ipte_lock_count > 1)
 280                 goto out;
 281 retry:
 282         read_lock(&vcpu->kvm->arch.sca_lock);
 283         ic = kvm_s390_get_ipte_control(vcpu->kvm);
 284         do {
 285                 old = READ_ONCE(*ic);
 286                 if (old.k) {
 287                         read_unlock(&vcpu->kvm->arch.sca_lock);
 288                         cond_resched();
 289                         goto retry;
 290                 }
 291                 new = old;
 292                 new.k = 1;
 293         } while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 294         read_unlock(&vcpu->kvm->arch.sca_lock);
 295 out:
 296         mutex_unlock(&vcpu->kvm->arch.ipte_mutex);
 297 }
 298
 299 static void ipte_unlock_simple(struct kvm_vcpu *vcpu)
 300 {
 301         union ipte_control old, new, *ic;
 302
 303         mutex_lock(&vcpu->kvm->arch.ipte_mutex);
 304         vcpu->kvm->arch.ipte_lock_count--;
 305         if (vcpu->kvm->arch.ipte_lock_count)
 306                 goto out;
 307         read_lock(&vcpu->kvm->arch.sca_lock);
 308         ic = kvm_s390_get_ipte_control(vcpu->kvm);
 309         do {
 310                 old = READ_ONCE(*ic);
 311                 new = old;
 312                 new.k = 0;
 313         } while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 314         read_unlock(&vcpu->kvm->arch.sca_lock);
 315         wake_up(&vcpu->kvm->arch.ipte_wq);
 316 out:
 317         mutex_unlock(&vcpu->kvm->arch.ipte_mutex);
 318 }
 319
 320 static void ipte_lock_siif(struct kvm_vcpu *vcpu)
 321 {
 322         union ipte_control old, new, *ic;
 323
 324 retry:
 325         read_lock(&vcpu->kvm->arch.sca_lock);
 326         ic = kvm_s390_get_ipte_control(vcpu->kvm);
 327         do {
 328                 old = READ_ONCE(*ic);
 329                 if (old.kg) {
 330                         read_unlock(&vcpu->kvm->arch.sca_lock);
 331                         cond_resched();
 332                         goto retry;
 333                 }
 334                 new = old;
 335                 new.k = 1;
 336                 new.kh++;
 337         } while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 338         read_unlock(&vcpu->kvm->arch.sca_lock);
 339 }
 340
 341 static void ipte_unlock_siif(struct kvm_vcpu *vcpu)
 342 {
 343         union ipte_control old, new, *ic;
 344
 345         read_lock(&vcpu->kvm->arch.sca_lock);
 346         ic = kvm_s390_get_ipte_control(vcpu->kvm);
 347         do {
 348                 old = READ_ONCE(*ic);
 349                 new = old;
 350                 new.kh--;
 351                 if (!new.kh)
 352                         new.k = 0;
 353         } while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 354         read_unlock(&vcpu->kvm->arch.sca_lock);
 355         if (!new.kh)
 356                 wake_up(&vcpu->kvm->arch.ipte_wq);
 357 }
 358
 359 void ipte_lock(struct kvm_vcpu *vcpu)
 360 {
 361         if (vcpu->arch.sie_block->eca & 1)
 362                 ipte_lock_siif(vcpu);
 363         else
 364                 ipte_lock_simple(vcpu);
 365 }
 366
 367 void ipte_unlock(struct kvm_vcpu *vcpu)
 368 {
 369         if (vcpu->arch.sie_block->eca & 1)
 370                 ipte_unlock_siif(vcpu);
 371         else
 372                 ipte_unlock_simple(vcpu);
 373 }
 374
 375 static int ar_translation(struct kvm_vcpu *vcpu, union asce *asce, ar_t ar,
 376                           enum gacc_mode mode)
 377 {
 378         union alet alet;
 379         struct ale ale;
 380         struct aste aste;
 381         unsigned long ald_addr, authority_table_addr;
 382         union ald ald;
 383         int eax, rc;
 384         u8 authority_table;
 385
 386         if (ar >= NUM_ACRS)
 387                 return -EINVAL;
 388
 389         save_access_regs(vcpu->run->s.regs.acrs);
 390         alet.val = vcpu->run->s.regs.acrs[ar];
 391
 392         if (ar == 0 || alet.val == 0) {
 393                 asce->val = vcpu->arch.sie_block->gcr[1];
 394                 return 0;
 395         } else if (alet.val == 1) {
 396                 asce->val = vcpu->arch.sie_block->gcr[7];
 397                 return 0;
 398         }
 399
 400         if (alet.reserved)
 401                 return PGM_ALET_SPECIFICATION;
 402
 403         if (alet.p)
 404                 ald_addr = vcpu->arch.sie_block->gcr[5];
 405         else
 406                 ald_addr = vcpu->arch.sie_block->gcr[2];
 407         ald_addr &= 0x7fffffc0;
 408
 409         rc = read_guest_real(vcpu, ald_addr + 16, &ald.val, sizeof(union ald));
 410         if (rc)
 411                 return rc;
 412
 413         if (alet.alen / 8 > ald.all)
 414                 return PGM_ALEN_TRANSLATION;
 415
 416         if (0x7fffffff - ald.alo * 128 < alet.alen * 16)
 417                 return PGM_ADDRESSING;
 418
 419         rc = read_guest_real(vcpu, ald.alo * 128 + alet.alen * 16, &ale,
 420                              sizeof(struct ale));
 421         if (rc)
 422                 return rc;
 423
 424         if (ale.i == 1)
 425                 return PGM_ALEN_TRANSLATION;
 426         if (ale.alesn != alet.alesn)
 427                 return PGM_ALE_SEQUENCE;
 428
 429         rc = read_guest_real(vcpu, ale.asteo * 64, &aste, sizeof(struct aste));
 430         if (rc)
 431                 return rc;
 432
 433         if (aste.i)
 434                 return PGM_ASTE_VALIDITY;
 435         if (aste.astesn != ale.astesn)
 436                 return PGM_ASTE_SEQUENCE;
 437
 438         if (ale.p == 1) {
 439                 eax = (vcpu->arch.sie_block->gcr[8] >> 16) & 0xffff;
 440                 if (ale.aleax != eax) {
 441                         if (eax / 16 > aste.atl)
 442                                 return PGM_EXTENDED_AUTHORITY;
 443
 444                         authority_table_addr = aste.ato * 4 + eax / 4;
 445
 446                         rc = read_guest_real(vcpu, authority_table_addr,
 447                                              &authority_table,
 448                                              sizeof(u8));
 449                         if (rc)
 450                                 return rc;
 451
 452                         if ((authority_table & (0x40 >> ((eax & 3) * 2))) == 0)
 453                                 return PGM_EXTENDED_AUTHORITY;
 454                 }
 455         }
 456
 457         if (ale.fo == 1 && mode == GACC_STORE)
 458                 return PGM_PROTECTION;
 459
 460         asce->val = aste.asce;
 461         return 0;
 462 }
 463
 464 struct trans_exc_code_bits {
 465         unsigned long addr : 52; /* Translation-exception Address */
 466         unsigned long fsi  : 2;  /* Access Exception Fetch/Store Indication */
 467         unsigned long      : 6;
 468         unsigned long b60  : 1;
 469         unsigned long b61  : 1;
 470         unsigned long as   : 2;  /* ASCE Identifier */
 471 };
 472
 473 enum {
 474         FSI_UNKNOWN = 0, /* Unknown wether fetch or store */
 475         FSI_STORE   = 1, /* Exception was due to store operation */
 476         FSI_FETCH   = 2  /* Exception was due to fetch operation */
 477 };
 478
 479 enum prot_type {
 480         PROT_TYPE_LA   = 0,
 481         PROT_TYPE_KEYC = 1,
 482         PROT_TYPE_ALC  = 2,
 483         PROT_TYPE_DAT  = 3,
 484 };
 485
 486 static int trans_exc(struct kvm_vcpu *vcpu, int code, unsigned long gva,
 487                      ar_t ar, enum gacc_mode mode, enum prot_type prot)
 488 {
 489         struct kvm_s390_pgm_info *pgm = &vcpu->arch.pgm;
 490         struct trans_exc_code_bits *tec;
 491
 492         memset(pgm, 0, sizeof(*pgm));
 493         pgm->code = code;
 494         tec = (struct trans_exc_code_bits *)&pgm->trans_exc_code;
 495
 496         switch (code) {
 497         case PGM_ASCE_TYPE:
 498         case PGM_PAGE_TRANSLATION:
 499         case PGM_REGION_FIRST_TRANS:
 500         case PGM_REGION_SECOND_TRANS:
 501         case PGM_REGION_THIRD_TRANS:
 502         case PGM_SEGMENT_TRANSLATION:
 503                 /*
 504                  * op_access_id only applies to MOVE_PAGE -> set bit 61
 505                  * exc_access_id has to be set to 0 for some instructions. Both
 506                  * cases have to be handled by the caller. We can always store
 507                  * exc_access_id, as it is undefined for non-ar cases.
 508                  */
 509                 tec->addr = gva >> PAGE_SHIFT;
 510                 tec->fsi = mode == GACC_STORE ? FSI_STORE : FSI_FETCH;
 511                 tec->as = psw_bits(vcpu->arch.sie_block->gpsw).as;
 512                 /* FALL THROUGH */
 513         case PGM_ALEN_TRANSLATION:
 514         case PGM_ALE_SEQUENCE:
 515         case PGM_ASTE_VALIDITY:
 516         case PGM_ASTE_SEQUENCE:
 517         case PGM_EXTENDED_AUTHORITY:
 518                 pgm->exc_access_id = ar;
 519                 break;
 520         case PGM_PROTECTION:
 521                 switch (prot) {
 522                 case PROT_TYPE_ALC:
 523                         tec->b60 = 1;
 524                         /* FALL THROUGH */
 525                 case PROT_TYPE_DAT:
 526                         tec->b61 = 1;
 527                         tec->addr = gva >> PAGE_SHIFT;
 528                         tec->fsi = mode == GACC_STORE ? FSI_STORE : FSI_FETCH;
 529                         tec->as = psw_bits(vcpu->arch.sie_block->gpsw).as;
 530                         /* exc_access_id is undefined for most cases */
 531                         pgm->exc_access_id = ar;
 532                         break;
 533                 default: /* LA and KEYC set b61 to 0, other params undefined */
 534                         break;
 535                 }
 536                 break;
 537         }
 538         return code;
 539 }
 540
 541 static int get_vcpu_asce(struct kvm_vcpu *vcpu, union asce *asce,
 542                          unsigned long ga, ar_t ar, enum gacc_mode mode)
 543 {
 544         int rc;
 545         struct psw_bits psw = psw_bits(vcpu->arch.sie_block->gpsw);
 546
 547         if (!psw.t) {
 548                 asce->val = 0;
 549                 asce->r = 1;
 550                 return 0;
 551         }
 552
 553         if (mode == GACC_IFETCH)
 554                 psw.as = psw.as == PSW_AS_HOME ? PSW_AS_HOME : PSW_AS_PRIMARY;
 555
 556         switch (psw.as) {
 557         case PSW_AS_PRIMARY:
 558                 asce->val = vcpu->arch.sie_block->gcr[1];
 559                 return 0;
 560         case PSW_AS_SECONDARY:
 561                 asce->val = vcpu->arch.sie_block->gcr[7];
 562                 return 0;
 563         case PSW_AS_HOME:
 564                 asce->val = vcpu->arch.sie_block->gcr[13];
 565                 return 0;
 566         case PSW_AS_ACCREG:
 567                 rc = ar_translation(vcpu, asce, ar, mode);
 568                 if (rc > 0)
 569                         return trans_exc(vcpu, rc, ga, ar, mode, PROT_TYPE_ALC);
 570                 return rc;
 571         }
 572         return 0;
 573 }
 574
 575 static int deref_table(struct kvm *kvm, unsigned long gpa, unsigned long *val)
 576 {
 577         return kvm_read_guest(kvm, gpa, val, sizeof(*val));
 578 }
 579
 580 /**
 581  * guest_translate - translate a guest virtual into a guest absolute address
 582  * @vcpu: virtual cpu
 583  * @gva: guest virtual address
 584  * @gpa: points to where guest physical (absolute) address should be stored
 585  * @asce: effective asce
 586  * @mode: indicates the access mode to be used
 587  *
 588  * Translate a guest virtual address into a guest absolute address by means
 589  * of dynamic address translation as specified by the architecture.
 590  * If the resulting absolute address is not available in the configuration
 591  * an addressing exception is indicated and @gpa will not be changed.
 592  *
 593  * Returns: - zero on success; @gpa contains the resulting absolute address
 594  *          - a negative value if guest access failed due to e.g. broken
 595  *            guest mapping
 596  *          - a positve value if an access exception happened. In this case
 597  *            the returned value is the program interruption code as defined
 598  *            by the architecture
 599  */
 600 static unsigned long guest_translate(struct kvm_vcpu *vcpu, unsigned long gva,
 601                                      unsigned long *gpa, const union asce asce,
 602                                      enum gacc_mode mode)
 603 {
 604         union vaddress vaddr = {.addr = gva};
 605         union raddress raddr = {.addr = gva};
 606         union page_table_entry pte;
 607         int dat_protection = 0;
 608         union ctlreg0 ctlreg0;
 609         unsigned long ptr;
 610         int edat1, edat2;
 611
 612         ctlreg0.val = vcpu->arch.sie_block->gcr[0];
 613         edat1 = ctlreg0.edat && test_kvm_facility(vcpu->kvm, 8);
 614         edat2 = edat1 && test_kvm_facility(vcpu->kvm, 78);
 615         if (asce.r)
 616                 goto real_address;
 617         ptr = asce.origin * 4096;
 618         switch (asce.dt) {
 619         case ASCE_TYPE_REGION1:
 620                 if (vaddr.rfx01 > asce.tl)
 621                         return PGM_REGION_FIRST_TRANS;
 622                 ptr += vaddr.rfx * 8;
 623                 break;
 624         case ASCE_TYPE_REGION2:
 625                 if (vaddr.rfx)
 626                         return PGM_ASCE_TYPE;
 627                 if (vaddr.rsx01 > asce.tl)
 628                         return PGM_REGION_SECOND_TRANS;
 629                 ptr += vaddr.rsx * 8;
 630                 break;
 631         case ASCE_TYPE_REGION3:
 632                 if (vaddr.rfx || vaddr.rsx)
 633                         return PGM_ASCE_TYPE;
 634                 if (vaddr.rtx01 > asce.tl)
 635                         return PGM_REGION_THIRD_TRANS;
 636                 ptr += vaddr.rtx * 8;
 637                 break;
 638         case ASCE_TYPE_SEGMENT:
 639                 if (vaddr.rfx || vaddr.rsx || vaddr.rtx)
 640                         return PGM_ASCE_TYPE;
 641                 if (vaddr.sx01 > asce.tl)
 642                         return PGM_SEGMENT_TRANSLATION;
 643                 ptr += vaddr.sx * 8;
 644                 break;
 645         }
 646         switch (asce.dt) {
 647         case ASCE_TYPE_REGION1: {
 648                 union region1_table_entry rfte;
 649
 650                 if (kvm_is_error_gpa(vcpu->kvm, ptr))
 651                         return PGM_ADDRESSING;
 652                 if (deref_table(vcpu->kvm, ptr, &rfte.val))
 653                         return -EFAULT;
 654                 if (rfte.i)
 655                         return PGM_REGION_FIRST_TRANS;
 656                 if (rfte.tt != TABLE_TYPE_REGION1)
 657                         return PGM_TRANSLATION_SPEC;
 658                 if (vaddr.rsx01 < rfte.tf || vaddr.rsx01 > rfte.tl)
 659                         return PGM_REGION_SECOND_TRANS;
 660                 if (edat1)
 661                         dat_protection |= rfte.p;
 662                 ptr = rfte.rto * 4096 + vaddr.rsx * 8;
 663         }
 664                 /* fallthrough */
 665         case ASCE_TYPE_REGION2: {
 666                 union region2_table_entry rste;
 667
 668                 if (kvm_is_error_gpa(vcpu->kvm, ptr))
 669                         return PGM_ADDRESSING;
 670                 if (deref_table(vcpu->kvm, ptr, &rste.val))
 671                         return -EFAULT;
 672                 if (rste.i)
 673                         return PGM_REGION_SECOND_TRANS;
 674                 if (rste.tt != TABLE_TYPE_REGION2)
 675                         return PGM_TRANSLATION_SPEC;
 676                 if (vaddr.rtx01 < rste.tf || vaddr.rtx01 > rste.tl)
 677                         return PGM_REGION_THIRD_TRANS;
 678                 if (edat1)
 679                         dat_protection |= rste.p;
 680                 ptr = rste.rto * 4096 + vaddr.rtx * 8;
 681         }
 682                 /* fallthrough */
 683         case ASCE_TYPE_REGION3: {
 684                 union region3_table_entry rtte;
 685
 686                 if (kvm_is_error_gpa(vcpu->kvm, ptr))
 687                         return PGM_ADDRESSING;
 688                 if (deref_table(vcpu->kvm, ptr, &rtte.val))
 689                         return -EFAULT;
 690                 if (rtte.i)
 691                         return PGM_REGION_THIRD_TRANS;
 692                 if (rtte.tt != TABLE_TYPE_REGION3)
 693                         return PGM_TRANSLATION_SPEC;
 694                 if (rtte.cr && asce.p && edat2)
 695                         return PGM_TRANSLATION_SPEC;
 696                 if (rtte.fc && edat2) {
 697                         dat_protection |= rtte.fc1.p;
 698                         raddr.rfaa = rtte.fc1.rfaa;
 699                         goto absolute_address;
 700                 }
 701                 if (vaddr.sx01 < rtte.fc0.tf)
 702                         return PGM_SEGMENT_TRANSLATION;
 703                 if (vaddr.sx01 > rtte.fc0.tl)
 704                         return PGM_SEGMENT_TRANSLATION;
 705                 if (edat1)
 706                         dat_protection |= rtte.fc0.p;
 707                 ptr = rtte.fc0.sto * 4096 + vaddr.sx * 8;
 708         }
 709                 /* fallthrough */
 710         case ASCE_TYPE_SEGMENT: {
 711                 union segment_table_entry ste;
 712
 713                 if (kvm_is_error_gpa(vcpu->kvm, ptr))
 714                         return PGM_ADDRESSING;
 715                 if (deref_table(vcpu->kvm, ptr, &ste.val))
 716                         return -EFAULT;
 717                 if (ste.i)
 718                         return PGM_SEGMENT_TRANSLATION;
 719                 if (ste.tt != TABLE_TYPE_SEGMENT)
 720                         return PGM_TRANSLATION_SPEC;
 721                 if (ste.cs && asce.p)
 722                         return PGM_TRANSLATION_SPEC;
 723                 if (ste.fc && edat1) {
 724                         dat_protection |= ste.fc1.p;
 725                         raddr.sfaa = ste.fc1.sfaa;
 726                         goto absolute_address;
 727                 }
 728                 dat_protection |= ste.fc0.p;
 729                 ptr = ste.fc0.pto * 2048 + vaddr.px * 8;
 730         }
 731         }
 732         if (kvm_is_error_gpa(vcpu->kvm, ptr))
 733                 return PGM_ADDRESSING;
 734         if (deref_table(vcpu->kvm, ptr, &pte.val))
 735                 return -EFAULT;
 736         if (pte.i)
 737                 return PGM_PAGE_TRANSLATION;
 738         if (pte.z)
 739                 return PGM_TRANSLATION_SPEC;
 740         if (pte.co && !edat1)
 741                 return PGM_TRANSLATION_SPEC;
 742         dat_protection |= pte.p;
 743         raddr.pfra = pte.pfra;
 744 real_address:
 745         raddr.addr = kvm_s390_real_to_abs(vcpu, raddr.addr);
 746 absolute_address:
 747         if (mode == GACC_STORE && dat_protection)
 748                 return PGM_PROTECTION;
 749         if (kvm_is_error_gpa(vcpu->kvm, raddr.addr))
 750                 return PGM_ADDRESSING;
 751         *gpa = raddr.addr;
 752         return 0;
 753 }
 754
 755 static inline int is_low_address(unsigned long ga)
 756 {
 757         /* Check for address ranges 0..511 and 4096..4607 */
 758         return (ga & ~0x11fful) == 0;
 759 }
 760
 761 static int low_address_protection_enabled(struct kvm_vcpu *vcpu,
 762                                           const union asce asce)
 763 {
 764         union ctlreg0 ctlreg0 = {.val = vcpu->arch.sie_block->gcr[0]};
 765         psw_t *psw = &vcpu->arch.sie_block->gpsw;
 766
 767         if (!ctlreg0.lap)
 768                 return 0;
 769         if (psw_bits(*psw).t && asce.p)
 770                 return 0;
 771         return 1;
 772 }
 773
 774 static int guest_page_range(struct kvm_vcpu *vcpu, unsigned long ga, ar_t ar,
 775                             unsigned long *pages, unsigned long nr_pages,
 776                             const union asce asce, enum gacc_mode mode)
 777 {
 778         psw_t *psw = &vcpu->arch.sie_block->gpsw;
 779         int lap_enabled, rc = 0;
 780
 781         lap_enabled = low_address_protection_enabled(vcpu, asce);
 782         while (nr_pages) {
 783                 ga = kvm_s390_logical_to_effective(vcpu, ga);
 784                 if (mode == GACC_STORE && lap_enabled && is_low_address(ga))
 785                         return trans_exc(vcpu, PGM_PROTECTION, ga, ar, mode,
 786                                          PROT_TYPE_LA);
 787                 ga &= PAGE_MASK;
 788                 if (psw_bits(*psw).t) {
 789                         rc = guest_translate(vcpu, ga, pages, asce, mode);
 790                         if (rc < 0)
 791                                 return rc;
 792                 } else {
 793                         *pages = kvm_s390_real_to_abs(vcpu, ga);
 794                         if (kvm_is_error_gpa(vcpu->kvm, *pages))
 795                                 rc = PGM_ADDRESSING;
 796                 }
 797                 if (rc)
 798                         return trans_exc(vcpu, rc, ga, ar, mode, PROT_TYPE_DAT);
 799                 ga += PAGE_SIZE;
 800                 pages++;
 801                 nr_pages--;
 802         }
 803         return 0;
 804 }
 805
 806 int access_guest(struct kvm_vcpu *vcpu, unsigned long ga, ar_t ar, void *data,
 807                  unsigned long len, enum gacc_mode mode)
 808 {
 809         psw_t *psw = &vcpu->arch.sie_block->gpsw;
 810         unsigned long _len, nr_pages, gpa, idx;
 811         unsigned long pages_array[2];
 812         unsigned long *pages;
 813         int need_ipte_lock;
 814         union asce asce;
 815         int rc;
 816
 817         if (!len)
 818                 return 0;
 819         ga = kvm_s390_logical_to_effective(vcpu, ga);
 820         rc = get_vcpu_asce(vcpu, &asce, ga, ar, mode);
 821         if (rc)
 822                 return rc;
 823         nr_pages = (((ga & ~PAGE_MASK) + len - 1) >> PAGE_SHIFT) + 1;
 824         pages = pages_array;
 825         if (nr_pages > ARRAY_SIZE(pages_array))
 826                 pages = vmalloc(nr_pages * sizeof(unsigned long));
 827         if (!pages)
 828                 return -ENOMEM;
 829         need_ipte_lock = psw_bits(*psw).t && !asce.r;
 830         if (need_ipte_lock)
 831                 ipte_lock(vcpu);
 832         rc = guest_page_range(vcpu, ga, ar, pages, nr_pages, asce, mode);
 833         for (idx = 0; idx < nr_pages && !rc; idx++) {
 834                 gpa = *(pages + idx) + (ga & ~PAGE_MASK);
 835                 _len = min(PAGE_SIZE - (gpa & ~PAGE_MASK), len);
 836                 if (mode == GACC_STORE)
 837                         rc = kvm_write_guest(vcpu->kvm, gpa, data, _len);
 838                 else
 839                         rc = kvm_read_guest(vcpu->kvm, gpa, data, _len);
 840                 len -= _len;
 841                 ga += _len;
 842                 data += _len;
 843         }
 844         if (need_ipte_lock)
 845                 ipte_unlock(vcpu);
 846         if (nr_pages > ARRAY_SIZE(pages_array))
 847                 vfree(pages);
 848         return rc;
 849 }
 850
 851 int access_guest_real(struct kvm_vcpu *vcpu, unsigned long gra,
 852                       void *data, unsigned long len, enum gacc_mode mode)
 853 {
 854         unsigned long _len, gpa;
 855         int rc = 0;
 856
 857         while (len && !rc) {
 858                 gpa = kvm_s390_real_to_abs(vcpu, gra);
 859                 _len = min(PAGE_SIZE - (gpa & ~PAGE_MASK), len);
 860                 if (mode)
 861                         rc = write_guest_abs(vcpu, gpa, data, _len);
 862                 else
 863                         rc = read_guest_abs(vcpu, gpa, data, _len);
 864                 len -= _len;
 865                 gra += _len;
 866                 data += _len;
 867         }
 868         return rc;
 869 }
 870
 871 /**
 872  * guest_translate_address - translate guest logical into guest absolute address
 873  *
 874  * Parameter semantics are the same as the ones from guest_translate.
 875  * The memory contents at the guest address are not changed.
 876  *
 877  * Note: The IPTE lock is not taken during this function, so the caller
 878  * has to take care of this.
 879  */
 880 int guest_translate_address(struct kvm_vcpu *vcpu, unsigned long gva, ar_t ar,
 881                             unsigned long *gpa, enum gacc_mode mode)
 882 {
 883         psw_t *psw = &vcpu->arch.sie_block->gpsw;
 884         union asce asce;
 885         int rc;
 886
 887         gva = kvm_s390_logical_to_effective(vcpu, gva);
 888         rc = get_vcpu_asce(vcpu, &asce, gva, ar, mode);
 889         if (rc)
 890                 return rc;
 891         if (is_low_address(gva) && low_address_protection_enabled(vcpu, asce)) {
 892                 if (mode == GACC_STORE)
 893                         return trans_exc(vcpu, PGM_PROTECTION, gva, 0,
 894                                          mode, PROT_TYPE_LA);
 895         }
 896
 897         if (psw_bits(*psw).t && !asce.r) {      /* Use DAT? */
 898                 rc = guest_translate(vcpu, gva, gpa, asce, mode);
 899                 if (rc > 0)
 900                         return trans_exc(vcpu, rc, gva, 0, mode, PROT_TYPE_DAT);
 901         } else {
 902                 *gpa = kvm_s390_real_to_abs(vcpu, gva);
 903                 if (kvm_is_error_gpa(vcpu->kvm, *gpa))
 904                         return trans_exc(vcpu, rc, gva, PGM_ADDRESSING, mode, 0);
 905         }
 906
 907         return rc;
 908 }
 909
 910 /**
 911  * check_gva_range - test a range of guest virtual addresses for accessibility
 912  */
 913 int check_gva_range(struct kvm_vcpu *vcpu, unsigned long gva, ar_t ar,
 914                     unsigned long length, enum gacc_mode mode)
 915 {
 916         unsigned long gpa;
 917         unsigned long currlen;
 918         int rc = 0;
 919
 920         ipte_lock(vcpu);
 921         while (length > 0 && !rc) {
 922                 currlen = min(length, PAGE_SIZE - (gva % PAGE_SIZE));
 923                 rc = guest_translate_address(vcpu, gva, ar, &gpa, mode);
 924                 gva += currlen;
 925                 length -= currlen;
 926         }
 927         ipte_unlock(vcpu);
 928
 929         return rc;
 930 }
 931
 932 /**
 933  * kvm_s390_check_low_addr_prot_real - check for low-address protection
 934  * @gra: Guest real address
 935  *
 936  * Checks whether an address is subject to low-address protection and set
 937  * up vcpu->arch.pgm accordingly if necessary.
 938  *
 939  * Return: 0 if no protection exception, or PGM_PROTECTION if protected.
 940  */
 941 int kvm_s390_check_low_addr_prot_real(struct kvm_vcpu *vcpu, unsigned long gra)
 942 {
 943         union ctlreg0 ctlreg0 = {.val = vcpu->arch.sie_block->gcr[0]};
 944
 945         if (!ctlreg0.lap || !is_low_address(gra))
 946                 return 0;
 947         return trans_exc(vcpu, PGM_PROTECTION, gra, 0, GACC_STORE, PROT_TYPE_LA);
 948 }