1 /* 2 * ARM SMMUv3 support - Internal API 3 * 4 * Copyright (C) 2014-2016 Broadcom Corporation 5 * Copyright (c) 2017 Red Hat, Inc. 6 * Written by Prem Mallappa, Eric Auger 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License version 2 as 10 * published by the Free Software Foundation. 11 * 12 * This program is distributed in the hope that it will be useful, 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 * GNU General Public License for more details. 16 * 17 * You should have received a copy of the GNU General Public License along 18 * with this program; if not, see <http://www.gnu.org/licenses/>. 19 */ 20 21 #ifndef HW_ARM_SMMU_V3_INTERNAL_H 22 #define HW_ARM_SMMU_V3_INTERNAL_H 23 24 #include "hw/arm/smmu-common.h" 25 26 /* MMIO Registers */ 27 28 REG32(IDR0, 0x0) 29 FIELD(IDR0, S1P, 1 , 1) 30 FIELD(IDR0, TTF, 2 , 2) 31 FIELD(IDR0, COHACC, 4 , 1) 32 FIELD(IDR0, ASID16, 12, 1) 33 FIELD(IDR0, TTENDIAN, 21, 2) 34 FIELD(IDR0, STALL_MODEL, 24, 2) 35 FIELD(IDR0, TERM_MODEL, 26, 1) 36 FIELD(IDR0, STLEVEL, 27, 2) 37 38 REG32(IDR1, 0x4) 39 FIELD(IDR1, SIDSIZE, 0 , 6) 40 FIELD(IDR1, EVENTQS, 16, 5) 41 FIELD(IDR1, CMDQS, 21, 5) 42 43 #define SMMU_IDR1_SIDSIZE 16 44 #define SMMU_CMDQS 19 45 #define SMMU_EVENTQS 19 46 47 REG32(IDR2, 0x8) 48 REG32(IDR3, 0xc) 49 REG32(IDR4, 0x10) 50 REG32(IDR5, 0x14) 51 FIELD(IDR5, OAS, 0, 3); 52 FIELD(IDR5, GRAN4K, 4, 1); 53 FIELD(IDR5, GRAN16K, 5, 1); 54 FIELD(IDR5, GRAN64K, 6, 1); 55 56 #define SMMU_IDR5_OAS 4 57 58 REG32(IIDR, 0x1c) 59 REG32(CR0, 0x20) 60 FIELD(CR0, SMMU_ENABLE, 0, 1) 61 FIELD(CR0, EVENTQEN, 2, 1) 62 FIELD(CR0, CMDQEN, 3, 1) 63 64 #define SMMU_CR0_RESERVED 0xFFFFFC20 65 66 REG32(CR0ACK, 0x24) 67 REG32(CR1, 0x28) 68 REG32(CR2, 0x2c) 69 REG32(STATUSR, 0x40) 70 REG32(IRQ_CTRL, 0x50) 71 FIELD(IRQ_CTRL, GERROR_IRQEN, 0, 1) 72 FIELD(IRQ_CTRL, PRI_IRQEN, 1, 1) 73 FIELD(IRQ_CTRL, EVENTQ_IRQEN, 2, 1) 74 75 REG32(IRQ_CTRL_ACK, 0x54) 76 REG32(GERROR, 0x60) 77 FIELD(GERROR, CMDQ_ERR, 0, 1) 78 FIELD(GERROR, EVENTQ_ABT_ERR, 2, 1) 79 FIELD(GERROR, PRIQ_ABT_ERR, 3, 1) 80 FIELD(GERROR, MSI_CMDQ_ABT_ERR, 4, 1) 81 FIELD(GERROR, MSI_EVENTQ_ABT_ERR, 5, 1) 82 FIELD(GERROR, MSI_PRIQ_ABT_ERR, 6, 1) 83 FIELD(GERROR, MSI_GERROR_ABT_ERR, 7, 1) 84 FIELD(GERROR, MSI_SFM_ERR, 8, 1) 85 86 REG32(GERRORN, 0x64) 87 88 #define A_GERROR_IRQ_CFG0 0x68 /* 64b */ 89 REG32(GERROR_IRQ_CFG1, 0x70) 90 REG32(GERROR_IRQ_CFG2, 0x74) 91 92 #define A_STRTAB_BASE 0x80 /* 64b */ 93 94 #define SMMU_BASE_ADDR_MASK 0xffffffffffe0 95 96 REG32(STRTAB_BASE_CFG, 0x88) 97 FIELD(STRTAB_BASE_CFG, FMT, 16, 2) 98 FIELD(STRTAB_BASE_CFG, SPLIT, 6 , 5) 99 FIELD(STRTAB_BASE_CFG, LOG2SIZE, 0 , 6) 100 101 #define A_CMDQ_BASE 0x90 /* 64b */ 102 REG32(CMDQ_PROD, 0x98) 103 REG32(CMDQ_CONS, 0x9c) 104 FIELD(CMDQ_CONS, ERR, 24, 7) 105 106 #define A_EVENTQ_BASE 0xa0 /* 64b */ 107 REG32(EVENTQ_PROD, 0xa8) 108 REG32(EVENTQ_CONS, 0xac) 109 110 #define A_EVENTQ_IRQ_CFG0 0xb0 /* 64b */ 111 REG32(EVENTQ_IRQ_CFG1, 0xb8) 112 REG32(EVENTQ_IRQ_CFG2, 0xbc) 113 114 #define A_IDREGS 0xfd0 115 116 static inline int smmu_enabled(SMMUv3State *s) 117 { 118 return FIELD_EX32(s->cr[0], CR0, SMMU_ENABLE); 119 } 120 121 /* Command Queue Entry */ 122 typedef struct Cmd { 123 uint32_t word[4]; 124 } Cmd; 125 126 /* Event Queue Entry */ 127 typedef struct Evt { 128 uint32_t word[8]; 129 } Evt; 130 131 static inline uint32_t smmuv3_idreg(int regoffset) 132 { 133 /* 134 * Return the value of the Primecell/Corelink ID registers at the 135 * specified offset from the first ID register. 136 * These value indicate an ARM implementation of MMU600 p1 137 */ 138 static const uint8_t smmuv3_ids[] = { 139 0x04, 0, 0, 0, 0x84, 0xB4, 0xF0, 0x10, 0x0D, 0xF0, 0x05, 0xB1 140 }; 141 return smmuv3_ids[regoffset / 4]; 142 } 143 144 static inline bool smmuv3_eventq_irq_enabled(SMMUv3State *s) 145 { 146 return FIELD_EX32(s->irq_ctrl, IRQ_CTRL, EVENTQ_IRQEN); 147 } 148 149 static inline bool smmuv3_gerror_irq_enabled(SMMUv3State *s) 150 { 151 return FIELD_EX32(s->irq_ctrl, IRQ_CTRL, GERROR_IRQEN); 152 } 153 154 /* Queue Handling */ 155 156 #define Q_BASE(q) ((q)->base & SMMU_BASE_ADDR_MASK) 157 #define WRAP_MASK(q) (1 << (q)->log2size) 158 #define INDEX_MASK(q) (((1 << (q)->log2size)) - 1) 159 #define WRAP_INDEX_MASK(q) ((1 << ((q)->log2size + 1)) - 1) 160 161 #define Q_CONS(q) ((q)->cons & INDEX_MASK(q)) 162 #define Q_PROD(q) ((q)->prod & INDEX_MASK(q)) 163 164 #define Q_CONS_ENTRY(q) (Q_BASE(q) + (q)->entry_size * Q_CONS(q)) 165 #define Q_PROD_ENTRY(q) (Q_BASE(q) + (q)->entry_size * Q_PROD(q)) 166 167 #define Q_CONS_WRAP(q) (((q)->cons & WRAP_MASK(q)) >> (q)->log2size) 168 #define Q_PROD_WRAP(q) (((q)->prod & WRAP_MASK(q)) >> (q)->log2size) 169 170 static inline bool smmuv3_q_full(SMMUQueue *q) 171 { 172 return ((q->cons ^ q->prod) & WRAP_INDEX_MASK(q)) == WRAP_MASK(q); 173 } 174 175 static inline bool smmuv3_q_empty(SMMUQueue *q) 176 { 177 return (q->cons & WRAP_INDEX_MASK(q)) == (q->prod & WRAP_INDEX_MASK(q)); 178 } 179 180 static inline void queue_prod_incr(SMMUQueue *q) 181 { 182 q->prod = (q->prod + 1) & WRAP_INDEX_MASK(q); 183 } 184 185 static inline void queue_cons_incr(SMMUQueue *q) 186 { 187 /* 188 * We have to use deposit for the CONS registers to preserve 189 * the ERR field in the high bits. 190 */ 191 q->cons = deposit32(q->cons, 0, q->log2size + 1, q->cons + 1); 192 } 193 194 static inline bool smmuv3_cmdq_enabled(SMMUv3State *s) 195 { 196 return FIELD_EX32(s->cr[0], CR0, CMDQEN); 197 } 198 199 static inline bool smmuv3_eventq_enabled(SMMUv3State *s) 200 { 201 return FIELD_EX32(s->cr[0], CR0, EVENTQEN); 202 } 203 204 static inline void smmu_write_cmdq_err(SMMUv3State *s, uint32_t err_type) 205 { 206 s->cmdq.cons = FIELD_DP32(s->cmdq.cons, CMDQ_CONS, ERR, err_type); 207 } 208 209 /* Commands */ 210 211 typedef enum SMMUCommandType { 212 SMMU_CMD_NONE = 0x00, 213 SMMU_CMD_PREFETCH_CONFIG , 214 SMMU_CMD_PREFETCH_ADDR, 215 SMMU_CMD_CFGI_STE, 216 SMMU_CMD_CFGI_STE_RANGE, 217 SMMU_CMD_CFGI_CD, 218 SMMU_CMD_CFGI_CD_ALL, 219 SMMU_CMD_CFGI_ALL, 220 SMMU_CMD_TLBI_NH_ALL = 0x10, 221 SMMU_CMD_TLBI_NH_ASID, 222 SMMU_CMD_TLBI_NH_VA, 223 SMMU_CMD_TLBI_NH_VAA, 224 SMMU_CMD_TLBI_EL3_ALL = 0x18, 225 SMMU_CMD_TLBI_EL3_VA = 0x1a, 226 SMMU_CMD_TLBI_EL2_ALL = 0x20, 227 SMMU_CMD_TLBI_EL2_ASID, 228 SMMU_CMD_TLBI_EL2_VA, 229 SMMU_CMD_TLBI_EL2_VAA, 230 SMMU_CMD_TLBI_S12_VMALL = 0x28, 231 SMMU_CMD_TLBI_S2_IPA = 0x2a, 232 SMMU_CMD_TLBI_NSNH_ALL = 0x30, 233 SMMU_CMD_ATC_INV = 0x40, 234 SMMU_CMD_PRI_RESP, 235 SMMU_CMD_RESUME = 0x44, 236 SMMU_CMD_STALL_TERM, 237 SMMU_CMD_SYNC, 238 } SMMUCommandType; 239 240 static const char *cmd_stringify[] = { 241 [SMMU_CMD_PREFETCH_CONFIG] = "SMMU_CMD_PREFETCH_CONFIG", 242 [SMMU_CMD_PREFETCH_ADDR] = "SMMU_CMD_PREFETCH_ADDR", 243 [SMMU_CMD_CFGI_STE] = "SMMU_CMD_CFGI_STE", 244 [SMMU_CMD_CFGI_STE_RANGE] = "SMMU_CMD_CFGI_STE_RANGE", 245 [SMMU_CMD_CFGI_CD] = "SMMU_CMD_CFGI_CD", 246 [SMMU_CMD_CFGI_CD_ALL] = "SMMU_CMD_CFGI_CD_ALL", 247 [SMMU_CMD_CFGI_ALL] = "SMMU_CMD_CFGI_ALL", 248 [SMMU_CMD_TLBI_NH_ALL] = "SMMU_CMD_TLBI_NH_ALL", 249 [SMMU_CMD_TLBI_NH_ASID] = "SMMU_CMD_TLBI_NH_ASID", 250 [SMMU_CMD_TLBI_NH_VA] = "SMMU_CMD_TLBI_NH_VA", 251 [SMMU_CMD_TLBI_NH_VAA] = "SMMU_CMD_TLBI_NH_VAA", 252 [SMMU_CMD_TLBI_EL3_ALL] = "SMMU_CMD_TLBI_EL3_ALL", 253 [SMMU_CMD_TLBI_EL3_VA] = "SMMU_CMD_TLBI_EL3_VA", 254 [SMMU_CMD_TLBI_EL2_ALL] = "SMMU_CMD_TLBI_EL2_ALL", 255 [SMMU_CMD_TLBI_EL2_ASID] = "SMMU_CMD_TLBI_EL2_ASID", 256 [SMMU_CMD_TLBI_EL2_VA] = "SMMU_CMD_TLBI_EL2_VA", 257 [SMMU_CMD_TLBI_EL2_VAA] = "SMMU_CMD_TLBI_EL2_VAA", 258 [SMMU_CMD_TLBI_S12_VMALL] = "SMMU_CMD_TLBI_S12_VMALL", 259 [SMMU_CMD_TLBI_S2_IPA] = "SMMU_CMD_TLBI_S2_IPA", 260 [SMMU_CMD_TLBI_NSNH_ALL] = "SMMU_CMD_TLBI_NSNH_ALL", 261 [SMMU_CMD_ATC_INV] = "SMMU_CMD_ATC_INV", 262 [SMMU_CMD_PRI_RESP] = "SMMU_CMD_PRI_RESP", 263 [SMMU_CMD_RESUME] = "SMMU_CMD_RESUME", 264 [SMMU_CMD_STALL_TERM] = "SMMU_CMD_STALL_TERM", 265 [SMMU_CMD_SYNC] = "SMMU_CMD_SYNC", 266 }; 267 268 static inline const char *smmu_cmd_string(SMMUCommandType type) 269 { 270 if (type > SMMU_CMD_NONE && type < ARRAY_SIZE(cmd_stringify)) { 271 return cmd_stringify[type] ? cmd_stringify[type] : "UNKNOWN"; 272 } else { 273 return "INVALID"; 274 } 275 } 276 277 /* CMDQ fields */ 278 279 typedef enum { 280 SMMU_CERROR_NONE = 0, 281 SMMU_CERROR_ILL, 282 SMMU_CERROR_ABT, 283 SMMU_CERROR_ATC_INV_SYNC, 284 } SMMUCmdError; 285 286 enum { /* Command completion notification */ 287 CMD_SYNC_SIG_NONE, 288 CMD_SYNC_SIG_IRQ, 289 CMD_SYNC_SIG_SEV, 290 }; 291 292 #define CMD_TYPE(x) extract32((x)->word[0], 0 , 8) 293 #define CMD_SSEC(x) extract32((x)->word[0], 10, 1) 294 #define CMD_SSV(x) extract32((x)->word[0], 11, 1) 295 #define CMD_RESUME_AC(x) extract32((x)->word[0], 12, 1) 296 #define CMD_RESUME_AB(x) extract32((x)->word[0], 13, 1) 297 #define CMD_SYNC_CS(x) extract32((x)->word[0], 12, 2) 298 #define CMD_SSID(x) extract32((x)->word[0], 12, 20) 299 #define CMD_SID(x) ((x)->word[1]) 300 #define CMD_VMID(x) extract32((x)->word[1], 0 , 16) 301 #define CMD_ASID(x) extract32((x)->word[1], 16, 16) 302 #define CMD_RESUME_STAG(x) extract32((x)->word[2], 0 , 16) 303 #define CMD_RESP(x) extract32((x)->word[2], 11, 2) 304 #define CMD_LEAF(x) extract32((x)->word[2], 0 , 1) 305 #define CMD_STE_RANGE(x) extract32((x)->word[2], 0 , 5) 306 #define CMD_ADDR(x) ({ \ 307 uint64_t high = (uint64_t)(x)->word[3]; \ 308 uint64_t low = extract32((x)->word[2], 12, 20); \ 309 uint64_t addr = high << 32 | (low << 12); \ 310 addr; \ 311 }) 312 313 #define SMMU_FEATURE_2LVL_STE (1 << 0) 314 315 /* Events */ 316 317 typedef enum SMMUEventType { 318 SMMU_EVT_OK = 0x00, 319 SMMU_EVT_F_UUT , 320 SMMU_EVT_C_BAD_STREAMID , 321 SMMU_EVT_F_STE_FETCH , 322 SMMU_EVT_C_BAD_STE , 323 SMMU_EVT_F_BAD_ATS_TREQ , 324 SMMU_EVT_F_STREAM_DISABLED , 325 SMMU_EVT_F_TRANS_FORBIDDEN , 326 SMMU_EVT_C_BAD_SUBSTREAMID , 327 SMMU_EVT_F_CD_FETCH , 328 SMMU_EVT_C_BAD_CD , 329 SMMU_EVT_F_WALK_EABT , 330 SMMU_EVT_F_TRANSLATION = 0x10, 331 SMMU_EVT_F_ADDR_SIZE , 332 SMMU_EVT_F_ACCESS , 333 SMMU_EVT_F_PERMISSION , 334 SMMU_EVT_F_TLB_CONFLICT = 0x20, 335 SMMU_EVT_F_CFG_CONFLICT , 336 SMMU_EVT_E_PAGE_REQ = 0x24, 337 } SMMUEventType; 338 339 static const char *event_stringify[] = { 340 [SMMU_EVT_OK] = "SMMU_EVT_OK", 341 [SMMU_EVT_F_UUT] = "SMMU_EVT_F_UUT", 342 [SMMU_EVT_C_BAD_STREAMID] = "SMMU_EVT_C_BAD_STREAMID", 343 [SMMU_EVT_F_STE_FETCH] = "SMMU_EVT_F_STE_FETCH", 344 [SMMU_EVT_C_BAD_STE] = "SMMU_EVT_C_BAD_STE", 345 [SMMU_EVT_F_BAD_ATS_TREQ] = "SMMU_EVT_F_BAD_ATS_TREQ", 346 [SMMU_EVT_F_STREAM_DISABLED] = "SMMU_EVT_F_STREAM_DISABLED", 347 [SMMU_EVT_F_TRANS_FORBIDDEN] = "SMMU_EVT_F_TRANS_FORBIDDEN", 348 [SMMU_EVT_C_BAD_SUBSTREAMID] = "SMMU_EVT_C_BAD_SUBSTREAMID", 349 [SMMU_EVT_F_CD_FETCH] = "SMMU_EVT_F_CD_FETCH", 350 [SMMU_EVT_C_BAD_CD] = "SMMU_EVT_C_BAD_CD", 351 [SMMU_EVT_F_WALK_EABT] = "SMMU_EVT_F_WALK_EABT", 352 [SMMU_EVT_F_TRANSLATION] = "SMMU_EVT_F_TRANSLATION", 353 [SMMU_EVT_F_ADDR_SIZE] = "SMMU_EVT_F_ADDR_SIZE", 354 [SMMU_EVT_F_ACCESS] = "SMMU_EVT_F_ACCESS", 355 [SMMU_EVT_F_PERMISSION] = "SMMU_EVT_F_PERMISSION", 356 [SMMU_EVT_F_TLB_CONFLICT] = "SMMU_EVT_F_TLB_CONFLICT", 357 [SMMU_EVT_F_CFG_CONFLICT] = "SMMU_EVT_F_CFG_CONFLICT", 358 [SMMU_EVT_E_PAGE_REQ] = "SMMU_EVT_E_PAGE_REQ", 359 }; 360 361 static inline const char *smmu_event_string(SMMUEventType type) 362 { 363 if (type < ARRAY_SIZE(event_stringify)) { 364 return event_stringify[type] ? event_stringify[type] : "UNKNOWN"; 365 } else { 366 return "INVALID"; 367 } 368 } 369 370 /* Encode an event record */ 371 typedef struct SMMUEventInfo { 372 SMMUEventType type; 373 uint32_t sid; 374 bool recorded; 375 bool record_trans_faults; 376 union { 377 struct { 378 uint32_t ssid; 379 bool ssv; 380 dma_addr_t addr; 381 bool rnw; 382 bool pnu; 383 bool ind; 384 } f_uut; 385 struct SSIDInfo { 386 uint32_t ssid; 387 bool ssv; 388 } c_bad_streamid; 389 struct SSIDAddrInfo { 390 uint32_t ssid; 391 bool ssv; 392 dma_addr_t addr; 393 } f_ste_fetch; 394 struct SSIDInfo c_bad_ste; 395 struct { 396 dma_addr_t addr; 397 bool rnw; 398 } f_transl_forbidden; 399 struct { 400 uint32_t ssid; 401 } c_bad_substream; 402 struct SSIDAddrInfo f_cd_fetch; 403 struct SSIDInfo c_bad_cd; 404 struct FullInfo { 405 bool stall; 406 uint16_t stag; 407 uint32_t ssid; 408 bool ssv; 409 bool s2; 410 dma_addr_t addr; 411 bool rnw; 412 bool pnu; 413 bool ind; 414 uint8_t class; 415 dma_addr_t addr2; 416 } f_walk_eabt; 417 struct FullInfo f_translation; 418 struct FullInfo f_addr_size; 419 struct FullInfo f_access; 420 struct FullInfo f_permission; 421 struct SSIDInfo f_cfg_conflict; 422 /** 423 * not supported yet: 424 * F_BAD_ATS_TREQ 425 * F_BAD_ATS_TREQ 426 * F_TLB_CONFLICT 427 * E_PAGE_REQUEST 428 * IMPDEF_EVENTn 429 */ 430 } u; 431 } SMMUEventInfo; 432 433 /* EVTQ fields */ 434 435 #define EVT_Q_OVERFLOW (1 << 31) 436 437 #define EVT_SET_TYPE(x, v) deposit32((x)->word[0], 0 , 8 , v) 438 #define EVT_SET_SSV(x, v) deposit32((x)->word[0], 11, 1 , v) 439 #define EVT_SET_SSID(x, v) deposit32((x)->word[0], 12, 20, v) 440 #define EVT_SET_SID(x, v) ((x)->word[1] = v) 441 #define EVT_SET_STAG(x, v) deposit32((x)->word[2], 0 , 16, v) 442 #define EVT_SET_STALL(x, v) deposit32((x)->word[2], 31, 1 , v) 443 #define EVT_SET_PNU(x, v) deposit32((x)->word[3], 1 , 1 , v) 444 #define EVT_SET_IND(x, v) deposit32((x)->word[3], 2 , 1 , v) 445 #define EVT_SET_RNW(x, v) deposit32((x)->word[3], 3 , 1 , v) 446 #define EVT_SET_S2(x, v) deposit32((x)->word[3], 7 , 1 , v) 447 #define EVT_SET_CLASS(x, v) deposit32((x)->word[3], 8 , 2 , v) 448 #define EVT_SET_ADDR(x, addr) \ 449 do { \ 450 (x)->word[5] = (uint32_t)(addr >> 32); \ 451 (x)->word[4] = (uint32_t)(addr & 0xffffffff); \ 452 } while (0) 453 #define EVT_SET_ADDR2(x, addr) \ 454 do { \ 455 deposit32((x)->word[7], 3, 29, addr >> 16); \ 456 deposit32((x)->word[7], 0, 16, addr & 0xffff);\ 457 } while (0) 458 459 void smmuv3_record_event(SMMUv3State *s, SMMUEventInfo *event); 460 461 /* Configuration Data */ 462 463 /* STE Level 1 Descriptor */ 464 typedef struct STEDesc { 465 uint32_t word[2]; 466 } STEDesc; 467 468 /* CD Level 1 Descriptor */ 469 typedef struct CDDesc { 470 uint32_t word[2]; 471 } CDDesc; 472 473 /* Stream Table Entry(STE) */ 474 typedef struct STE { 475 uint32_t word[16]; 476 } STE; 477 478 /* Context Descriptor(CD) */ 479 typedef struct CD { 480 uint32_t word[16]; 481 } CD; 482 483 /* STE fields */ 484 485 #define STE_VALID(x) extract32((x)->word[0], 0, 1) 486 487 #define STE_CONFIG(x) extract32((x)->word[0], 1, 3) 488 #define STE_CFG_S1_ENABLED(config) (config & 0x1) 489 #define STE_CFG_S2_ENABLED(config) (config & 0x2) 490 #define STE_CFG_ABORT(config) (!(config & 0x4)) 491 #define STE_CFG_BYPASS(config) (config == 0x4) 492 493 #define STE_S1FMT(x) extract32((x)->word[0], 4 , 2) 494 #define STE_S1CDMAX(x) extract32((x)->word[1], 27, 5) 495 #define STE_S1STALLD(x) extract32((x)->word[2], 27, 1) 496 #define STE_EATS(x) extract32((x)->word[2], 28, 2) 497 #define STE_STRW(x) extract32((x)->word[2], 30, 2) 498 #define STE_S2VMID(x) extract32((x)->word[4], 0 , 16) 499 #define STE_S2T0SZ(x) extract32((x)->word[5], 0 , 6) 500 #define STE_S2SL0(x) extract32((x)->word[5], 6 , 2) 501 #define STE_S2TG(x) extract32((x)->word[5], 14, 2) 502 #define STE_S2PS(x) extract32((x)->word[5], 16, 3) 503 #define STE_S2AA64(x) extract32((x)->word[5], 19, 1) 504 #define STE_S2HD(x) extract32((x)->word[5], 24, 1) 505 #define STE_S2HA(x) extract32((x)->word[5], 25, 1) 506 #define STE_S2S(x) extract32((x)->word[5], 26, 1) 507 #define STE_CTXPTR(x) \ 508 ({ \ 509 unsigned long addr; \ 510 addr = (uint64_t)extract32((x)->word[1], 0, 16) << 32; \ 511 addr |= (uint64_t)((x)->word[0] & 0xffffffc0); \ 512 addr; \ 513 }) 514 515 #define STE_S2TTB(x) \ 516 ({ \ 517 unsigned long addr; \ 518 addr = (uint64_t)extract32((x)->word[7], 0, 16) << 32; \ 519 addr |= (uint64_t)((x)->word[6] & 0xfffffff0); \ 520 addr; \ 521 }) 522 523 static inline int oas2bits(int oas_field) 524 { 525 switch (oas_field) { 526 case 0: 527 return 32; 528 case 1: 529 return 36; 530 case 2: 531 return 40; 532 case 3: 533 return 42; 534 case 4: 535 return 44; 536 case 5: 537 return 48; 538 } 539 return -1; 540 } 541 542 static inline int pa_range(STE *ste) 543 { 544 int oas_field = MIN(STE_S2PS(ste), SMMU_IDR5_OAS); 545 546 if (!STE_S2AA64(ste)) { 547 return 40; 548 } 549 550 return oas2bits(oas_field); 551 } 552 553 #define MAX_PA(ste) ((1 << pa_range(ste)) - 1) 554 555 /* CD fields */ 556 557 #define CD_VALID(x) extract32((x)->word[0], 30, 1) 558 #define CD_ASID(x) extract32((x)->word[1], 16, 16) 559 #define CD_TTB(x, sel) \ 560 ({ \ 561 uint64_t hi, lo; \ 562 hi = extract32((x)->word[(sel) * 2 + 3], 0, 19); \ 563 hi <<= 32; \ 564 lo = (x)->word[(sel) * 2 + 2] & ~0xfULL; \ 565 hi | lo; \ 566 }) 567 568 #define CD_TSZ(x, sel) extract32((x)->word[0], (16 * (sel)) + 0, 6) 569 #define CD_TG(x, sel) extract32((x)->word[0], (16 * (sel)) + 6, 2) 570 #define CD_EPD(x, sel) extract32((x)->word[0], (16 * (sel)) + 14, 1) 571 #define CD_ENDI(x) extract32((x)->word[0], 15, 1) 572 #define CD_IPS(x) extract32((x)->word[1], 0 , 3) 573 #define CD_TBI(x) extract32((x)->word[1], 6 , 2) 574 #define CD_HD(x) extract32((x)->word[1], 10 , 1) 575 #define CD_HA(x) extract32((x)->word[1], 11 , 1) 576 #define CD_S(x) extract32((x)->word[1], 12, 1) 577 #define CD_R(x) extract32((x)->word[1], 13, 1) 578 #define CD_A(x) extract32((x)->word[1], 14, 1) 579 #define CD_AARCH64(x) extract32((x)->word[1], 9 , 1) 580 581 #define CDM_VALID(x) ((x)->word[0] & 0x1) 582 583 static inline int is_cd_valid(SMMUv3State *s, STE *ste, CD *cd) 584 { 585 return CD_VALID(cd); 586 } 587 588 /** 589 * tg2granule - Decodes the CD translation granule size field according 590 * to the ttbr in use 591 * @bits: TG0/1 fields 592 * @ttbr: ttbr index in use 593 */ 594 static inline int tg2granule(int bits, int ttbr) 595 { 596 switch (bits) { 597 case 0: 598 return ttbr ? 0 : 12; 599 case 1: 600 return ttbr ? 14 : 16; 601 case 2: 602 return ttbr ? 12 : 14; 603 case 3: 604 return ttbr ? 16 : 0; 605 default: 606 return 0; 607 } 608 } 609 610 static inline uint64_t l1std_l2ptr(STEDesc *desc) 611 { 612 uint64_t hi, lo; 613 614 hi = desc->word[1]; 615 lo = desc->word[0] & ~0x1fULL; 616 return hi << 32 | lo; 617 } 618 619 #define L1STD_SPAN(stm) (extract32((stm)->word[0], 0, 4)) 620 621 #endif 622