110a83cb9SPrem Mallappa /* 210a83cb9SPrem Mallappa * Copyright (C) 2014-2016 Broadcom Corporation 310a83cb9SPrem Mallappa * Copyright (c) 2017 Red Hat, Inc. 410a83cb9SPrem Mallappa * Written by Prem Mallappa, Eric Auger 510a83cb9SPrem Mallappa * 610a83cb9SPrem Mallappa * This program is free software; you can redistribute it and/or modify 710a83cb9SPrem Mallappa * it under the terms of the GNU General Public License version 2 as 810a83cb9SPrem Mallappa * published by the Free Software Foundation. 910a83cb9SPrem Mallappa * 1010a83cb9SPrem Mallappa * This program is distributed in the hope that it will be useful, 1110a83cb9SPrem Mallappa * but WITHOUT ANY WARRANTY; without even the implied warranty of 1210a83cb9SPrem Mallappa * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1310a83cb9SPrem Mallappa * GNU General Public License for more details. 1410a83cb9SPrem Mallappa * 1510a83cb9SPrem Mallappa * You should have received a copy of the GNU General Public License along 1610a83cb9SPrem Mallappa * with this program; if not, see <http://www.gnu.org/licenses/>. 1710a83cb9SPrem Mallappa */ 1810a83cb9SPrem Mallappa 1910a83cb9SPrem Mallappa #include "qemu/osdep.h" 20744a790eSPhilippe Mathieu-Daudé #include "qemu/bitops.h" 2164552b6bSMarkus Armbruster #include "hw/irq.h" 2210a83cb9SPrem Mallappa #include "hw/sysbus.h" 23d6454270SMarkus Armbruster #include "migration/vmstate.h" 248cefcc3bSMostafa Saleh #include "hw/qdev-properties.h" 2510a83cb9SPrem Mallappa #include "hw/qdev-core.h" 2610a83cb9SPrem Mallappa #include "hw/pci/pci.h" 279122bea9SJia He #include "cpu.h" 2810a83cb9SPrem Mallappa #include "trace.h" 2910a83cb9SPrem Mallappa #include "qemu/log.h" 3010a83cb9SPrem Mallappa #include "qemu/error-report.h" 3110a83cb9SPrem Mallappa #include "qapi/error.h" 3210a83cb9SPrem Mallappa 3310a83cb9SPrem Mallappa #include "hw/arm/smmuv3.h" 3410a83cb9SPrem Mallappa #include "smmuv3-internal.h" 351194140bSEric Auger #include "smmu-internal.h" 3610a83cb9SPrem Mallappa 37f6cc1980SMostafa Saleh #define PTW_RECORD_FAULT(cfg) (((cfg)->stage == SMMU_STAGE_1) ? \ 38f6cc1980SMostafa Saleh (cfg)->record_faults : \ 3921eb5b5cSMostafa Saleh (cfg)->s2cfg.record_faults) 4021eb5b5cSMostafa Saleh 416a736033SEric Auger /** 426a736033SEric Auger * smmuv3_trigger_irq - pulse @irq if enabled and update 436a736033SEric Auger * GERROR register in case of GERROR interrupt 446a736033SEric Auger * 456a736033SEric Auger * @irq: irq type 466a736033SEric Auger * @gerror_mask: mask of gerrors to toggle (relevant if @irq is GERROR) 476a736033SEric Auger */ 48fae4be38SEric Auger static void smmuv3_trigger_irq(SMMUv3State *s, SMMUIrq irq, 49fae4be38SEric Auger uint32_t gerror_mask) 506a736033SEric Auger { 516a736033SEric Auger 526a736033SEric Auger bool pulse = false; 536a736033SEric Auger 546a736033SEric Auger switch (irq) { 556a736033SEric Auger case SMMU_IRQ_EVTQ: 566a736033SEric Auger pulse = smmuv3_eventq_irq_enabled(s); 576a736033SEric Auger break; 586a736033SEric Auger case SMMU_IRQ_PRIQ: 596a736033SEric Auger qemu_log_mask(LOG_UNIMP, "PRI not yet supported\n"); 606a736033SEric Auger break; 616a736033SEric Auger case SMMU_IRQ_CMD_SYNC: 626a736033SEric Auger pulse = true; 636a736033SEric Auger break; 646a736033SEric Auger case SMMU_IRQ_GERROR: 656a736033SEric Auger { 666a736033SEric Auger uint32_t pending = s->gerror ^ s->gerrorn; 676a736033SEric Auger uint32_t new_gerrors = ~pending & gerror_mask; 686a736033SEric Auger 696a736033SEric Auger if (!new_gerrors) { 706a736033SEric Auger /* only toggle non pending errors */ 716a736033SEric Auger return; 726a736033SEric Auger } 736a736033SEric Auger s->gerror ^= new_gerrors; 746a736033SEric Auger trace_smmuv3_write_gerror(new_gerrors, s->gerror); 756a736033SEric Auger 766a736033SEric Auger pulse = smmuv3_gerror_irq_enabled(s); 776a736033SEric Auger break; 786a736033SEric Auger } 796a736033SEric Auger } 806a736033SEric Auger if (pulse) { 816a736033SEric Auger trace_smmuv3_trigger_irq(irq); 826a736033SEric Auger qemu_irq_pulse(s->irq[irq]); 836a736033SEric Auger } 846a736033SEric Auger } 856a736033SEric Auger 86fae4be38SEric Auger static void smmuv3_write_gerrorn(SMMUv3State *s, uint32_t new_gerrorn) 876a736033SEric Auger { 886a736033SEric Auger uint32_t pending = s->gerror ^ s->gerrorn; 896a736033SEric Auger uint32_t toggled = s->gerrorn ^ new_gerrorn; 906a736033SEric Auger 916a736033SEric Auger if (toggled & ~pending) { 926a736033SEric Auger qemu_log_mask(LOG_GUEST_ERROR, 936a736033SEric Auger "guest toggles non pending errors = 0x%x\n", 946a736033SEric Auger toggled & ~pending); 956a736033SEric Auger } 966a736033SEric Auger 976a736033SEric Auger /* 986a736033SEric Auger * We do not raise any error in case guest toggles bits corresponding 996a736033SEric Auger * to not active IRQs (CONSTRAINED UNPREDICTABLE) 1006a736033SEric Auger */ 1016a736033SEric Auger s->gerrorn = new_gerrorn; 1026a736033SEric Auger 1036a736033SEric Auger trace_smmuv3_write_gerrorn(toggled & pending, s->gerrorn); 1046a736033SEric Auger } 1056a736033SEric Auger 106c6445544SPeter Maydell static inline MemTxResult queue_read(SMMUQueue *q, Cmd *cmd) 107dadd1a08SEric Auger { 108dadd1a08SEric Auger dma_addr_t addr = Q_CONS_ENTRY(q); 109c6445544SPeter Maydell MemTxResult ret; 110c6445544SPeter Maydell int i; 111dadd1a08SEric Auger 112c6445544SPeter Maydell ret = dma_memory_read(&address_space_memory, addr, cmd, sizeof(Cmd), 113ba06fe8aSPhilippe Mathieu-Daudé MEMTXATTRS_UNSPECIFIED); 114c6445544SPeter Maydell if (ret != MEMTX_OK) { 115c6445544SPeter Maydell return ret; 116c6445544SPeter Maydell } 117c6445544SPeter Maydell for (i = 0; i < ARRAY_SIZE(cmd->word); i++) { 118c6445544SPeter Maydell le32_to_cpus(&cmd->word[i]); 119c6445544SPeter Maydell } 120c6445544SPeter Maydell return ret; 121dadd1a08SEric Auger } 122dadd1a08SEric Auger 123c6445544SPeter Maydell static MemTxResult queue_write(SMMUQueue *q, Evt *evt_in) 124dadd1a08SEric Auger { 125dadd1a08SEric Auger dma_addr_t addr = Q_PROD_ENTRY(q); 126dadd1a08SEric Auger MemTxResult ret; 127c6445544SPeter Maydell Evt evt = *evt_in; 128c6445544SPeter Maydell int i; 129dadd1a08SEric Auger 130c6445544SPeter Maydell for (i = 0; i < ARRAY_SIZE(evt.word); i++) { 131c6445544SPeter Maydell cpu_to_le32s(&evt.word[i]); 132c6445544SPeter Maydell } 133c6445544SPeter Maydell ret = dma_memory_write(&address_space_memory, addr, &evt, sizeof(Evt), 134ba06fe8aSPhilippe Mathieu-Daudé MEMTXATTRS_UNSPECIFIED); 135dadd1a08SEric Auger if (ret != MEMTX_OK) { 136dadd1a08SEric Auger return ret; 137dadd1a08SEric Auger } 138dadd1a08SEric Auger 139dadd1a08SEric Auger queue_prod_incr(q); 140dadd1a08SEric Auger return MEMTX_OK; 141dadd1a08SEric Auger } 142dadd1a08SEric Auger 143bb981004SEric Auger static MemTxResult smmuv3_write_eventq(SMMUv3State *s, Evt *evt) 144dadd1a08SEric Auger { 145dadd1a08SEric Auger SMMUQueue *q = &s->eventq; 146bb981004SEric Auger MemTxResult r; 147bb981004SEric Auger 148bb981004SEric Auger if (!smmuv3_eventq_enabled(s)) { 149bb981004SEric Auger return MEMTX_ERROR; 150bb981004SEric Auger } 151bb981004SEric Auger 152bb981004SEric Auger if (smmuv3_q_full(q)) { 153bb981004SEric Auger return MEMTX_ERROR; 154bb981004SEric Auger } 155bb981004SEric Auger 156bb981004SEric Auger r = queue_write(q, evt); 157bb981004SEric Auger if (r != MEMTX_OK) { 158bb981004SEric Auger return r; 159bb981004SEric Auger } 160bb981004SEric Auger 1619f4d2a13SEric Auger if (!smmuv3_q_empty(q)) { 162bb981004SEric Auger smmuv3_trigger_irq(s, SMMU_IRQ_EVTQ, 0); 163bb981004SEric Auger } 164bb981004SEric Auger return MEMTX_OK; 165bb981004SEric Auger } 166bb981004SEric Auger 167bb981004SEric Auger void smmuv3_record_event(SMMUv3State *s, SMMUEventInfo *info) 168bb981004SEric Auger { 16924af32e0SEric Auger Evt evt = {}; 170bb981004SEric Auger MemTxResult r; 171dadd1a08SEric Auger 172dadd1a08SEric Auger if (!smmuv3_eventq_enabled(s)) { 173dadd1a08SEric Auger return; 174dadd1a08SEric Auger } 175dadd1a08SEric Auger 176bb981004SEric Auger EVT_SET_TYPE(&evt, info->type); 177bb981004SEric Auger EVT_SET_SID(&evt, info->sid); 178bb981004SEric Auger 179bb981004SEric Auger switch (info->type) { 1809122bea9SJia He case SMMU_EVT_NONE: 181dadd1a08SEric Auger return; 182bb981004SEric Auger case SMMU_EVT_F_UUT: 183bb981004SEric Auger EVT_SET_SSID(&evt, info->u.f_uut.ssid); 184bb981004SEric Auger EVT_SET_SSV(&evt, info->u.f_uut.ssv); 185bb981004SEric Auger EVT_SET_ADDR(&evt, info->u.f_uut.addr); 186bb981004SEric Auger EVT_SET_RNW(&evt, info->u.f_uut.rnw); 187bb981004SEric Auger EVT_SET_PNU(&evt, info->u.f_uut.pnu); 188bb981004SEric Auger EVT_SET_IND(&evt, info->u.f_uut.ind); 189bb981004SEric Auger break; 190bb981004SEric Auger case SMMU_EVT_C_BAD_STREAMID: 191bb981004SEric Auger EVT_SET_SSID(&evt, info->u.c_bad_streamid.ssid); 192bb981004SEric Auger EVT_SET_SSV(&evt, info->u.c_bad_streamid.ssv); 193bb981004SEric Auger break; 194bb981004SEric Auger case SMMU_EVT_F_STE_FETCH: 195bb981004SEric Auger EVT_SET_SSID(&evt, info->u.f_ste_fetch.ssid); 196bb981004SEric Auger EVT_SET_SSV(&evt, info->u.f_ste_fetch.ssv); 197b255cafbSSimon Veith EVT_SET_ADDR2(&evt, info->u.f_ste_fetch.addr); 198bb981004SEric Auger break; 199bb981004SEric Auger case SMMU_EVT_C_BAD_STE: 200bb981004SEric Auger EVT_SET_SSID(&evt, info->u.c_bad_ste.ssid); 201bb981004SEric Auger EVT_SET_SSV(&evt, info->u.c_bad_ste.ssv); 202bb981004SEric Auger break; 203bb981004SEric Auger case SMMU_EVT_F_STREAM_DISABLED: 204bb981004SEric Auger break; 205bb981004SEric Auger case SMMU_EVT_F_TRANS_FORBIDDEN: 206bb981004SEric Auger EVT_SET_ADDR(&evt, info->u.f_transl_forbidden.addr); 207bb981004SEric Auger EVT_SET_RNW(&evt, info->u.f_transl_forbidden.rnw); 208bb981004SEric Auger break; 209bb981004SEric Auger case SMMU_EVT_C_BAD_SUBSTREAMID: 210bb981004SEric Auger EVT_SET_SSID(&evt, info->u.c_bad_substream.ssid); 211bb981004SEric Auger break; 212bb981004SEric Auger case SMMU_EVT_F_CD_FETCH: 213bb981004SEric Auger EVT_SET_SSID(&evt, info->u.f_cd_fetch.ssid); 214bb981004SEric Auger EVT_SET_SSV(&evt, info->u.f_cd_fetch.ssv); 215bb981004SEric Auger EVT_SET_ADDR(&evt, info->u.f_cd_fetch.addr); 216bb981004SEric Auger break; 217bb981004SEric Auger case SMMU_EVT_C_BAD_CD: 218bb981004SEric Auger EVT_SET_SSID(&evt, info->u.c_bad_cd.ssid); 219bb981004SEric Auger EVT_SET_SSV(&evt, info->u.c_bad_cd.ssv); 220bb981004SEric Auger break; 221bb981004SEric Auger case SMMU_EVT_F_WALK_EABT: 222bb981004SEric Auger case SMMU_EVT_F_TRANSLATION: 223bb981004SEric Auger case SMMU_EVT_F_ADDR_SIZE: 224bb981004SEric Auger case SMMU_EVT_F_ACCESS: 225bb981004SEric Auger case SMMU_EVT_F_PERMISSION: 226bb981004SEric Auger EVT_SET_STALL(&evt, info->u.f_walk_eabt.stall); 227bb981004SEric Auger EVT_SET_STAG(&evt, info->u.f_walk_eabt.stag); 228bb981004SEric Auger EVT_SET_SSID(&evt, info->u.f_walk_eabt.ssid); 229bb981004SEric Auger EVT_SET_SSV(&evt, info->u.f_walk_eabt.ssv); 230bb981004SEric Auger EVT_SET_S2(&evt, info->u.f_walk_eabt.s2); 231bb981004SEric Auger EVT_SET_ADDR(&evt, info->u.f_walk_eabt.addr); 232bb981004SEric Auger EVT_SET_RNW(&evt, info->u.f_walk_eabt.rnw); 233bb981004SEric Auger EVT_SET_PNU(&evt, info->u.f_walk_eabt.pnu); 234bb981004SEric Auger EVT_SET_IND(&evt, info->u.f_walk_eabt.ind); 235bb981004SEric Auger EVT_SET_CLASS(&evt, info->u.f_walk_eabt.class); 236bb981004SEric Auger EVT_SET_ADDR2(&evt, info->u.f_walk_eabt.addr2); 237bb981004SEric Auger break; 238bb981004SEric Auger case SMMU_EVT_F_CFG_CONFLICT: 239bb981004SEric Auger EVT_SET_SSID(&evt, info->u.f_cfg_conflict.ssid); 240bb981004SEric Auger EVT_SET_SSV(&evt, info->u.f_cfg_conflict.ssv); 241bb981004SEric Auger break; 242bb981004SEric Auger /* rest is not implemented */ 243bb981004SEric Auger case SMMU_EVT_F_BAD_ATS_TREQ: 244bb981004SEric Auger case SMMU_EVT_F_TLB_CONFLICT: 245bb981004SEric Auger case SMMU_EVT_E_PAGE_REQ: 246bb981004SEric Auger default: 247bb981004SEric Auger g_assert_not_reached(); 248dadd1a08SEric Auger } 249dadd1a08SEric Auger 250bb981004SEric Auger trace_smmuv3_record_event(smmu_event_string(info->type), info->sid); 251bb981004SEric Auger r = smmuv3_write_eventq(s, &evt); 252bb981004SEric Auger if (r != MEMTX_OK) { 253bb981004SEric Auger smmuv3_trigger_irq(s, SMMU_IRQ_GERROR, R_GERROR_EVENTQ_ABT_ERR_MASK); 254dadd1a08SEric Auger } 255bb981004SEric Auger info->recorded = true; 256dadd1a08SEric Auger } 257dadd1a08SEric Auger 25810a83cb9SPrem Mallappa static void smmuv3_init_regs(SMMUv3State *s) 25910a83cb9SPrem Mallappa { 2608cefcc3bSMostafa Saleh /* Based on sys property, the stages supported in smmu will be advertised.*/ 2618cefcc3bSMostafa Saleh if (s->stage && !strcmp("2", s->stage)) { 2628cefcc3bSMostafa Saleh s->idr[0] = FIELD_DP32(s->idr[0], IDR0, S2P, 1); 2638cefcc3bSMostafa Saleh } else { 2648cefcc3bSMostafa Saleh s->idr[0] = FIELD_DP32(s->idr[0], IDR0, S1P, 1); 2658cefcc3bSMostafa Saleh } 2668cefcc3bSMostafa Saleh 26710a83cb9SPrem Mallappa s->idr[0] = FIELD_DP32(s->idr[0], IDR0, TTF, 2); /* AArch64 PTW only */ 26810a83cb9SPrem Mallappa s->idr[0] = FIELD_DP32(s->idr[0], IDR0, COHACC, 1); /* IO coherent */ 26910a83cb9SPrem Mallappa s->idr[0] = FIELD_DP32(s->idr[0], IDR0, ASID16, 1); /* 16-bit ASID */ 2708cefcc3bSMostafa Saleh s->idr[0] = FIELD_DP32(s->idr[0], IDR0, VMID16, 1); /* 16-bit VMID */ 27110a83cb9SPrem Mallappa s->idr[0] = FIELD_DP32(s->idr[0], IDR0, TTENDIAN, 2); /* little endian */ 27210a83cb9SPrem Mallappa s->idr[0] = FIELD_DP32(s->idr[0], IDR0, STALL_MODEL, 1); /* No stall */ 27310a83cb9SPrem Mallappa /* terminated transaction will always be aborted/error returned */ 27410a83cb9SPrem Mallappa s->idr[0] = FIELD_DP32(s->idr[0], IDR0, TERM_MODEL, 1); 27510a83cb9SPrem Mallappa /* 2-level stream table supported */ 27610a83cb9SPrem Mallappa s->idr[0] = FIELD_DP32(s->idr[0], IDR0, STLEVEL, 1); 27710a83cb9SPrem Mallappa 27810a83cb9SPrem Mallappa s->idr[1] = FIELD_DP32(s->idr[1], IDR1, SIDSIZE, SMMU_IDR1_SIDSIZE); 27910a83cb9SPrem Mallappa s->idr[1] = FIELD_DP32(s->idr[1], IDR1, EVENTQS, SMMU_EVENTQS); 28010a83cb9SPrem Mallappa s->idr[1] = FIELD_DP32(s->idr[1], IDR1, CMDQS, SMMU_CMDQS); 28110a83cb9SPrem Mallappa 282e7c3b9d9SEric Auger s->idr[3] = FIELD_DP32(s->idr[3], IDR3, HAD, 1); 2834cdd146dSPeter Maydell if (FIELD_EX32(s->idr[0], IDR0, S2P)) { 2844cdd146dSPeter Maydell /* XNX is a stage-2-specific feature */ 2854cdd146dSPeter Maydell s->idr[3] = FIELD_DP32(s->idr[3], IDR3, XNX, 1); 2864cdd146dSPeter Maydell } 28727fd85d3SPeter Maydell s->idr[3] = FIELD_DP32(s->idr[3], IDR3, RIL, 1); 288f8e7163dSPeter Maydell s->idr[3] = FIELD_DP32(s->idr[3], IDR3, BBML, 2); 289e7c3b9d9SEric Auger 29027fd85d3SPeter Maydell s->idr[5] = FIELD_DP32(s->idr[5], IDR5, OAS, SMMU_IDR5_OAS); /* 44 bits */ 291bf559ee4SKunkun Jiang /* 4K, 16K and 64K granule support */ 29210a83cb9SPrem Mallappa s->idr[5] = FIELD_DP32(s->idr[5], IDR5, GRAN4K, 1); 293bf559ee4SKunkun Jiang s->idr[5] = FIELD_DP32(s->idr[5], IDR5, GRAN16K, 1); 29410a83cb9SPrem Mallappa s->idr[5] = FIELD_DP32(s->idr[5], IDR5, GRAN64K, 1); 29510a83cb9SPrem Mallappa 29610a83cb9SPrem Mallappa s->cmdq.base = deposit64(s->cmdq.base, 0, 5, SMMU_CMDQS); 29710a83cb9SPrem Mallappa s->cmdq.prod = 0; 29810a83cb9SPrem Mallappa s->cmdq.cons = 0; 29910a83cb9SPrem Mallappa s->cmdq.entry_size = sizeof(struct Cmd); 30010a83cb9SPrem Mallappa s->eventq.base = deposit64(s->eventq.base, 0, 5, SMMU_EVENTQS); 30110a83cb9SPrem Mallappa s->eventq.prod = 0; 30210a83cb9SPrem Mallappa s->eventq.cons = 0; 30310a83cb9SPrem Mallappa s->eventq.entry_size = sizeof(struct Evt); 30410a83cb9SPrem Mallappa 30510a83cb9SPrem Mallappa s->features = 0; 30610a83cb9SPrem Mallappa s->sid_split = 0; 307e7c3b9d9SEric Auger s->aidr = 0x1; 30843530095SEric Auger s->cr[0] = 0; 30943530095SEric Auger s->cr0ack = 0; 31043530095SEric Auger s->irq_ctrl = 0; 31143530095SEric Auger s->gerror = 0; 31243530095SEric Auger s->gerrorn = 0; 31343530095SEric Auger s->statusr = 0; 314c2ecb424SMostafa Saleh s->gbpa = SMMU_GBPA_RESET_VAL; 31510a83cb9SPrem Mallappa } 31610a83cb9SPrem Mallappa 3179bde7f06SEric Auger static int smmu_get_ste(SMMUv3State *s, dma_addr_t addr, STE *buf, 3189bde7f06SEric Auger SMMUEventInfo *event) 3199bde7f06SEric Auger { 320c6445544SPeter Maydell int ret, i; 3219bde7f06SEric Auger 3229bde7f06SEric Auger trace_smmuv3_get_ste(addr); 3239bde7f06SEric Auger /* TODO: guarantee 64-bit single-copy atomicity */ 324ba06fe8aSPhilippe Mathieu-Daudé ret = dma_memory_read(&address_space_memory, addr, buf, sizeof(*buf), 325ba06fe8aSPhilippe Mathieu-Daudé MEMTXATTRS_UNSPECIFIED); 3269bde7f06SEric Auger if (ret != MEMTX_OK) { 3279bde7f06SEric Auger qemu_log_mask(LOG_GUEST_ERROR, 3289bde7f06SEric Auger "Cannot fetch pte at address=0x%"PRIx64"\n", addr); 3299bde7f06SEric Auger event->type = SMMU_EVT_F_STE_FETCH; 3309bde7f06SEric Auger event->u.f_ste_fetch.addr = addr; 3319bde7f06SEric Auger return -EINVAL; 3329bde7f06SEric Auger } 333c6445544SPeter Maydell for (i = 0; i < ARRAY_SIZE(buf->word); i++) { 334c6445544SPeter Maydell le32_to_cpus(&buf->word[i]); 335c6445544SPeter Maydell } 3369bde7f06SEric Auger return 0; 3379bde7f06SEric Auger 3389bde7f06SEric Auger } 3399bde7f06SEric Auger 3409dd6aa9bSMostafa Saleh static SMMUTranslationStatus smmuv3_do_translate(SMMUv3State *s, hwaddr addr, 3419dd6aa9bSMostafa Saleh SMMUTransCfg *cfg, 3429dd6aa9bSMostafa Saleh SMMUEventInfo *event, 3439dd6aa9bSMostafa Saleh IOMMUAccessFlags flag, 3449dd6aa9bSMostafa Saleh SMMUTLBEntry **out_entry, 3459dd6aa9bSMostafa Saleh SMMUTranslationClass class); 3469bde7f06SEric Auger /* @ssid > 0 not supported yet */ 3479dd6aa9bSMostafa Saleh static int smmu_get_cd(SMMUv3State *s, STE *ste, SMMUTransCfg *cfg, 3489dd6aa9bSMostafa Saleh uint32_t ssid, CD *buf, SMMUEventInfo *event) 3499bde7f06SEric Auger { 3509bde7f06SEric Auger dma_addr_t addr = STE_CTXPTR(ste); 351c6445544SPeter Maydell int ret, i; 3529dd6aa9bSMostafa Saleh SMMUTranslationStatus status; 3539dd6aa9bSMostafa Saleh SMMUTLBEntry *entry; 3549bde7f06SEric Auger 3559bde7f06SEric Auger trace_smmuv3_get_cd(addr); 3569dd6aa9bSMostafa Saleh 3579dd6aa9bSMostafa Saleh if (cfg->stage == SMMU_NESTED) { 3589dd6aa9bSMostafa Saleh status = smmuv3_do_translate(s, addr, cfg, event, 3599dd6aa9bSMostafa Saleh IOMMU_RO, &entry, SMMU_CLASS_CD); 3609dd6aa9bSMostafa Saleh 3619dd6aa9bSMostafa Saleh /* Same PTW faults are reported but with CLASS = CD. */ 3629dd6aa9bSMostafa Saleh if (status != SMMU_TRANS_SUCCESS) { 3639dd6aa9bSMostafa Saleh return -EINVAL; 3649dd6aa9bSMostafa Saleh } 3659dd6aa9bSMostafa Saleh 3669dd6aa9bSMostafa Saleh addr = CACHED_ENTRY_TO_ADDR(entry, addr); 3679dd6aa9bSMostafa Saleh } 3689dd6aa9bSMostafa Saleh 3699bde7f06SEric Auger /* TODO: guarantee 64-bit single-copy atomicity */ 370ba06fe8aSPhilippe Mathieu-Daudé ret = dma_memory_read(&address_space_memory, addr, buf, sizeof(*buf), 371ba06fe8aSPhilippe Mathieu-Daudé MEMTXATTRS_UNSPECIFIED); 3729bde7f06SEric Auger if (ret != MEMTX_OK) { 3739bde7f06SEric Auger qemu_log_mask(LOG_GUEST_ERROR, 3749bde7f06SEric Auger "Cannot fetch pte at address=0x%"PRIx64"\n", addr); 3759bde7f06SEric Auger event->type = SMMU_EVT_F_CD_FETCH; 3769bde7f06SEric Auger event->u.f_ste_fetch.addr = addr; 3779bde7f06SEric Auger return -EINVAL; 3789bde7f06SEric Auger } 379c6445544SPeter Maydell for (i = 0; i < ARRAY_SIZE(buf->word); i++) { 380c6445544SPeter Maydell le32_to_cpus(&buf->word[i]); 381c6445544SPeter Maydell } 3829bde7f06SEric Auger return 0; 3839bde7f06SEric Auger } 3849bde7f06SEric Auger 38521eb5b5cSMostafa Saleh /* 38621eb5b5cSMostafa Saleh * Max valid value is 39 when SMMU_IDR3.STT == 0. 38721eb5b5cSMostafa Saleh * In architectures after SMMUv3.0: 38821eb5b5cSMostafa Saleh * - If STE.S2TG selects a 4KB or 16KB granule, the minimum valid value for this 38921eb5b5cSMostafa Saleh * field is MAX(16, 64-IAS) 39021eb5b5cSMostafa Saleh * - If STE.S2TG selects a 64KB granule, the minimum valid value for this field 39121eb5b5cSMostafa Saleh * is (64-IAS). 39221eb5b5cSMostafa Saleh * As we only support AA64, IAS = OAS. 39321eb5b5cSMostafa Saleh */ 39421eb5b5cSMostafa Saleh static bool s2t0sz_valid(SMMUTransCfg *cfg) 39521eb5b5cSMostafa Saleh { 39621eb5b5cSMostafa Saleh if (cfg->s2cfg.tsz > 39) { 39721eb5b5cSMostafa Saleh return false; 39821eb5b5cSMostafa Saleh } 39921eb5b5cSMostafa Saleh 40021eb5b5cSMostafa Saleh if (cfg->s2cfg.granule_sz == 16) { 40121eb5b5cSMostafa Saleh return (cfg->s2cfg.tsz >= 64 - oas2bits(SMMU_IDR5_OAS)); 40221eb5b5cSMostafa Saleh } 40321eb5b5cSMostafa Saleh 40421eb5b5cSMostafa Saleh return (cfg->s2cfg.tsz >= MAX(64 - oas2bits(SMMU_IDR5_OAS), 16)); 40521eb5b5cSMostafa Saleh } 40621eb5b5cSMostafa Saleh 40721eb5b5cSMostafa Saleh /* 40821eb5b5cSMostafa Saleh * Return true if s2 page table config is valid. 40921eb5b5cSMostafa Saleh * This checks with the configured start level, ias_bits and granularity we can 41021eb5b5cSMostafa Saleh * have a valid page table as described in ARM ARM D8.2 Translation process. 41121eb5b5cSMostafa Saleh * The idea here is to see for the highest possible number of IPA bits, how 41221eb5b5cSMostafa Saleh * many concatenated tables we would need, if it is more than 16, then this is 41321eb5b5cSMostafa Saleh * not possible. 41421eb5b5cSMostafa Saleh */ 41521eb5b5cSMostafa Saleh static bool s2_pgtable_config_valid(uint8_t sl0, uint8_t t0sz, uint8_t gran) 41621eb5b5cSMostafa Saleh { 41721eb5b5cSMostafa Saleh int level = get_start_level(sl0, gran); 41821eb5b5cSMostafa Saleh uint64_t ipa_bits = 64 - t0sz; 41921eb5b5cSMostafa Saleh uint64_t max_ipa = (1ULL << ipa_bits) - 1; 42021eb5b5cSMostafa Saleh int nr_concat = pgd_concat_idx(level, gran, max_ipa) + 1; 42121eb5b5cSMostafa Saleh 42221eb5b5cSMostafa Saleh return nr_concat <= VMSA_MAX_S2_CONCAT; 42321eb5b5cSMostafa Saleh } 42421eb5b5cSMostafa Saleh 42521eb5b5cSMostafa Saleh static int decode_ste_s2_cfg(SMMUTransCfg *cfg, STE *ste) 42621eb5b5cSMostafa Saleh { 427f6cc1980SMostafa Saleh cfg->stage = SMMU_STAGE_2; 42821eb5b5cSMostafa Saleh 42921eb5b5cSMostafa Saleh if (STE_S2AA64(ste) == 0x0) { 43021eb5b5cSMostafa Saleh qemu_log_mask(LOG_UNIMP, 43121eb5b5cSMostafa Saleh "SMMUv3 AArch32 tables not supported\n"); 43221eb5b5cSMostafa Saleh g_assert_not_reached(); 43321eb5b5cSMostafa Saleh } 43421eb5b5cSMostafa Saleh 43521eb5b5cSMostafa Saleh switch (STE_S2TG(ste)) { 43621eb5b5cSMostafa Saleh case 0x0: /* 4KB */ 43721eb5b5cSMostafa Saleh cfg->s2cfg.granule_sz = 12; 43821eb5b5cSMostafa Saleh break; 43921eb5b5cSMostafa Saleh case 0x1: /* 64KB */ 44021eb5b5cSMostafa Saleh cfg->s2cfg.granule_sz = 16; 44121eb5b5cSMostafa Saleh break; 44221eb5b5cSMostafa Saleh case 0x2: /* 16KB */ 44321eb5b5cSMostafa Saleh cfg->s2cfg.granule_sz = 14; 44421eb5b5cSMostafa Saleh break; 44521eb5b5cSMostafa Saleh default: 44621eb5b5cSMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, 44721eb5b5cSMostafa Saleh "SMMUv3 bad STE S2TG: %x\n", STE_S2TG(ste)); 44821eb5b5cSMostafa Saleh goto bad_ste; 44921eb5b5cSMostafa Saleh } 45021eb5b5cSMostafa Saleh 45121eb5b5cSMostafa Saleh cfg->s2cfg.vttb = STE_S2TTB(ste); 45221eb5b5cSMostafa Saleh 45321eb5b5cSMostafa Saleh cfg->s2cfg.sl0 = STE_S2SL0(ste); 45421eb5b5cSMostafa Saleh /* FEAT_TTST not supported. */ 45521eb5b5cSMostafa Saleh if (cfg->s2cfg.sl0 == 0x3) { 45621eb5b5cSMostafa Saleh qemu_log_mask(LOG_UNIMP, "SMMUv3 S2SL0 = 0x3 has no meaning!\n"); 45721eb5b5cSMostafa Saleh goto bad_ste; 45821eb5b5cSMostafa Saleh } 45921eb5b5cSMostafa Saleh 46021eb5b5cSMostafa Saleh /* For AA64, The effective S2PS size is capped to the OAS. */ 46121eb5b5cSMostafa Saleh cfg->s2cfg.eff_ps = oas2bits(MIN(STE_S2PS(ste), SMMU_IDR5_OAS)); 46221eb5b5cSMostafa Saleh /* 46321eb5b5cSMostafa Saleh * It is ILLEGAL for the address in S2TTB to be outside the range 46421eb5b5cSMostafa Saleh * described by the effective S2PS value. 46521eb5b5cSMostafa Saleh */ 46621eb5b5cSMostafa Saleh if (cfg->s2cfg.vttb & ~(MAKE_64BIT_MASK(0, cfg->s2cfg.eff_ps))) { 46721eb5b5cSMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, 46821eb5b5cSMostafa Saleh "SMMUv3 S2TTB too large 0x%" PRIx64 46921eb5b5cSMostafa Saleh ", effective PS %d bits\n", 47021eb5b5cSMostafa Saleh cfg->s2cfg.vttb, cfg->s2cfg.eff_ps); 47121eb5b5cSMostafa Saleh goto bad_ste; 47221eb5b5cSMostafa Saleh } 47321eb5b5cSMostafa Saleh 47421eb5b5cSMostafa Saleh cfg->s2cfg.tsz = STE_S2T0SZ(ste); 47521eb5b5cSMostafa Saleh 47621eb5b5cSMostafa Saleh if (!s2t0sz_valid(cfg)) { 47721eb5b5cSMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, "SMMUv3 bad STE S2T0SZ = %d\n", 47821eb5b5cSMostafa Saleh cfg->s2cfg.tsz); 47921eb5b5cSMostafa Saleh goto bad_ste; 48021eb5b5cSMostafa Saleh } 48121eb5b5cSMostafa Saleh 48221eb5b5cSMostafa Saleh if (!s2_pgtable_config_valid(cfg->s2cfg.sl0, cfg->s2cfg.tsz, 48321eb5b5cSMostafa Saleh cfg->s2cfg.granule_sz)) { 48421eb5b5cSMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, 48521eb5b5cSMostafa Saleh "SMMUv3 STE stage 2 config not valid!\n"); 48621eb5b5cSMostafa Saleh goto bad_ste; 48721eb5b5cSMostafa Saleh } 48821eb5b5cSMostafa Saleh 48921eb5b5cSMostafa Saleh /* Only LE supported(IDR0.TTENDIAN). */ 49021eb5b5cSMostafa Saleh if (STE_S2ENDI(ste)) { 49121eb5b5cSMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, 49221eb5b5cSMostafa Saleh "SMMUv3 STE_S2ENDI only supports LE!\n"); 49321eb5b5cSMostafa Saleh goto bad_ste; 49421eb5b5cSMostafa Saleh } 49521eb5b5cSMostafa Saleh 49621eb5b5cSMostafa Saleh cfg->s2cfg.affd = STE_S2AFFD(ste); 49721eb5b5cSMostafa Saleh 49821eb5b5cSMostafa Saleh cfg->s2cfg.record_faults = STE_S2R(ste); 49921eb5b5cSMostafa Saleh /* As stall is not supported. */ 50021eb5b5cSMostafa Saleh if (STE_S2S(ste)) { 50121eb5b5cSMostafa Saleh qemu_log_mask(LOG_UNIMP, "SMMUv3 Stall not implemented!\n"); 50221eb5b5cSMostafa Saleh goto bad_ste; 50321eb5b5cSMostafa Saleh } 50421eb5b5cSMostafa Saleh 50521eb5b5cSMostafa Saleh return 0; 50621eb5b5cSMostafa Saleh 50721eb5b5cSMostafa Saleh bad_ste: 50821eb5b5cSMostafa Saleh return -EINVAL; 50921eb5b5cSMostafa Saleh } 51021eb5b5cSMostafa Saleh 5119122bea9SJia He /* Returns < 0 in case of invalid STE, 0 otherwise */ 5129bde7f06SEric Auger static int decode_ste(SMMUv3State *s, SMMUTransCfg *cfg, 5139bde7f06SEric Auger STE *ste, SMMUEventInfo *event) 5149bde7f06SEric Auger { 5159bde7f06SEric Auger uint32_t config; 51621eb5b5cSMostafa Saleh int ret; 5179bde7f06SEric Auger 5189bde7f06SEric Auger if (!STE_VALID(ste)) { 5193499ec08SEric Auger if (!event->inval_ste_allowed) { 52051b6d368SEric Auger qemu_log_mask(LOG_GUEST_ERROR, "invalid STE\n"); 5213499ec08SEric Auger } 5229bde7f06SEric Auger goto bad_ste; 5239bde7f06SEric Auger } 5249bde7f06SEric Auger 5259bde7f06SEric Auger config = STE_CONFIG(ste); 5269bde7f06SEric Auger 5279bde7f06SEric Auger if (STE_CFG_ABORT(config)) { 5289122bea9SJia He cfg->aborted = true; 5299122bea9SJia He return 0; 5309bde7f06SEric Auger } 5319bde7f06SEric Auger 5329bde7f06SEric Auger if (STE_CFG_BYPASS(config)) { 5339bde7f06SEric Auger cfg->bypassed = true; 5349122bea9SJia He return 0; 5359bde7f06SEric Auger } 5369bde7f06SEric Auger 53721eb5b5cSMostafa Saleh /* 53821eb5b5cSMostafa Saleh * If a stage is enabled in SW while not advertised, throw bad ste 53921eb5b5cSMostafa Saleh * according to user manual(IHI0070E) "5.2 Stream Table Entry". 54021eb5b5cSMostafa Saleh */ 54121eb5b5cSMostafa Saleh if (!STAGE1_SUPPORTED(s) && STE_CFG_S1_ENABLED(config)) { 54221eb5b5cSMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, "SMMUv3 S1 used but not supported.\n"); 5439bde7f06SEric Auger goto bad_ste; 5449bde7f06SEric Auger } 54521eb5b5cSMostafa Saleh if (!STAGE2_SUPPORTED(s) && STE_CFG_S2_ENABLED(config)) { 54621eb5b5cSMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, "SMMUv3 S2 used but not supported.\n"); 54721eb5b5cSMostafa Saleh goto bad_ste; 54821eb5b5cSMostafa Saleh } 54921eb5b5cSMostafa Saleh 55021eb5b5cSMostafa Saleh if (STAGE2_SUPPORTED(s)) { 55121eb5b5cSMostafa Saleh /* VMID is considered even if s2 is disabled. */ 55221eb5b5cSMostafa Saleh cfg->s2cfg.vmid = STE_S2VMID(ste); 55321eb5b5cSMostafa Saleh } else { 55421eb5b5cSMostafa Saleh /* Default to -1 */ 55521eb5b5cSMostafa Saleh cfg->s2cfg.vmid = -1; 55621eb5b5cSMostafa Saleh } 55721eb5b5cSMostafa Saleh 55821eb5b5cSMostafa Saleh if (STE_CFG_S2_ENABLED(config)) { 55921eb5b5cSMostafa Saleh /* 56021eb5b5cSMostafa Saleh * Stage-1 OAS defaults to OAS even if not enabled as it would be used 56121eb5b5cSMostafa Saleh * in input address check for stage-2. 56221eb5b5cSMostafa Saleh */ 56321eb5b5cSMostafa Saleh cfg->oas = oas2bits(SMMU_IDR5_OAS); 56421eb5b5cSMostafa Saleh ret = decode_ste_s2_cfg(cfg, ste); 56521eb5b5cSMostafa Saleh if (ret) { 56621eb5b5cSMostafa Saleh goto bad_ste; 56721eb5b5cSMostafa Saleh } 56821eb5b5cSMostafa Saleh } 5699bde7f06SEric Auger 5709bde7f06SEric Auger if (STE_S1CDMAX(ste) != 0) { 5719bde7f06SEric Auger qemu_log_mask(LOG_UNIMP, 5729bde7f06SEric Auger "SMMUv3 does not support multiple context descriptors yet\n"); 5739bde7f06SEric Auger goto bad_ste; 5749bde7f06SEric Auger } 5759bde7f06SEric Auger 5769bde7f06SEric Auger if (STE_S1STALLD(ste)) { 5779bde7f06SEric Auger qemu_log_mask(LOG_UNIMP, 5789bde7f06SEric Auger "SMMUv3 S1 stalling fault model not allowed yet\n"); 5799bde7f06SEric Auger goto bad_ste; 5809bde7f06SEric Auger } 5819bde7f06SEric Auger return 0; 5829bde7f06SEric Auger 5839bde7f06SEric Auger bad_ste: 5849bde7f06SEric Auger event->type = SMMU_EVT_C_BAD_STE; 5859bde7f06SEric Auger return -EINVAL; 5869bde7f06SEric Auger } 5879bde7f06SEric Auger 5889bde7f06SEric Auger /** 5899bde7f06SEric Auger * smmu_find_ste - Return the stream table entry associated 5909bde7f06SEric Auger * to the sid 5919bde7f06SEric Auger * 5929bde7f06SEric Auger * @s: smmuv3 handle 5939bde7f06SEric Auger * @sid: stream ID 5949bde7f06SEric Auger * @ste: returned stream table entry 5959bde7f06SEric Auger * @event: handle to an event info 5969bde7f06SEric Auger * 5979bde7f06SEric Auger * Supports linear and 2-level stream table 5989bde7f06SEric Auger * Return 0 on success, -EINVAL otherwise 5999bde7f06SEric Auger */ 6009bde7f06SEric Auger static int smmu_find_ste(SMMUv3State *s, uint32_t sid, STE *ste, 6019bde7f06SEric Auger SMMUEventInfo *event) 6029bde7f06SEric Auger { 60341678c33SSimon Veith dma_addr_t addr, strtab_base; 60405ff2fb8SSimon Veith uint32_t log2size; 60541678c33SSimon Veith int strtab_size_shift; 6069bde7f06SEric Auger int ret; 6079bde7f06SEric Auger 6089bde7f06SEric Auger trace_smmuv3_find_ste(sid, s->features, s->sid_split); 60905ff2fb8SSimon Veith log2size = FIELD_EX32(s->strtab_base_cfg, STRTAB_BASE_CFG, LOG2SIZE); 61005ff2fb8SSimon Veith /* 61105ff2fb8SSimon Veith * Check SID range against both guest-configured and implementation limits 61205ff2fb8SSimon Veith */ 61305ff2fb8SSimon Veith if (sid >= (1 << MIN(log2size, SMMU_IDR1_SIDSIZE))) { 6149bde7f06SEric Auger event->type = SMMU_EVT_C_BAD_STREAMID; 6159bde7f06SEric Auger return -EINVAL; 6169bde7f06SEric Auger } 6179bde7f06SEric Auger if (s->features & SMMU_FEATURE_2LVL_STE) { 618c6445544SPeter Maydell int l1_ste_offset, l2_ste_offset, max_l2_ste, span, i; 61941678c33SSimon Veith dma_addr_t l1ptr, l2ptr; 6209bde7f06SEric Auger STEDesc l1std; 6219bde7f06SEric Auger 62241678c33SSimon Veith /* 62341678c33SSimon Veith * Align strtab base address to table size. For this purpose, assume it 62441678c33SSimon Veith * is not bounded by SMMU_IDR1_SIDSIZE. 62541678c33SSimon Veith */ 62641678c33SSimon Veith strtab_size_shift = MAX(5, (int)log2size - s->sid_split - 1 + 3); 62741678c33SSimon Veith strtab_base = s->strtab_base & SMMU_BASE_ADDR_MASK & 62841678c33SSimon Veith ~MAKE_64BIT_MASK(0, strtab_size_shift); 6299bde7f06SEric Auger l1_ste_offset = sid >> s->sid_split; 6309bde7f06SEric Auger l2_ste_offset = sid & ((1 << s->sid_split) - 1); 6319bde7f06SEric Auger l1ptr = (dma_addr_t)(strtab_base + l1_ste_offset * sizeof(l1std)); 6329bde7f06SEric Auger /* TODO: guarantee 64-bit single-copy atomicity */ 63318610bfdSPhilippe Mathieu-Daudé ret = dma_memory_read(&address_space_memory, l1ptr, &l1std, 634ba06fe8aSPhilippe Mathieu-Daudé sizeof(l1std), MEMTXATTRS_UNSPECIFIED); 6359bde7f06SEric Auger if (ret != MEMTX_OK) { 6369bde7f06SEric Auger qemu_log_mask(LOG_GUEST_ERROR, 6379bde7f06SEric Auger "Could not read L1PTR at 0X%"PRIx64"\n", l1ptr); 6389bde7f06SEric Auger event->type = SMMU_EVT_F_STE_FETCH; 6399bde7f06SEric Auger event->u.f_ste_fetch.addr = l1ptr; 6409bde7f06SEric Auger return -EINVAL; 6419bde7f06SEric Auger } 642c6445544SPeter Maydell for (i = 0; i < ARRAY_SIZE(l1std.word); i++) { 643c6445544SPeter Maydell le32_to_cpus(&l1std.word[i]); 644c6445544SPeter Maydell } 6459bde7f06SEric Auger 6469bde7f06SEric Auger span = L1STD_SPAN(&l1std); 6479bde7f06SEric Auger 6489bde7f06SEric Auger if (!span) { 6499bde7f06SEric Auger /* l2ptr is not valid */ 6503499ec08SEric Auger if (!event->inval_ste_allowed) { 6519bde7f06SEric Auger qemu_log_mask(LOG_GUEST_ERROR, 6529bde7f06SEric Auger "invalid sid=%d (L1STD span=0)\n", sid); 6533499ec08SEric Auger } 6549bde7f06SEric Auger event->type = SMMU_EVT_C_BAD_STREAMID; 6559bde7f06SEric Auger return -EINVAL; 6569bde7f06SEric Auger } 6579bde7f06SEric Auger max_l2_ste = (1 << span) - 1; 6589bde7f06SEric Auger l2ptr = l1std_l2ptr(&l1std); 6599bde7f06SEric Auger trace_smmuv3_find_ste_2lvl(s->strtab_base, l1ptr, l1_ste_offset, 6609bde7f06SEric Auger l2ptr, l2_ste_offset, max_l2_ste); 6619bde7f06SEric Auger if (l2_ste_offset > max_l2_ste) { 6629bde7f06SEric Auger qemu_log_mask(LOG_GUEST_ERROR, 6639bde7f06SEric Auger "l2_ste_offset=%d > max_l2_ste=%d\n", 6649bde7f06SEric Auger l2_ste_offset, max_l2_ste); 6659bde7f06SEric Auger event->type = SMMU_EVT_C_BAD_STE; 6669bde7f06SEric Auger return -EINVAL; 6679bde7f06SEric Auger } 6689bde7f06SEric Auger addr = l2ptr + l2_ste_offset * sizeof(*ste); 6699bde7f06SEric Auger } else { 67041678c33SSimon Veith strtab_size_shift = log2size + 5; 67141678c33SSimon Veith strtab_base = s->strtab_base & SMMU_BASE_ADDR_MASK & 67241678c33SSimon Veith ~MAKE_64BIT_MASK(0, strtab_size_shift); 67341678c33SSimon Veith addr = strtab_base + sid * sizeof(*ste); 6749bde7f06SEric Auger } 6759bde7f06SEric Auger 6769bde7f06SEric Auger if (smmu_get_ste(s, addr, ste, event)) { 6779bde7f06SEric Auger return -EINVAL; 6789bde7f06SEric Auger } 6799bde7f06SEric Auger 6809bde7f06SEric Auger return 0; 6819bde7f06SEric Auger } 6829bde7f06SEric Auger 6839dd6aa9bSMostafa Saleh static int decode_cd(SMMUv3State *s, SMMUTransCfg *cfg, 6849dd6aa9bSMostafa Saleh CD *cd, SMMUEventInfo *event) 6859bde7f06SEric Auger { 6869bde7f06SEric Auger int ret = -EINVAL; 6879bde7f06SEric Auger int i; 6889dd6aa9bSMostafa Saleh SMMUTranslationStatus status; 6899dd6aa9bSMostafa Saleh SMMUTLBEntry *entry; 6909bde7f06SEric Auger 6919bde7f06SEric Auger if (!CD_VALID(cd) || !CD_AARCH64(cd)) { 6929bde7f06SEric Auger goto bad_cd; 6939bde7f06SEric Auger } 6949bde7f06SEric Auger if (!CD_A(cd)) { 6959bde7f06SEric Auger goto bad_cd; /* SMMU_IDR0.TERM_MODEL == 1 */ 6969bde7f06SEric Auger } 6979bde7f06SEric Auger if (CD_S(cd)) { 6989bde7f06SEric Auger goto bad_cd; /* !STE_SECURE && SMMU_IDR0.STALL_MODEL == 1 */ 6999bde7f06SEric Auger } 7009bde7f06SEric Auger if (CD_HA(cd) || CD_HD(cd)) { 7019bde7f06SEric Auger goto bad_cd; /* HTTU = 0 */ 7029bde7f06SEric Auger } 7039bde7f06SEric Auger 7049bde7f06SEric Auger /* we support only those at the moment */ 7059bde7f06SEric Auger cfg->aa64 = true; 706f6cc1980SMostafa Saleh cfg->stage = SMMU_STAGE_1; 7079bde7f06SEric Auger 7089bde7f06SEric Auger cfg->oas = oas2bits(CD_IPS(cd)); 7099bde7f06SEric Auger cfg->oas = MIN(oas2bits(SMMU_IDR5_OAS), cfg->oas); 7109bde7f06SEric Auger cfg->tbi = CD_TBI(cd); 7119bde7f06SEric Auger cfg->asid = CD_ASID(cd); 71215f6c16eSLuc Michel cfg->affd = CD_AFFD(cd); 7139bde7f06SEric Auger 7149bde7f06SEric Auger trace_smmuv3_decode_cd(cfg->oas); 7159bde7f06SEric Auger 7169bde7f06SEric Auger /* decode data dependent on TT */ 7179bde7f06SEric Auger for (i = 0; i <= 1; i++) { 7189bde7f06SEric Auger int tg, tsz; 7199bde7f06SEric Auger SMMUTransTableInfo *tt = &cfg->tt[i]; 7209bde7f06SEric Auger 7219bde7f06SEric Auger cfg->tt[i].disabled = CD_EPD(cd, i); 7229bde7f06SEric Auger if (cfg->tt[i].disabled) { 7239bde7f06SEric Auger continue; 7249bde7f06SEric Auger } 7259bde7f06SEric Auger 7269bde7f06SEric Auger tsz = CD_TSZ(cd, i); 7279bde7f06SEric Auger if (tsz < 16 || tsz > 39) { 7289bde7f06SEric Auger goto bad_cd; 7299bde7f06SEric Auger } 7309bde7f06SEric Auger 7319bde7f06SEric Auger tg = CD_TG(cd, i); 7329bde7f06SEric Auger tt->granule_sz = tg2granule(tg, i); 733bf559ee4SKunkun Jiang if ((tt->granule_sz != 12 && tt->granule_sz != 14 && 734bf559ee4SKunkun Jiang tt->granule_sz != 16) || CD_ENDI(cd)) { 7359bde7f06SEric Auger goto bad_cd; 7369bde7f06SEric Auger } 7379bde7f06SEric Auger 7389bde7f06SEric Auger tt->tsz = tsz; 7399bde7f06SEric Auger tt->ttb = CD_TTB(cd, i); 7409dd6aa9bSMostafa Saleh 7419bde7f06SEric Auger if (tt->ttb & ~(MAKE_64BIT_MASK(0, cfg->oas))) { 7429bde7f06SEric Auger goto bad_cd; 7439bde7f06SEric Auger } 7449dd6aa9bSMostafa Saleh 7459dd6aa9bSMostafa Saleh /* Translate the TTBx, from IPA to PA if nesting is enabled. */ 7469dd6aa9bSMostafa Saleh if (cfg->stage == SMMU_NESTED) { 7479dd6aa9bSMostafa Saleh status = smmuv3_do_translate(s, tt->ttb, cfg, event, IOMMU_RO, 7489dd6aa9bSMostafa Saleh &entry, SMMU_CLASS_TT); 7499dd6aa9bSMostafa Saleh /* 7509dd6aa9bSMostafa Saleh * Same PTW faults are reported but with CLASS = TT. 7519dd6aa9bSMostafa Saleh * If TTBx is larger than the effective stage 1 output addres 7529dd6aa9bSMostafa Saleh * size, it reports C_BAD_CD, which is handled by the above case. 7539dd6aa9bSMostafa Saleh */ 7549dd6aa9bSMostafa Saleh if (status != SMMU_TRANS_SUCCESS) { 7559dd6aa9bSMostafa Saleh return -EINVAL; 7569dd6aa9bSMostafa Saleh } 7579dd6aa9bSMostafa Saleh tt->ttb = CACHED_ENTRY_TO_ADDR(entry, tt->ttb); 7589dd6aa9bSMostafa Saleh } 7599dd6aa9bSMostafa Saleh 760e7c3b9d9SEric Auger tt->had = CD_HAD(cd, i); 761e7c3b9d9SEric Auger trace_smmuv3_decode_cd_tt(i, tt->tsz, tt->ttb, tt->granule_sz, tt->had); 7629bde7f06SEric Auger } 7639bde7f06SEric Auger 764ced71694SJean-Philippe Brucker cfg->record_faults = CD_R(cd); 7659bde7f06SEric Auger 7669bde7f06SEric Auger return 0; 7679bde7f06SEric Auger 7689bde7f06SEric Auger bad_cd: 7699bde7f06SEric Auger event->type = SMMU_EVT_C_BAD_CD; 7709bde7f06SEric Auger return ret; 7719bde7f06SEric Auger } 7729bde7f06SEric Auger 7739bde7f06SEric Auger /** 7749bde7f06SEric Auger * smmuv3_decode_config - Prepare the translation configuration 7759bde7f06SEric Auger * for the @mr iommu region 7769bde7f06SEric Auger * @mr: iommu memory region the translation config must be prepared for 7779bde7f06SEric Auger * @cfg: output translation configuration which is populated through 7789bde7f06SEric Auger * the different configuration decoding steps 7799bde7f06SEric Auger * @event: must be zero'ed by the caller 7809bde7f06SEric Auger * 7819122bea9SJia He * return < 0 in case of config decoding error (@event is filled 7829bde7f06SEric Auger * accordingly). Return 0 otherwise. 7839bde7f06SEric Auger */ 7849bde7f06SEric Auger static int smmuv3_decode_config(IOMMUMemoryRegion *mr, SMMUTransCfg *cfg, 7859bde7f06SEric Auger SMMUEventInfo *event) 7869bde7f06SEric Auger { 7879bde7f06SEric Auger SMMUDevice *sdev = container_of(mr, SMMUDevice, iommu); 7889bde7f06SEric Auger uint32_t sid = smmu_get_sid(sdev); 7899bde7f06SEric Auger SMMUv3State *s = sdev->smmu; 7909122bea9SJia He int ret; 7919bde7f06SEric Auger STE ste; 7929bde7f06SEric Auger CD cd; 7939bde7f06SEric Auger 794cd617556SMostafa Saleh /* ASID defaults to -1 (if s1 is not supported). */ 795cd617556SMostafa Saleh cfg->asid = -1; 796cd617556SMostafa Saleh 7979122bea9SJia He ret = smmu_find_ste(s, sid, &ste, event); 7989122bea9SJia He if (ret) { 7999bde7f06SEric Auger return ret; 8009bde7f06SEric Auger } 8019bde7f06SEric Auger 8029122bea9SJia He ret = decode_ste(s, cfg, &ste, event); 8039122bea9SJia He if (ret) { 8049bde7f06SEric Auger return ret; 8059bde7f06SEric Auger } 8069bde7f06SEric Auger 807f6cc1980SMostafa Saleh if (cfg->aborted || cfg->bypassed || (cfg->stage == SMMU_STAGE_2)) { 8089122bea9SJia He return 0; 8099122bea9SJia He } 8109122bea9SJia He 8119dd6aa9bSMostafa Saleh ret = smmu_get_cd(s, &ste, cfg, 0 /* ssid */, &cd, event); 8129122bea9SJia He if (ret) { 8139bde7f06SEric Auger return ret; 8149bde7f06SEric Auger } 8159bde7f06SEric Auger 8169dd6aa9bSMostafa Saleh return decode_cd(s, cfg, &cd, event); 8179bde7f06SEric Auger } 8189bde7f06SEric Auger 81932cfd7f3SEric Auger /** 82032cfd7f3SEric Auger * smmuv3_get_config - Look up for a cached copy of configuration data for 82132cfd7f3SEric Auger * @sdev and on cache miss performs a configuration structure decoding from 82232cfd7f3SEric Auger * guest RAM. 82332cfd7f3SEric Auger * 82432cfd7f3SEric Auger * @sdev: SMMUDevice handle 82532cfd7f3SEric Auger * @event: output event info 82632cfd7f3SEric Auger * 82732cfd7f3SEric Auger * The configuration cache contains data resulting from both STE and CD 82832cfd7f3SEric Auger * decoding under the form of an SMMUTransCfg struct. The hash table is indexed 82932cfd7f3SEric Auger * by the SMMUDevice handle. 83032cfd7f3SEric Auger */ 83132cfd7f3SEric Auger static SMMUTransCfg *smmuv3_get_config(SMMUDevice *sdev, SMMUEventInfo *event) 83232cfd7f3SEric Auger { 83332cfd7f3SEric Auger SMMUv3State *s = sdev->smmu; 83432cfd7f3SEric Auger SMMUState *bc = &s->smmu_state; 83532cfd7f3SEric Auger SMMUTransCfg *cfg; 83632cfd7f3SEric Auger 83732cfd7f3SEric Auger cfg = g_hash_table_lookup(bc->configs, sdev); 83832cfd7f3SEric Auger if (cfg) { 83932cfd7f3SEric Auger sdev->cfg_cache_hits++; 84032cfd7f3SEric Auger trace_smmuv3_config_cache_hit(smmu_get_sid(sdev), 84132cfd7f3SEric Auger sdev->cfg_cache_hits, sdev->cfg_cache_misses, 84232cfd7f3SEric Auger 100 * sdev->cfg_cache_hits / 84332cfd7f3SEric Auger (sdev->cfg_cache_hits + sdev->cfg_cache_misses)); 84432cfd7f3SEric Auger } else { 84532cfd7f3SEric Auger sdev->cfg_cache_misses++; 84632cfd7f3SEric Auger trace_smmuv3_config_cache_miss(smmu_get_sid(sdev), 84732cfd7f3SEric Auger sdev->cfg_cache_hits, sdev->cfg_cache_misses, 84832cfd7f3SEric Auger 100 * sdev->cfg_cache_hits / 84932cfd7f3SEric Auger (sdev->cfg_cache_hits + sdev->cfg_cache_misses)); 85032cfd7f3SEric Auger cfg = g_new0(SMMUTransCfg, 1); 85132cfd7f3SEric Auger 85232cfd7f3SEric Auger if (!smmuv3_decode_config(&sdev->iommu, cfg, event)) { 85332cfd7f3SEric Auger g_hash_table_insert(bc->configs, sdev, cfg); 85432cfd7f3SEric Auger } else { 85532cfd7f3SEric Auger g_free(cfg); 85632cfd7f3SEric Auger cfg = NULL; 85732cfd7f3SEric Auger } 85832cfd7f3SEric Auger } 85932cfd7f3SEric Auger return cfg; 86032cfd7f3SEric Auger } 86132cfd7f3SEric Auger 86232cfd7f3SEric Auger static void smmuv3_flush_config(SMMUDevice *sdev) 86332cfd7f3SEric Auger { 86432cfd7f3SEric Auger SMMUv3State *s = sdev->smmu; 86532cfd7f3SEric Auger SMMUState *bc = &s->smmu_state; 86632cfd7f3SEric Auger 86732cfd7f3SEric Auger trace_smmuv3_config_cache_inv(smmu_get_sid(sdev)); 86832cfd7f3SEric Auger g_hash_table_remove(bc->configs, sdev); 86932cfd7f3SEric Auger } 87032cfd7f3SEric Auger 871a9e3f4c1SMostafa Saleh /* Do translation with TLB lookup. */ 872a9e3f4c1SMostafa Saleh static SMMUTranslationStatus smmuv3_do_translate(SMMUv3State *s, hwaddr addr, 873a9e3f4c1SMostafa Saleh SMMUTransCfg *cfg, 874a9e3f4c1SMostafa Saleh SMMUEventInfo *event, 875a9e3f4c1SMostafa Saleh IOMMUAccessFlags flag, 8769dd6aa9bSMostafa Saleh SMMUTLBEntry **out_entry, 8779dd6aa9bSMostafa Saleh SMMUTranslationClass class) 878a9e3f4c1SMostafa Saleh { 879a9e3f4c1SMostafa Saleh SMMUPTWEventInfo ptw_info = {}; 880a9e3f4c1SMostafa Saleh SMMUState *bs = ARM_SMMU(s); 881a9e3f4c1SMostafa Saleh SMMUTLBEntry *cached_entry = NULL; 8829dd6aa9bSMostafa Saleh int asid, stage; 8839dd6aa9bSMostafa Saleh bool desc_s2_translation = class != SMMU_CLASS_IN; 8849dd6aa9bSMostafa Saleh 8859dd6aa9bSMostafa Saleh /* 8869dd6aa9bSMostafa Saleh * The function uses the argument class to identify which stage is used: 8879dd6aa9bSMostafa Saleh * - CLASS = IN: Means an input translation, determine the stage from STE. 8889dd6aa9bSMostafa Saleh * - CLASS = CD: Means the addr is an IPA of the CD, and it would be 8899dd6aa9bSMostafa Saleh * translated using the stage-2. 8909dd6aa9bSMostafa Saleh * - CLASS = TT: Means the addr is an IPA of the stage-1 translation table 8919dd6aa9bSMostafa Saleh * and it would be translated using the stage-2. 8929dd6aa9bSMostafa Saleh * For the last 2 cases instead of having intrusive changes in the common 8939dd6aa9bSMostafa Saleh * logic, we modify the cfg to be a stage-2 translation only in case of 8949dd6aa9bSMostafa Saleh * nested, and then restore it after. 8959dd6aa9bSMostafa Saleh */ 8969dd6aa9bSMostafa Saleh if (desc_s2_translation) { 8979dd6aa9bSMostafa Saleh asid = cfg->asid; 8989dd6aa9bSMostafa Saleh stage = cfg->stage; 8999dd6aa9bSMostafa Saleh cfg->asid = -1; 9009dd6aa9bSMostafa Saleh cfg->stage = SMMU_STAGE_2; 9019dd6aa9bSMostafa Saleh } 902a9e3f4c1SMostafa Saleh 903a9e3f4c1SMostafa Saleh cached_entry = smmu_translate(bs, cfg, addr, flag, &ptw_info); 9049dd6aa9bSMostafa Saleh 9059dd6aa9bSMostafa Saleh if (desc_s2_translation) { 9069dd6aa9bSMostafa Saleh cfg->asid = asid; 9079dd6aa9bSMostafa Saleh cfg->stage = stage; 9089dd6aa9bSMostafa Saleh } 9099dd6aa9bSMostafa Saleh 910a9e3f4c1SMostafa Saleh if (!cached_entry) { 911a9e3f4c1SMostafa Saleh /* All faults from PTW has S2 field. */ 912a9e3f4c1SMostafa Saleh event->u.f_walk_eabt.s2 = (ptw_info.stage == SMMU_STAGE_2); 913f42a0a57SMostafa Saleh /* 914f42a0a57SMostafa Saleh * Fault class is set as follows based on "class" input to 915f42a0a57SMostafa Saleh * the function and to "ptw_info" from "smmu_translate()" 916f42a0a57SMostafa Saleh * For stage-1: 917f42a0a57SMostafa Saleh * - EABT => CLASS_TT (hardcoded) 918f42a0a57SMostafa Saleh * - other events => CLASS_IN (input to function) 919f42a0a57SMostafa Saleh * For stage-2 => CLASS_IN (input to function) 920f42a0a57SMostafa Saleh * For nested, for all events: 921f42a0a57SMostafa Saleh * - CD fetch => CLASS_CD (input to function) 922f42a0a57SMostafa Saleh * - walking stage 1 translation table => CLASS_TT (from 923f42a0a57SMostafa Saleh * is_ipa_descriptor or input in case of TTBx) 924f42a0a57SMostafa Saleh * - s2 translation => CLASS_IN (input to function) 925f42a0a57SMostafa Saleh */ 926f42a0a57SMostafa Saleh class = ptw_info.is_ipa_descriptor ? SMMU_CLASS_TT : class; 927a9e3f4c1SMostafa Saleh switch (ptw_info.type) { 928a9e3f4c1SMostafa Saleh case SMMU_PTW_ERR_WALK_EABT: 929a9e3f4c1SMostafa Saleh event->type = SMMU_EVT_F_WALK_EABT; 930a9e3f4c1SMostafa Saleh event->u.f_walk_eabt.rnw = flag & 0x1; 931a9e3f4c1SMostafa Saleh event->u.f_walk_eabt.class = (ptw_info.stage == SMMU_STAGE_2) ? 9329dd6aa9bSMostafa Saleh class : SMMU_CLASS_TT; 933a9e3f4c1SMostafa Saleh event->u.f_walk_eabt.addr2 = ptw_info.addr; 934a9e3f4c1SMostafa Saleh break; 935a9e3f4c1SMostafa Saleh case SMMU_PTW_ERR_TRANSLATION: 936a9e3f4c1SMostafa Saleh if (PTW_RECORD_FAULT(cfg)) { 937a9e3f4c1SMostafa Saleh event->type = SMMU_EVT_F_TRANSLATION; 938a9e3f4c1SMostafa Saleh event->u.f_translation.addr2 = ptw_info.addr; 9399dd6aa9bSMostafa Saleh event->u.f_translation.class = class; 940a9e3f4c1SMostafa Saleh event->u.f_translation.rnw = flag & 0x1; 941a9e3f4c1SMostafa Saleh } 942a9e3f4c1SMostafa Saleh break; 943a9e3f4c1SMostafa Saleh case SMMU_PTW_ERR_ADDR_SIZE: 944a9e3f4c1SMostafa Saleh if (PTW_RECORD_FAULT(cfg)) { 945a9e3f4c1SMostafa Saleh event->type = SMMU_EVT_F_ADDR_SIZE; 946a9e3f4c1SMostafa Saleh event->u.f_addr_size.addr2 = ptw_info.addr; 9479dd6aa9bSMostafa Saleh event->u.f_addr_size.class = class; 948a9e3f4c1SMostafa Saleh event->u.f_addr_size.rnw = flag & 0x1; 949a9e3f4c1SMostafa Saleh } 950a9e3f4c1SMostafa Saleh break; 951a9e3f4c1SMostafa Saleh case SMMU_PTW_ERR_ACCESS: 952a9e3f4c1SMostafa Saleh if (PTW_RECORD_FAULT(cfg)) { 953a9e3f4c1SMostafa Saleh event->type = SMMU_EVT_F_ACCESS; 954a9e3f4c1SMostafa Saleh event->u.f_access.addr2 = ptw_info.addr; 9559dd6aa9bSMostafa Saleh event->u.f_access.class = class; 956a9e3f4c1SMostafa Saleh event->u.f_access.rnw = flag & 0x1; 957a9e3f4c1SMostafa Saleh } 958a9e3f4c1SMostafa Saleh break; 959a9e3f4c1SMostafa Saleh case SMMU_PTW_ERR_PERMISSION: 960a9e3f4c1SMostafa Saleh if (PTW_RECORD_FAULT(cfg)) { 961a9e3f4c1SMostafa Saleh event->type = SMMU_EVT_F_PERMISSION; 962a9e3f4c1SMostafa Saleh event->u.f_permission.addr2 = ptw_info.addr; 9639dd6aa9bSMostafa Saleh event->u.f_permission.class = class; 964a9e3f4c1SMostafa Saleh event->u.f_permission.rnw = flag & 0x1; 965a9e3f4c1SMostafa Saleh } 966a9e3f4c1SMostafa Saleh break; 967a9e3f4c1SMostafa Saleh default: 968a9e3f4c1SMostafa Saleh g_assert_not_reached(); 969a9e3f4c1SMostafa Saleh } 970a9e3f4c1SMostafa Saleh return SMMU_TRANS_ERROR; 971a9e3f4c1SMostafa Saleh } 972a9e3f4c1SMostafa Saleh *out_entry = cached_entry; 973a9e3f4c1SMostafa Saleh return SMMU_TRANS_SUCCESS; 974a9e3f4c1SMostafa Saleh } 975a9e3f4c1SMostafa Saleh 9769dd6aa9bSMostafa Saleh /* 9779dd6aa9bSMostafa Saleh * Sets the InputAddr for an SMMU_TRANS_ERROR, as it can't be 9789dd6aa9bSMostafa Saleh * set from all contexts, as smmuv3_get_config() can return 9799dd6aa9bSMostafa Saleh * translation faults in case of nested translation (for CD 9809dd6aa9bSMostafa Saleh * and TTBx). But in that case the iova is not known. 9819dd6aa9bSMostafa Saleh */ 9829dd6aa9bSMostafa Saleh static void smmuv3_fixup_event(SMMUEventInfo *event, hwaddr iova) 9839dd6aa9bSMostafa Saleh { 9849dd6aa9bSMostafa Saleh switch (event->type) { 9859dd6aa9bSMostafa Saleh case SMMU_EVT_F_WALK_EABT: 9869dd6aa9bSMostafa Saleh case SMMU_EVT_F_TRANSLATION: 9879dd6aa9bSMostafa Saleh case SMMU_EVT_F_ADDR_SIZE: 9889dd6aa9bSMostafa Saleh case SMMU_EVT_F_ACCESS: 9899dd6aa9bSMostafa Saleh case SMMU_EVT_F_PERMISSION: 9909dd6aa9bSMostafa Saleh event->u.f_walk_eabt.addr = iova; 9919dd6aa9bSMostafa Saleh break; 9929dd6aa9bSMostafa Saleh default: 9939dd6aa9bSMostafa Saleh break; 9949dd6aa9bSMostafa Saleh } 9959dd6aa9bSMostafa Saleh } 9969dd6aa9bSMostafa Saleh 997a9e3f4c1SMostafa Saleh /* Entry point to SMMU, does everything. */ 9989bde7f06SEric Auger static IOMMUTLBEntry smmuv3_translate(IOMMUMemoryRegion *mr, hwaddr addr, 9992c91bcf2SPeter Maydell IOMMUAccessFlags flag, int iommu_idx) 10009bde7f06SEric Auger { 10019bde7f06SEric Auger SMMUDevice *sdev = container_of(mr, SMMUDevice, iommu); 10029bde7f06SEric Auger SMMUv3State *s = sdev->smmu; 10039bde7f06SEric Auger uint32_t sid = smmu_get_sid(sdev); 10043499ec08SEric Auger SMMUEventInfo event = {.type = SMMU_EVT_NONE, 10053499ec08SEric Auger .sid = sid, 10063499ec08SEric Auger .inval_ste_allowed = false}; 10079122bea9SJia He SMMUTranslationStatus status; 100832cfd7f3SEric Auger SMMUTransCfg *cfg = NULL; 10099bde7f06SEric Auger IOMMUTLBEntry entry = { 10109bde7f06SEric Auger .target_as = &address_space_memory, 10119bde7f06SEric Auger .iova = addr, 10129bde7f06SEric Auger .translated_addr = addr, 10139bde7f06SEric Auger .addr_mask = ~(hwaddr)0, 10149bde7f06SEric Auger .perm = IOMMU_NONE, 10159bde7f06SEric Auger }; 1016a9e3f4c1SMostafa Saleh SMMUTLBEntry *cached_entry = NULL; 10179bde7f06SEric Auger 101832cfd7f3SEric Auger qemu_mutex_lock(&s->mutex); 101932cfd7f3SEric Auger 10209bde7f06SEric Auger if (!smmu_enabled(s)) { 1021c2ecb424SMostafa Saleh if (FIELD_EX32(s->gbpa, GBPA, ABORT)) { 1022c2ecb424SMostafa Saleh status = SMMU_TRANS_ABORT; 1023c2ecb424SMostafa Saleh } else { 10249122bea9SJia He status = SMMU_TRANS_DISABLE; 1025c2ecb424SMostafa Saleh } 10269122bea9SJia He goto epilogue; 10279bde7f06SEric Auger } 10289bde7f06SEric Auger 102932cfd7f3SEric Auger cfg = smmuv3_get_config(sdev, &event); 103032cfd7f3SEric Auger if (!cfg) { 10319122bea9SJia He status = SMMU_TRANS_ERROR; 10329122bea9SJia He goto epilogue; 10339bde7f06SEric Auger } 10349bde7f06SEric Auger 103532cfd7f3SEric Auger if (cfg->aborted) { 10369122bea9SJia He status = SMMU_TRANS_ABORT; 10379122bea9SJia He goto epilogue; 10389bde7f06SEric Auger } 10399bde7f06SEric Auger 104032cfd7f3SEric Auger if (cfg->bypassed) { 10419122bea9SJia He status = SMMU_TRANS_BYPASS; 10429122bea9SJia He goto epilogue; 10439122bea9SJia He } 10449122bea9SJia He 10459dd6aa9bSMostafa Saleh status = smmuv3_do_translate(s, addr, cfg, &event, flag, 10469dd6aa9bSMostafa Saleh &cached_entry, SMMU_CLASS_IN); 10479122bea9SJia He 10489122bea9SJia He epilogue: 104932cfd7f3SEric Auger qemu_mutex_unlock(&s->mutex); 10509122bea9SJia He switch (status) { 10519122bea9SJia He case SMMU_TRANS_SUCCESS: 1052c3ca7d56SXiang Chen entry.perm = cached_entry->entry.perm; 1053ec31ef91SMostafa Saleh entry.translated_addr = CACHED_ENTRY_TO_ADDR(cached_entry, addr); 1054a7550158SEric Auger entry.addr_mask = cached_entry->entry.addr_mask; 10559122bea9SJia He trace_smmuv3_translate_success(mr->parent_obj.name, sid, addr, 1056a9e3f4c1SMostafa Saleh entry.translated_addr, entry.perm, 1057a9e3f4c1SMostafa Saleh cfg->stage); 10589122bea9SJia He break; 10599122bea9SJia He case SMMU_TRANS_DISABLE: 10609122bea9SJia He entry.perm = flag; 10619122bea9SJia He entry.addr_mask = ~TARGET_PAGE_MASK; 10629122bea9SJia He trace_smmuv3_translate_disable(mr->parent_obj.name, sid, addr, 10639122bea9SJia He entry.perm); 10649122bea9SJia He break; 10659122bea9SJia He case SMMU_TRANS_BYPASS: 10669122bea9SJia He entry.perm = flag; 10679122bea9SJia He entry.addr_mask = ~TARGET_PAGE_MASK; 10689122bea9SJia He trace_smmuv3_translate_bypass(mr->parent_obj.name, sid, addr, 10699122bea9SJia He entry.perm); 10709122bea9SJia He break; 10719122bea9SJia He case SMMU_TRANS_ABORT: 10729122bea9SJia He /* no event is recorded on abort */ 10739122bea9SJia He trace_smmuv3_translate_abort(mr->parent_obj.name, sid, addr, 10749122bea9SJia He entry.perm); 10759122bea9SJia He break; 10769122bea9SJia He case SMMU_TRANS_ERROR: 10779dd6aa9bSMostafa Saleh smmuv3_fixup_event(&event, addr); 10789122bea9SJia He qemu_log_mask(LOG_GUEST_ERROR, 10799122bea9SJia He "%s translation failed for iova=0x%"PRIx64" (%s)\n", 10809122bea9SJia He mr->parent_obj.name, addr, smmu_event_string(event.type)); 10819122bea9SJia He smmuv3_record_event(s, &event); 10829122bea9SJia He break; 10839bde7f06SEric Auger } 10849bde7f06SEric Auger 10859bde7f06SEric Auger return entry; 10869bde7f06SEric Auger } 10879bde7f06SEric Auger 1088832e4222SEric Auger /** 1089832e4222SEric Auger * smmuv3_notify_iova - call the notifier @n for a given 1090832e4222SEric Auger * @asid and @iova tuple. 1091832e4222SEric Auger * 1092832e4222SEric Auger * @mr: IOMMU mr region handle 1093832e4222SEric Auger * @n: notifier to be called 1094832e4222SEric Auger * @asid: address space ID or negative value if we don't care 109532bd7baeSMostafa Saleh * @vmid: virtual machine ID or negative value if we don't care 1096832e4222SEric Auger * @iova: iova 1097d5291561SEric Auger * @tg: translation granule (if communicated through range invalidation) 1098d5291561SEric Auger * @num_pages: number of @granule sized pages (if tg != 0), otherwise 1 1099832e4222SEric Auger */ 1100832e4222SEric Auger static void smmuv3_notify_iova(IOMMUMemoryRegion *mr, 1101832e4222SEric Auger IOMMUNotifier *n, 110232bd7baeSMostafa Saleh int asid, int vmid, 110332bd7baeSMostafa Saleh dma_addr_t iova, uint8_t tg, 110432bd7baeSMostafa Saleh uint64_t num_pages) 1105832e4222SEric Auger { 1106832e4222SEric Auger SMMUDevice *sdev = container_of(mr, SMMUDevice, iommu); 11075039caf3SEugenio Pérez IOMMUTLBEvent event; 1108dcda883cSZenghui Yu uint8_t granule; 110932bd7baeSMostafa Saleh SMMUv3State *s = sdev->smmu; 1110832e4222SEric Auger 1111d5291561SEric Auger if (!tg) { 11129e2135eeSPeter Maydell SMMUEventInfo eventinfo = {.inval_ste_allowed = true}; 11139e2135eeSPeter Maydell SMMUTransCfg *cfg = smmuv3_get_config(sdev, &eventinfo); 1114d5291561SEric Auger SMMUTransTableInfo *tt; 1115d5291561SEric Auger 1116832e4222SEric Auger if (!cfg) { 1117832e4222SEric Auger return; 1118832e4222SEric Auger } 1119832e4222SEric Auger 1120832e4222SEric Auger if (asid >= 0 && cfg->asid != asid) { 1121832e4222SEric Auger return; 1122832e4222SEric Auger } 1123832e4222SEric Auger 112432bd7baeSMostafa Saleh if (vmid >= 0 && cfg->s2cfg.vmid != vmid) { 112532bd7baeSMostafa Saleh return; 112632bd7baeSMostafa Saleh } 112732bd7baeSMostafa Saleh 112832bd7baeSMostafa Saleh if (STAGE1_SUPPORTED(s)) { 1129832e4222SEric Auger tt = select_tt(cfg, iova); 1130832e4222SEric Auger if (!tt) { 1131832e4222SEric Auger return; 1132832e4222SEric Auger } 1133d5291561SEric Auger granule = tt->granule_sz; 1134dcda883cSZenghui Yu } else { 113532bd7baeSMostafa Saleh granule = cfg->s2cfg.granule_sz; 113632bd7baeSMostafa Saleh } 113732bd7baeSMostafa Saleh 113832bd7baeSMostafa Saleh } else { 1139dcda883cSZenghui Yu granule = tg * 2 + 10; 1140d5291561SEric Auger } 1141832e4222SEric Auger 11425039caf3SEugenio Pérez event.type = IOMMU_NOTIFIER_UNMAP; 11435039caf3SEugenio Pérez event.entry.target_as = &address_space_memory; 11445039caf3SEugenio Pérez event.entry.iova = iova; 11455039caf3SEugenio Pérez event.entry.addr_mask = num_pages * (1 << granule) - 1; 11465039caf3SEugenio Pérez event.entry.perm = IOMMU_NONE; 1147832e4222SEric Auger 11485039caf3SEugenio Pérez memory_region_notify_iommu_one(n, &event); 1149832e4222SEric Auger } 1150832e4222SEric Auger 115132bd7baeSMostafa Saleh /* invalidate an asid/vmid/iova range tuple in all mr's */ 115232bd7baeSMostafa Saleh static void smmuv3_inv_notifiers_iova(SMMUState *s, int asid, int vmid, 115332bd7baeSMostafa Saleh dma_addr_t iova, uint8_t tg, 115432bd7baeSMostafa Saleh uint64_t num_pages) 1155832e4222SEric Auger { 1156c6370441SEric Auger SMMUDevice *sdev; 1157832e4222SEric Auger 1158c6370441SEric Auger QLIST_FOREACH(sdev, &s->devices_with_notifiers, next) { 1159c6370441SEric Auger IOMMUMemoryRegion *mr = &sdev->iommu; 1160832e4222SEric Auger IOMMUNotifier *n; 1161832e4222SEric Auger 116232bd7baeSMostafa Saleh trace_smmuv3_inv_notifiers_iova(mr->parent_obj.name, asid, vmid, 116332bd7baeSMostafa Saleh iova, tg, num_pages); 1164832e4222SEric Auger 1165832e4222SEric Auger IOMMU_NOTIFIER_FOREACH(n, mr) { 116632bd7baeSMostafa Saleh smmuv3_notify_iova(mr, n, asid, vmid, iova, tg, num_pages); 1167832e4222SEric Auger } 1168832e4222SEric Auger } 1169832e4222SEric Auger } 1170832e4222SEric Auger 1171*1ea8a6f5SMostafa Saleh static void smmuv3_range_inval(SMMUState *s, Cmd *cmd, SMMUStage stage) 1172c0f9ef70SEric Auger { 1173219729cfSEric Auger dma_addr_t end, addr = CMD_ADDR(cmd); 1174c0f9ef70SEric Auger uint8_t type = CMD_TYPE(cmd); 11752eaeb7d5SMostafa Saleh int vmid = -1; 1176219729cfSEric Auger uint8_t scale = CMD_SCALE(cmd); 1177219729cfSEric Auger uint8_t num = CMD_NUM(cmd); 1178219729cfSEric Auger uint8_t ttl = CMD_TTL(cmd); 1179c0f9ef70SEric Auger bool leaf = CMD_LEAF(cmd); 1180d5291561SEric Auger uint8_t tg = CMD_TG(cmd); 1181219729cfSEric Auger uint64_t num_pages; 1182219729cfSEric Auger uint8_t granule; 1183c0f9ef70SEric Auger int asid = -1; 11842eaeb7d5SMostafa Saleh SMMUv3State *smmuv3 = ARM_SMMUV3(s); 11852eaeb7d5SMostafa Saleh 11862eaeb7d5SMostafa Saleh /* Only consider VMID if stage-2 is supported. */ 11872eaeb7d5SMostafa Saleh if (STAGE2_SUPPORTED(smmuv3)) { 11882eaeb7d5SMostafa Saleh vmid = CMD_VMID(cmd); 11892eaeb7d5SMostafa Saleh } 1190c0f9ef70SEric Auger 1191c0f9ef70SEric Auger if (type == SMMU_CMD_TLBI_NH_VA) { 1192c0f9ef70SEric Auger asid = CMD_ASID(cmd); 1193c0f9ef70SEric Auger } 11946d9cd115SEric Auger 1195219729cfSEric Auger if (!tg) { 1196*1ea8a6f5SMostafa Saleh trace_smmuv3_range_inval(vmid, asid, addr, tg, 1, ttl, leaf, stage); 119732bd7baeSMostafa Saleh smmuv3_inv_notifiers_iova(s, asid, vmid, addr, tg, 1); 1198*1ea8a6f5SMostafa Saleh if (stage == SMMU_STAGE_1) { 11992eaeb7d5SMostafa Saleh smmu_iotlb_inv_iova(s, asid, vmid, addr, tg, 1, ttl); 1200*1ea8a6f5SMostafa Saleh } else { 1201*1ea8a6f5SMostafa Saleh smmu_iotlb_inv_ipa(s, vmid, addr, tg, 1, ttl); 1202*1ea8a6f5SMostafa Saleh } 1203219729cfSEric Auger return; 1204219729cfSEric Auger } 1205219729cfSEric Auger 1206219729cfSEric Auger /* RIL in use */ 1207219729cfSEric Auger 1208219729cfSEric Auger num_pages = (num + 1) * BIT_ULL(scale); 1209219729cfSEric Auger granule = tg * 2 + 10; 1210219729cfSEric Auger 12116d9cd115SEric Auger /* Split invalidations into ^2 range invalidations */ 1212219729cfSEric Auger end = addr + (num_pages << granule) - 1; 12136d9cd115SEric Auger 1214219729cfSEric Auger while (addr != end + 1) { 1215219729cfSEric Auger uint64_t mask = dma_aligned_pow2_mask(addr, end, 64); 12166d9cd115SEric Auger 1217219729cfSEric Auger num_pages = (mask + 1) >> granule; 1218*1ea8a6f5SMostafa Saleh trace_smmuv3_range_inval(vmid, asid, addr, tg, num_pages, 1219*1ea8a6f5SMostafa Saleh ttl, leaf, stage); 122032bd7baeSMostafa Saleh smmuv3_inv_notifiers_iova(s, asid, vmid, addr, tg, num_pages); 1221*1ea8a6f5SMostafa Saleh if (stage == SMMU_STAGE_1) { 12222eaeb7d5SMostafa Saleh smmu_iotlb_inv_iova(s, asid, vmid, addr, tg, num_pages, ttl); 1223*1ea8a6f5SMostafa Saleh } else { 1224*1ea8a6f5SMostafa Saleh smmu_iotlb_inv_ipa(s, vmid, addr, tg, num_pages, ttl); 1225*1ea8a6f5SMostafa Saleh } 1226219729cfSEric Auger addr += mask + 1; 12276d9cd115SEric Auger } 1228c0f9ef70SEric Auger } 1229c0f9ef70SEric Auger 12301194140bSEric Auger static gboolean 12311194140bSEric Auger smmuv3_invalidate_ste(gpointer key, gpointer value, gpointer user_data) 12321194140bSEric Auger { 12331194140bSEric Auger SMMUDevice *sdev = (SMMUDevice *)key; 12341194140bSEric Auger uint32_t sid = smmu_get_sid(sdev); 12351194140bSEric Auger SMMUSIDRange *sid_range = (SMMUSIDRange *)user_data; 12361194140bSEric Auger 12371194140bSEric Auger if (sid < sid_range->start || sid > sid_range->end) { 12381194140bSEric Auger return false; 12391194140bSEric Auger } 12401194140bSEric Auger trace_smmuv3_config_cache_inv(sid); 12411194140bSEric Auger return true; 12421194140bSEric Auger } 12431194140bSEric Auger 1244fae4be38SEric Auger static int smmuv3_cmdq_consume(SMMUv3State *s) 1245dadd1a08SEric Auger { 124632cfd7f3SEric Auger SMMUState *bs = ARM_SMMU(s); 1247dadd1a08SEric Auger SMMUCmdError cmd_error = SMMU_CERROR_NONE; 1248dadd1a08SEric Auger SMMUQueue *q = &s->cmdq; 1249dadd1a08SEric Auger SMMUCommandType type = 0; 1250dadd1a08SEric Auger 1251dadd1a08SEric Auger if (!smmuv3_cmdq_enabled(s)) { 1252dadd1a08SEric Auger return 0; 1253dadd1a08SEric Auger } 1254dadd1a08SEric Auger /* 1255dadd1a08SEric Auger * some commands depend on register values, typically CR0. In case those 1256dadd1a08SEric Auger * register values change while handling the command, spec says it 1257dadd1a08SEric Auger * is UNPREDICTABLE whether the command is interpreted under the new 1258dadd1a08SEric Auger * or old value. 1259dadd1a08SEric Auger */ 1260dadd1a08SEric Auger 1261dadd1a08SEric Auger while (!smmuv3_q_empty(q)) { 1262dadd1a08SEric Auger uint32_t pending = s->gerror ^ s->gerrorn; 1263dadd1a08SEric Auger Cmd cmd; 1264dadd1a08SEric Auger 1265dadd1a08SEric Auger trace_smmuv3_cmdq_consume(Q_PROD(q), Q_CONS(q), 1266dadd1a08SEric Auger Q_PROD_WRAP(q), Q_CONS_WRAP(q)); 1267dadd1a08SEric Auger 1268dadd1a08SEric Auger if (FIELD_EX32(pending, GERROR, CMDQ_ERR)) { 1269dadd1a08SEric Auger break; 1270dadd1a08SEric Auger } 1271dadd1a08SEric Auger 1272dadd1a08SEric Auger if (queue_read(q, &cmd) != MEMTX_OK) { 1273dadd1a08SEric Auger cmd_error = SMMU_CERROR_ABT; 1274dadd1a08SEric Auger break; 1275dadd1a08SEric Auger } 1276dadd1a08SEric Auger 1277dadd1a08SEric Auger type = CMD_TYPE(&cmd); 1278dadd1a08SEric Auger 1279dadd1a08SEric Auger trace_smmuv3_cmdq_opcode(smmu_cmd_string(type)); 1280dadd1a08SEric Auger 128132cfd7f3SEric Auger qemu_mutex_lock(&s->mutex); 1282dadd1a08SEric Auger switch (type) { 1283dadd1a08SEric Auger case SMMU_CMD_SYNC: 1284dadd1a08SEric Auger if (CMD_SYNC_CS(&cmd) & CMD_SYNC_SIG_IRQ) { 1285dadd1a08SEric Auger smmuv3_trigger_irq(s, SMMU_IRQ_CMD_SYNC, 0); 1286dadd1a08SEric Auger } 1287dadd1a08SEric Auger break; 1288dadd1a08SEric Auger case SMMU_CMD_PREFETCH_CONFIG: 1289dadd1a08SEric Auger case SMMU_CMD_PREFETCH_ADDR: 129032cfd7f3SEric Auger break; 1291dadd1a08SEric Auger case SMMU_CMD_CFGI_STE: 129232cfd7f3SEric Auger { 129332cfd7f3SEric Auger uint32_t sid = CMD_SID(&cmd); 129469970205SNicolin Chen SMMUDevice *sdev = smmu_find_sdev(bs, sid); 129532cfd7f3SEric Auger 129632cfd7f3SEric Auger if (CMD_SSEC(&cmd)) { 129732cfd7f3SEric Auger cmd_error = SMMU_CERROR_ILL; 129832cfd7f3SEric Auger break; 129932cfd7f3SEric Auger } 130032cfd7f3SEric Auger 130169970205SNicolin Chen if (!sdev) { 130232cfd7f3SEric Auger break; 130332cfd7f3SEric Auger } 130432cfd7f3SEric Auger 130532cfd7f3SEric Auger trace_smmuv3_cmdq_cfgi_ste(sid); 130632cfd7f3SEric Auger smmuv3_flush_config(sdev); 130732cfd7f3SEric Auger 130832cfd7f3SEric Auger break; 130932cfd7f3SEric Auger } 1310dadd1a08SEric Auger case SMMU_CMD_CFGI_STE_RANGE: /* same as SMMU_CMD_CFGI_ALL */ 131132cfd7f3SEric Auger { 1312017a913aSZenghui Yu uint32_t sid = CMD_SID(&cmd), mask; 131332cfd7f3SEric Auger uint8_t range = CMD_STE_RANGE(&cmd); 1314017a913aSZenghui Yu SMMUSIDRange sid_range; 131532cfd7f3SEric Auger 131632cfd7f3SEric Auger if (CMD_SSEC(&cmd)) { 131732cfd7f3SEric Auger cmd_error = SMMU_CERROR_ILL; 131832cfd7f3SEric Auger break; 131932cfd7f3SEric Auger } 1320017a913aSZenghui Yu 1321017a913aSZenghui Yu mask = (1ULL << (range + 1)) - 1; 1322017a913aSZenghui Yu sid_range.start = sid & ~mask; 1323017a913aSZenghui Yu sid_range.end = sid_range.start + mask; 1324017a913aSZenghui Yu 1325017a913aSZenghui Yu trace_smmuv3_cmdq_cfgi_ste_range(sid_range.start, sid_range.end); 13261194140bSEric Auger g_hash_table_foreach_remove(bs->configs, smmuv3_invalidate_ste, 13271194140bSEric Auger &sid_range); 132832cfd7f3SEric Auger break; 132932cfd7f3SEric Auger } 1330dadd1a08SEric Auger case SMMU_CMD_CFGI_CD: 1331dadd1a08SEric Auger case SMMU_CMD_CFGI_CD_ALL: 133232cfd7f3SEric Auger { 133332cfd7f3SEric Auger uint32_t sid = CMD_SID(&cmd); 133469970205SNicolin Chen SMMUDevice *sdev = smmu_find_sdev(bs, sid); 133532cfd7f3SEric Auger 133632cfd7f3SEric Auger if (CMD_SSEC(&cmd)) { 133732cfd7f3SEric Auger cmd_error = SMMU_CERROR_ILL; 133832cfd7f3SEric Auger break; 133932cfd7f3SEric Auger } 134032cfd7f3SEric Auger 134169970205SNicolin Chen if (!sdev) { 134232cfd7f3SEric Auger break; 134332cfd7f3SEric Auger } 134432cfd7f3SEric Auger 134532cfd7f3SEric Auger trace_smmuv3_cmdq_cfgi_cd(sid); 134632cfd7f3SEric Auger smmuv3_flush_config(sdev); 134732cfd7f3SEric Auger break; 134832cfd7f3SEric Auger } 1349dadd1a08SEric Auger case SMMU_CMD_TLBI_NH_ASID: 1350cc27ed81SEric Auger { 1351d8838226SMostafa Saleh int asid = CMD_ASID(&cmd); 1352cc27ed81SEric Auger 1353ccc3ee38SMostafa Saleh if (!STAGE1_SUPPORTED(s)) { 1354ccc3ee38SMostafa Saleh cmd_error = SMMU_CERROR_ILL; 1355ccc3ee38SMostafa Saleh break; 1356ccc3ee38SMostafa Saleh } 1357ccc3ee38SMostafa Saleh 1358cc27ed81SEric Auger trace_smmuv3_cmdq_tlbi_nh_asid(asid); 1359832e4222SEric Auger smmu_inv_notifiers_all(&s->smmu_state); 1360cc27ed81SEric Auger smmu_iotlb_inv_asid(bs, asid); 1361cc27ed81SEric Auger break; 1362cc27ed81SEric Auger } 1363cc27ed81SEric Auger case SMMU_CMD_TLBI_NH_ALL: 1364ccc3ee38SMostafa Saleh if (!STAGE1_SUPPORTED(s)) { 1365ccc3ee38SMostafa Saleh cmd_error = SMMU_CERROR_ILL; 1366ccc3ee38SMostafa Saleh break; 1367ccc3ee38SMostafa Saleh } 1368ccc3ee38SMostafa Saleh QEMU_FALLTHROUGH; 1369cc27ed81SEric Auger case SMMU_CMD_TLBI_NSNH_ALL: 1370cc27ed81SEric Auger trace_smmuv3_cmdq_tlbi_nh(); 1371832e4222SEric Auger smmu_inv_notifiers_all(&s->smmu_state); 1372cc27ed81SEric Auger smmu_iotlb_inv_all(bs); 1373cc27ed81SEric Auger break; 1374dadd1a08SEric Auger case SMMU_CMD_TLBI_NH_VAA: 1375cc27ed81SEric Auger case SMMU_CMD_TLBI_NH_VA: 1376ccc3ee38SMostafa Saleh if (!STAGE1_SUPPORTED(s)) { 1377ccc3ee38SMostafa Saleh cmd_error = SMMU_CERROR_ILL; 1378ccc3ee38SMostafa Saleh break; 1379ccc3ee38SMostafa Saleh } 1380*1ea8a6f5SMostafa Saleh smmuv3_range_inval(bs, &cmd, SMMU_STAGE_1); 1381ccc3ee38SMostafa Saleh break; 1382ccc3ee38SMostafa Saleh case SMMU_CMD_TLBI_S12_VMALL: 1383ccc3ee38SMostafa Saleh { 1384d8838226SMostafa Saleh int vmid = CMD_VMID(&cmd); 1385ccc3ee38SMostafa Saleh 1386ccc3ee38SMostafa Saleh if (!STAGE2_SUPPORTED(s)) { 1387ccc3ee38SMostafa Saleh cmd_error = SMMU_CERROR_ILL; 1388ccc3ee38SMostafa Saleh break; 1389ccc3ee38SMostafa Saleh } 1390ccc3ee38SMostafa Saleh 1391ccc3ee38SMostafa Saleh trace_smmuv3_cmdq_tlbi_s12_vmid(vmid); 1392ccc3ee38SMostafa Saleh smmu_inv_notifiers_all(&s->smmu_state); 1393ccc3ee38SMostafa Saleh smmu_iotlb_inv_vmid(bs, vmid); 1394ccc3ee38SMostafa Saleh break; 1395ccc3ee38SMostafa Saleh } 1396ccc3ee38SMostafa Saleh case SMMU_CMD_TLBI_S2_IPA: 1397ccc3ee38SMostafa Saleh if (!STAGE2_SUPPORTED(s)) { 1398ccc3ee38SMostafa Saleh cmd_error = SMMU_CERROR_ILL; 1399ccc3ee38SMostafa Saleh break; 1400ccc3ee38SMostafa Saleh } 1401ccc3ee38SMostafa Saleh /* 1402ccc3ee38SMostafa Saleh * As currently only either s1 or s2 are supported 1403ccc3ee38SMostafa Saleh * we can reuse same function for s2. 1404ccc3ee38SMostafa Saleh */ 1405*1ea8a6f5SMostafa Saleh smmuv3_range_inval(bs, &cmd, SMMU_STAGE_2); 1406cc27ed81SEric Auger break; 1407dadd1a08SEric Auger case SMMU_CMD_TLBI_EL3_ALL: 1408dadd1a08SEric Auger case SMMU_CMD_TLBI_EL3_VA: 1409dadd1a08SEric Auger case SMMU_CMD_TLBI_EL2_ALL: 1410dadd1a08SEric Auger case SMMU_CMD_TLBI_EL2_ASID: 1411dadd1a08SEric Auger case SMMU_CMD_TLBI_EL2_VA: 1412dadd1a08SEric Auger case SMMU_CMD_TLBI_EL2_VAA: 1413dadd1a08SEric Auger case SMMU_CMD_ATC_INV: 1414dadd1a08SEric Auger case SMMU_CMD_PRI_RESP: 1415dadd1a08SEric Auger case SMMU_CMD_RESUME: 1416dadd1a08SEric Auger case SMMU_CMD_STALL_TERM: 1417dadd1a08SEric Auger trace_smmuv3_unhandled_cmd(type); 1418dadd1a08SEric Auger break; 1419dadd1a08SEric Auger default: 1420dadd1a08SEric Auger cmd_error = SMMU_CERROR_ILL; 1421dadd1a08SEric Auger break; 1422dadd1a08SEric Auger } 142332cfd7f3SEric Auger qemu_mutex_unlock(&s->mutex); 1424dadd1a08SEric Auger if (cmd_error) { 1425ccc3ee38SMostafa Saleh if (cmd_error == SMMU_CERROR_ILL) { 1426ccc3ee38SMostafa Saleh qemu_log_mask(LOG_GUEST_ERROR, 1427ccc3ee38SMostafa Saleh "Illegal command type: %d\n", CMD_TYPE(&cmd)); 1428ccc3ee38SMostafa Saleh } 1429dadd1a08SEric Auger break; 1430dadd1a08SEric Auger } 1431dadd1a08SEric Auger /* 1432dadd1a08SEric Auger * We only increment the cons index after the completion of 1433dadd1a08SEric Auger * the command. We do that because the SYNC returns immediately 1434dadd1a08SEric Auger * and does not check the completion of previous commands 1435dadd1a08SEric Auger */ 1436dadd1a08SEric Auger queue_cons_incr(q); 1437dadd1a08SEric Auger } 1438dadd1a08SEric Auger 1439dadd1a08SEric Auger if (cmd_error) { 1440dadd1a08SEric Auger trace_smmuv3_cmdq_consume_error(smmu_cmd_string(type), cmd_error); 1441dadd1a08SEric Auger smmu_write_cmdq_err(s, cmd_error); 1442dadd1a08SEric Auger smmuv3_trigger_irq(s, SMMU_IRQ_GERROR, R_GERROR_CMDQ_ERR_MASK); 1443dadd1a08SEric Auger } 1444dadd1a08SEric Auger 1445dadd1a08SEric Auger trace_smmuv3_cmdq_consume_out(Q_PROD(q), Q_CONS(q), 1446dadd1a08SEric Auger Q_PROD_WRAP(q), Q_CONS_WRAP(q)); 1447dadd1a08SEric Auger 1448dadd1a08SEric Auger return 0; 1449dadd1a08SEric Auger } 1450dadd1a08SEric Auger 1451fae4be38SEric Auger static MemTxResult smmu_writell(SMMUv3State *s, hwaddr offset, 1452fae4be38SEric Auger uint64_t data, MemTxAttrs attrs) 1453fae4be38SEric Auger { 1454fae4be38SEric Auger switch (offset) { 1455fae4be38SEric Auger case A_GERROR_IRQ_CFG0: 1456fae4be38SEric Auger s->gerror_irq_cfg0 = data; 1457fae4be38SEric Auger return MEMTX_OK; 1458fae4be38SEric Auger case A_STRTAB_BASE: 1459fae4be38SEric Auger s->strtab_base = data; 1460fae4be38SEric Auger return MEMTX_OK; 1461fae4be38SEric Auger case A_CMDQ_BASE: 1462fae4be38SEric Auger s->cmdq.base = data; 1463fae4be38SEric Auger s->cmdq.log2size = extract64(s->cmdq.base, 0, 5); 1464fae4be38SEric Auger if (s->cmdq.log2size > SMMU_CMDQS) { 1465fae4be38SEric Auger s->cmdq.log2size = SMMU_CMDQS; 1466fae4be38SEric Auger } 1467fae4be38SEric Auger return MEMTX_OK; 1468fae4be38SEric Auger case A_EVENTQ_BASE: 1469fae4be38SEric Auger s->eventq.base = data; 1470fae4be38SEric Auger s->eventq.log2size = extract64(s->eventq.base, 0, 5); 1471fae4be38SEric Auger if (s->eventq.log2size > SMMU_EVENTQS) { 1472fae4be38SEric Auger s->eventq.log2size = SMMU_EVENTQS; 1473fae4be38SEric Auger } 1474fae4be38SEric Auger return MEMTX_OK; 1475fae4be38SEric Auger case A_EVENTQ_IRQ_CFG0: 1476fae4be38SEric Auger s->eventq_irq_cfg0 = data; 1477fae4be38SEric Auger return MEMTX_OK; 1478fae4be38SEric Auger default: 1479fae4be38SEric Auger qemu_log_mask(LOG_UNIMP, 1480fae4be38SEric Auger "%s Unexpected 64-bit access to 0x%"PRIx64" (WI)\n", 1481fae4be38SEric Auger __func__, offset); 1482fae4be38SEric Auger return MEMTX_OK; 1483fae4be38SEric Auger } 1484fae4be38SEric Auger } 1485fae4be38SEric Auger 1486fae4be38SEric Auger static MemTxResult smmu_writel(SMMUv3State *s, hwaddr offset, 1487fae4be38SEric Auger uint64_t data, MemTxAttrs attrs) 1488fae4be38SEric Auger { 1489fae4be38SEric Auger switch (offset) { 1490fae4be38SEric Auger case A_CR0: 1491fae4be38SEric Auger s->cr[0] = data; 1492fae4be38SEric Auger s->cr0ack = data & ~SMMU_CR0_RESERVED; 1493fae4be38SEric Auger /* in case the command queue has been enabled */ 1494fae4be38SEric Auger smmuv3_cmdq_consume(s); 1495fae4be38SEric Auger return MEMTX_OK; 1496fae4be38SEric Auger case A_CR1: 1497fae4be38SEric Auger s->cr[1] = data; 1498fae4be38SEric Auger return MEMTX_OK; 1499fae4be38SEric Auger case A_CR2: 1500fae4be38SEric Auger s->cr[2] = data; 1501fae4be38SEric Auger return MEMTX_OK; 1502fae4be38SEric Auger case A_IRQ_CTRL: 1503fae4be38SEric Auger s->irq_ctrl = data; 1504fae4be38SEric Auger return MEMTX_OK; 1505fae4be38SEric Auger case A_GERRORN: 1506fae4be38SEric Auger smmuv3_write_gerrorn(s, data); 1507fae4be38SEric Auger /* 1508fae4be38SEric Auger * By acknowledging the CMDQ_ERR, SW may notify cmds can 1509fae4be38SEric Auger * be processed again 1510fae4be38SEric Auger */ 1511fae4be38SEric Auger smmuv3_cmdq_consume(s); 1512fae4be38SEric Auger return MEMTX_OK; 1513fae4be38SEric Auger case A_GERROR_IRQ_CFG0: /* 64b */ 1514fae4be38SEric Auger s->gerror_irq_cfg0 = deposit64(s->gerror_irq_cfg0, 0, 32, data); 1515fae4be38SEric Auger return MEMTX_OK; 1516fae4be38SEric Auger case A_GERROR_IRQ_CFG0 + 4: 1517fae4be38SEric Auger s->gerror_irq_cfg0 = deposit64(s->gerror_irq_cfg0, 32, 32, data); 1518fae4be38SEric Auger return MEMTX_OK; 1519fae4be38SEric Auger case A_GERROR_IRQ_CFG1: 1520fae4be38SEric Auger s->gerror_irq_cfg1 = data; 1521fae4be38SEric Auger return MEMTX_OK; 1522fae4be38SEric Auger case A_GERROR_IRQ_CFG2: 1523fae4be38SEric Auger s->gerror_irq_cfg2 = data; 1524fae4be38SEric Auger return MEMTX_OK; 1525c2ecb424SMostafa Saleh case A_GBPA: 1526c2ecb424SMostafa Saleh /* 1527c2ecb424SMostafa Saleh * If UPDATE is not set, the write is ignored. This is the only 1528c2ecb424SMostafa Saleh * permitted behavior in SMMUv3.2 and later. 1529c2ecb424SMostafa Saleh */ 1530c2ecb424SMostafa Saleh if (data & R_GBPA_UPDATE_MASK) { 1531c2ecb424SMostafa Saleh /* Ignore update bit as write is synchronous. */ 1532c2ecb424SMostafa Saleh s->gbpa = data & ~R_GBPA_UPDATE_MASK; 1533c2ecb424SMostafa Saleh } 1534c2ecb424SMostafa Saleh return MEMTX_OK; 1535fae4be38SEric Auger case A_STRTAB_BASE: /* 64b */ 1536fae4be38SEric Auger s->strtab_base = deposit64(s->strtab_base, 0, 32, data); 1537fae4be38SEric Auger return MEMTX_OK; 1538fae4be38SEric Auger case A_STRTAB_BASE + 4: 1539fae4be38SEric Auger s->strtab_base = deposit64(s->strtab_base, 32, 32, data); 1540fae4be38SEric Auger return MEMTX_OK; 1541fae4be38SEric Auger case A_STRTAB_BASE_CFG: 1542fae4be38SEric Auger s->strtab_base_cfg = data; 1543fae4be38SEric Auger if (FIELD_EX32(data, STRTAB_BASE_CFG, FMT) == 1) { 1544fae4be38SEric Auger s->sid_split = FIELD_EX32(data, STRTAB_BASE_CFG, SPLIT); 1545fae4be38SEric Auger s->features |= SMMU_FEATURE_2LVL_STE; 1546fae4be38SEric Auger } 1547fae4be38SEric Auger return MEMTX_OK; 1548fae4be38SEric Auger case A_CMDQ_BASE: /* 64b */ 1549fae4be38SEric Auger s->cmdq.base = deposit64(s->cmdq.base, 0, 32, data); 1550fae4be38SEric Auger s->cmdq.log2size = extract64(s->cmdq.base, 0, 5); 1551fae4be38SEric Auger if (s->cmdq.log2size > SMMU_CMDQS) { 1552fae4be38SEric Auger s->cmdq.log2size = SMMU_CMDQS; 1553fae4be38SEric Auger } 1554fae4be38SEric Auger return MEMTX_OK; 1555fae4be38SEric Auger case A_CMDQ_BASE + 4: /* 64b */ 1556fae4be38SEric Auger s->cmdq.base = deposit64(s->cmdq.base, 32, 32, data); 1557fae4be38SEric Auger return MEMTX_OK; 1558fae4be38SEric Auger case A_CMDQ_PROD: 1559fae4be38SEric Auger s->cmdq.prod = data; 1560fae4be38SEric Auger smmuv3_cmdq_consume(s); 1561fae4be38SEric Auger return MEMTX_OK; 1562fae4be38SEric Auger case A_CMDQ_CONS: 1563fae4be38SEric Auger s->cmdq.cons = data; 1564fae4be38SEric Auger return MEMTX_OK; 1565fae4be38SEric Auger case A_EVENTQ_BASE: /* 64b */ 1566fae4be38SEric Auger s->eventq.base = deposit64(s->eventq.base, 0, 32, data); 1567fae4be38SEric Auger s->eventq.log2size = extract64(s->eventq.base, 0, 5); 1568fae4be38SEric Auger if (s->eventq.log2size > SMMU_EVENTQS) { 1569fae4be38SEric Auger s->eventq.log2size = SMMU_EVENTQS; 1570fae4be38SEric Auger } 1571fae4be38SEric Auger return MEMTX_OK; 1572fae4be38SEric Auger case A_EVENTQ_BASE + 4: 1573fae4be38SEric Auger s->eventq.base = deposit64(s->eventq.base, 32, 32, data); 1574fae4be38SEric Auger return MEMTX_OK; 1575fae4be38SEric Auger case A_EVENTQ_PROD: 1576fae4be38SEric Auger s->eventq.prod = data; 1577fae4be38SEric Auger return MEMTX_OK; 1578fae4be38SEric Auger case A_EVENTQ_CONS: 1579fae4be38SEric Auger s->eventq.cons = data; 1580fae4be38SEric Auger return MEMTX_OK; 1581fae4be38SEric Auger case A_EVENTQ_IRQ_CFG0: /* 64b */ 1582fae4be38SEric Auger s->eventq_irq_cfg0 = deposit64(s->eventq_irq_cfg0, 0, 32, data); 1583fae4be38SEric Auger return MEMTX_OK; 1584fae4be38SEric Auger case A_EVENTQ_IRQ_CFG0 + 4: 1585fae4be38SEric Auger s->eventq_irq_cfg0 = deposit64(s->eventq_irq_cfg0, 32, 32, data); 1586fae4be38SEric Auger return MEMTX_OK; 1587fae4be38SEric Auger case A_EVENTQ_IRQ_CFG1: 1588fae4be38SEric Auger s->eventq_irq_cfg1 = data; 1589fae4be38SEric Auger return MEMTX_OK; 1590fae4be38SEric Auger case A_EVENTQ_IRQ_CFG2: 1591fae4be38SEric Auger s->eventq_irq_cfg2 = data; 1592fae4be38SEric Auger return MEMTX_OK; 1593fae4be38SEric Auger default: 1594fae4be38SEric Auger qemu_log_mask(LOG_UNIMP, 1595fae4be38SEric Auger "%s Unexpected 32-bit access to 0x%"PRIx64" (WI)\n", 1596fae4be38SEric Auger __func__, offset); 1597fae4be38SEric Auger return MEMTX_OK; 1598fae4be38SEric Auger } 1599fae4be38SEric Auger } 1600fae4be38SEric Auger 160110a83cb9SPrem Mallappa static MemTxResult smmu_write_mmio(void *opaque, hwaddr offset, uint64_t data, 160210a83cb9SPrem Mallappa unsigned size, MemTxAttrs attrs) 160310a83cb9SPrem Mallappa { 1604fae4be38SEric Auger SMMUState *sys = opaque; 1605fae4be38SEric Auger SMMUv3State *s = ARM_SMMUV3(sys); 1606fae4be38SEric Auger MemTxResult r; 1607fae4be38SEric Auger 1608fae4be38SEric Auger /* CONSTRAINED UNPREDICTABLE choice to have page0/1 be exact aliases */ 1609fae4be38SEric Auger offset &= ~0x10000; 1610fae4be38SEric Auger 1611fae4be38SEric Auger switch (size) { 1612fae4be38SEric Auger case 8: 1613fae4be38SEric Auger r = smmu_writell(s, offset, data, attrs); 1614fae4be38SEric Auger break; 1615fae4be38SEric Auger case 4: 1616fae4be38SEric Auger r = smmu_writel(s, offset, data, attrs); 1617fae4be38SEric Auger break; 1618fae4be38SEric Auger default: 1619fae4be38SEric Auger r = MEMTX_ERROR; 1620fae4be38SEric Auger break; 1621fae4be38SEric Auger } 1622fae4be38SEric Auger 1623fae4be38SEric Auger trace_smmuv3_write_mmio(offset, data, size, r); 1624fae4be38SEric Auger return r; 162510a83cb9SPrem Mallappa } 162610a83cb9SPrem Mallappa 162710a83cb9SPrem Mallappa static MemTxResult smmu_readll(SMMUv3State *s, hwaddr offset, 162810a83cb9SPrem Mallappa uint64_t *data, MemTxAttrs attrs) 162910a83cb9SPrem Mallappa { 163010a83cb9SPrem Mallappa switch (offset) { 163110a83cb9SPrem Mallappa case A_GERROR_IRQ_CFG0: 163210a83cb9SPrem Mallappa *data = s->gerror_irq_cfg0; 163310a83cb9SPrem Mallappa return MEMTX_OK; 163410a83cb9SPrem Mallappa case A_STRTAB_BASE: 163510a83cb9SPrem Mallappa *data = s->strtab_base; 163610a83cb9SPrem Mallappa return MEMTX_OK; 163710a83cb9SPrem Mallappa case A_CMDQ_BASE: 163810a83cb9SPrem Mallappa *data = s->cmdq.base; 163910a83cb9SPrem Mallappa return MEMTX_OK; 164010a83cb9SPrem Mallappa case A_EVENTQ_BASE: 164110a83cb9SPrem Mallappa *data = s->eventq.base; 164210a83cb9SPrem Mallappa return MEMTX_OK; 164310a83cb9SPrem Mallappa default: 164410a83cb9SPrem Mallappa *data = 0; 164510a83cb9SPrem Mallappa qemu_log_mask(LOG_UNIMP, 164610a83cb9SPrem Mallappa "%s Unexpected 64-bit access to 0x%"PRIx64" (RAZ)\n", 164710a83cb9SPrem Mallappa __func__, offset); 164810a83cb9SPrem Mallappa return MEMTX_OK; 164910a83cb9SPrem Mallappa } 165010a83cb9SPrem Mallappa } 165110a83cb9SPrem Mallappa 165210a83cb9SPrem Mallappa static MemTxResult smmu_readl(SMMUv3State *s, hwaddr offset, 165310a83cb9SPrem Mallappa uint64_t *data, MemTxAttrs attrs) 165410a83cb9SPrem Mallappa { 165510a83cb9SPrem Mallappa switch (offset) { 165697fb318dSPeter Maydell case A_IDREGS ... A_IDREGS + 0x2f: 165710a83cb9SPrem Mallappa *data = smmuv3_idreg(offset - A_IDREGS); 165810a83cb9SPrem Mallappa return MEMTX_OK; 165910a83cb9SPrem Mallappa case A_IDR0 ... A_IDR5: 166010a83cb9SPrem Mallappa *data = s->idr[(offset - A_IDR0) / 4]; 166110a83cb9SPrem Mallappa return MEMTX_OK; 166210a83cb9SPrem Mallappa case A_IIDR: 166310a83cb9SPrem Mallappa *data = s->iidr; 166410a83cb9SPrem Mallappa return MEMTX_OK; 16655888f0adSEric Auger case A_AIDR: 16665888f0adSEric Auger *data = s->aidr; 16675888f0adSEric Auger return MEMTX_OK; 166810a83cb9SPrem Mallappa case A_CR0: 166910a83cb9SPrem Mallappa *data = s->cr[0]; 167010a83cb9SPrem Mallappa return MEMTX_OK; 167110a83cb9SPrem Mallappa case A_CR0ACK: 167210a83cb9SPrem Mallappa *data = s->cr0ack; 167310a83cb9SPrem Mallappa return MEMTX_OK; 167410a83cb9SPrem Mallappa case A_CR1: 167510a83cb9SPrem Mallappa *data = s->cr[1]; 167610a83cb9SPrem Mallappa return MEMTX_OK; 167710a83cb9SPrem Mallappa case A_CR2: 167810a83cb9SPrem Mallappa *data = s->cr[2]; 167910a83cb9SPrem Mallappa return MEMTX_OK; 168010a83cb9SPrem Mallappa case A_STATUSR: 168110a83cb9SPrem Mallappa *data = s->statusr; 168210a83cb9SPrem Mallappa return MEMTX_OK; 1683c2ecb424SMostafa Saleh case A_GBPA: 1684c2ecb424SMostafa Saleh *data = s->gbpa; 1685c2ecb424SMostafa Saleh return MEMTX_OK; 168610a83cb9SPrem Mallappa case A_IRQ_CTRL: 168710a83cb9SPrem Mallappa case A_IRQ_CTRL_ACK: 168810a83cb9SPrem Mallappa *data = s->irq_ctrl; 168910a83cb9SPrem Mallappa return MEMTX_OK; 169010a83cb9SPrem Mallappa case A_GERROR: 169110a83cb9SPrem Mallappa *data = s->gerror; 169210a83cb9SPrem Mallappa return MEMTX_OK; 169310a83cb9SPrem Mallappa case A_GERRORN: 169410a83cb9SPrem Mallappa *data = s->gerrorn; 169510a83cb9SPrem Mallappa return MEMTX_OK; 169610a83cb9SPrem Mallappa case A_GERROR_IRQ_CFG0: /* 64b */ 169710a83cb9SPrem Mallappa *data = extract64(s->gerror_irq_cfg0, 0, 32); 169810a83cb9SPrem Mallappa return MEMTX_OK; 169910a83cb9SPrem Mallappa case A_GERROR_IRQ_CFG0 + 4: 170010a83cb9SPrem Mallappa *data = extract64(s->gerror_irq_cfg0, 32, 32); 170110a83cb9SPrem Mallappa return MEMTX_OK; 170210a83cb9SPrem Mallappa case A_GERROR_IRQ_CFG1: 170310a83cb9SPrem Mallappa *data = s->gerror_irq_cfg1; 170410a83cb9SPrem Mallappa return MEMTX_OK; 170510a83cb9SPrem Mallappa case A_GERROR_IRQ_CFG2: 170610a83cb9SPrem Mallappa *data = s->gerror_irq_cfg2; 170710a83cb9SPrem Mallappa return MEMTX_OK; 170810a83cb9SPrem Mallappa case A_STRTAB_BASE: /* 64b */ 170910a83cb9SPrem Mallappa *data = extract64(s->strtab_base, 0, 32); 171010a83cb9SPrem Mallappa return MEMTX_OK; 171110a83cb9SPrem Mallappa case A_STRTAB_BASE + 4: /* 64b */ 171210a83cb9SPrem Mallappa *data = extract64(s->strtab_base, 32, 32); 171310a83cb9SPrem Mallappa return MEMTX_OK; 171410a83cb9SPrem Mallappa case A_STRTAB_BASE_CFG: 171510a83cb9SPrem Mallappa *data = s->strtab_base_cfg; 171610a83cb9SPrem Mallappa return MEMTX_OK; 171710a83cb9SPrem Mallappa case A_CMDQ_BASE: /* 64b */ 171810a83cb9SPrem Mallappa *data = extract64(s->cmdq.base, 0, 32); 171910a83cb9SPrem Mallappa return MEMTX_OK; 172010a83cb9SPrem Mallappa case A_CMDQ_BASE + 4: 172110a83cb9SPrem Mallappa *data = extract64(s->cmdq.base, 32, 32); 172210a83cb9SPrem Mallappa return MEMTX_OK; 172310a83cb9SPrem Mallappa case A_CMDQ_PROD: 172410a83cb9SPrem Mallappa *data = s->cmdq.prod; 172510a83cb9SPrem Mallappa return MEMTX_OK; 172610a83cb9SPrem Mallappa case A_CMDQ_CONS: 172710a83cb9SPrem Mallappa *data = s->cmdq.cons; 172810a83cb9SPrem Mallappa return MEMTX_OK; 172910a83cb9SPrem Mallappa case A_EVENTQ_BASE: /* 64b */ 173010a83cb9SPrem Mallappa *data = extract64(s->eventq.base, 0, 32); 173110a83cb9SPrem Mallappa return MEMTX_OK; 173210a83cb9SPrem Mallappa case A_EVENTQ_BASE + 4: /* 64b */ 173310a83cb9SPrem Mallappa *data = extract64(s->eventq.base, 32, 32); 173410a83cb9SPrem Mallappa return MEMTX_OK; 173510a83cb9SPrem Mallappa case A_EVENTQ_PROD: 173610a83cb9SPrem Mallappa *data = s->eventq.prod; 173710a83cb9SPrem Mallappa return MEMTX_OK; 173810a83cb9SPrem Mallappa case A_EVENTQ_CONS: 173910a83cb9SPrem Mallappa *data = s->eventq.cons; 174010a83cb9SPrem Mallappa return MEMTX_OK; 174110a83cb9SPrem Mallappa default: 174210a83cb9SPrem Mallappa *data = 0; 174310a83cb9SPrem Mallappa qemu_log_mask(LOG_UNIMP, 174410a83cb9SPrem Mallappa "%s unhandled 32-bit access at 0x%"PRIx64" (RAZ)\n", 174510a83cb9SPrem Mallappa __func__, offset); 174610a83cb9SPrem Mallappa return MEMTX_OK; 174710a83cb9SPrem Mallappa } 174810a83cb9SPrem Mallappa } 174910a83cb9SPrem Mallappa 175010a83cb9SPrem Mallappa static MemTxResult smmu_read_mmio(void *opaque, hwaddr offset, uint64_t *data, 175110a83cb9SPrem Mallappa unsigned size, MemTxAttrs attrs) 175210a83cb9SPrem Mallappa { 175310a83cb9SPrem Mallappa SMMUState *sys = opaque; 175410a83cb9SPrem Mallappa SMMUv3State *s = ARM_SMMUV3(sys); 175510a83cb9SPrem Mallappa MemTxResult r; 175610a83cb9SPrem Mallappa 175710a83cb9SPrem Mallappa /* CONSTRAINED UNPREDICTABLE choice to have page0/1 be exact aliases */ 175810a83cb9SPrem Mallappa offset &= ~0x10000; 175910a83cb9SPrem Mallappa 176010a83cb9SPrem Mallappa switch (size) { 176110a83cb9SPrem Mallappa case 8: 176210a83cb9SPrem Mallappa r = smmu_readll(s, offset, data, attrs); 176310a83cb9SPrem Mallappa break; 176410a83cb9SPrem Mallappa case 4: 176510a83cb9SPrem Mallappa r = smmu_readl(s, offset, data, attrs); 176610a83cb9SPrem Mallappa break; 176710a83cb9SPrem Mallappa default: 176810a83cb9SPrem Mallappa r = MEMTX_ERROR; 176910a83cb9SPrem Mallappa break; 177010a83cb9SPrem Mallappa } 177110a83cb9SPrem Mallappa 177210a83cb9SPrem Mallappa trace_smmuv3_read_mmio(offset, *data, size, r); 177310a83cb9SPrem Mallappa return r; 177410a83cb9SPrem Mallappa } 177510a83cb9SPrem Mallappa 177610a83cb9SPrem Mallappa static const MemoryRegionOps smmu_mem_ops = { 177710a83cb9SPrem Mallappa .read_with_attrs = smmu_read_mmio, 177810a83cb9SPrem Mallappa .write_with_attrs = smmu_write_mmio, 177910a83cb9SPrem Mallappa .endianness = DEVICE_LITTLE_ENDIAN, 178010a83cb9SPrem Mallappa .valid = { 178110a83cb9SPrem Mallappa .min_access_size = 4, 178210a83cb9SPrem Mallappa .max_access_size = 8, 178310a83cb9SPrem Mallappa }, 178410a83cb9SPrem Mallappa .impl = { 178510a83cb9SPrem Mallappa .min_access_size = 4, 178610a83cb9SPrem Mallappa .max_access_size = 8, 178710a83cb9SPrem Mallappa }, 178810a83cb9SPrem Mallappa }; 178910a83cb9SPrem Mallappa 179010a83cb9SPrem Mallappa static void smmu_init_irq(SMMUv3State *s, SysBusDevice *dev) 179110a83cb9SPrem Mallappa { 179210a83cb9SPrem Mallappa int i; 179310a83cb9SPrem Mallappa 179410a83cb9SPrem Mallappa for (i = 0; i < ARRAY_SIZE(s->irq); i++) { 179510a83cb9SPrem Mallappa sysbus_init_irq(dev, &s->irq[i]); 179610a83cb9SPrem Mallappa } 179710a83cb9SPrem Mallappa } 179810a83cb9SPrem Mallappa 1799ad80e367SPeter Maydell static void smmu_reset_hold(Object *obj, ResetType type) 180010a83cb9SPrem Mallappa { 1801503819a3SPeter Maydell SMMUv3State *s = ARM_SMMUV3(obj); 180210a83cb9SPrem Mallappa SMMUv3Class *c = ARM_SMMUV3_GET_CLASS(s); 180310a83cb9SPrem Mallappa 1804503819a3SPeter Maydell if (c->parent_phases.hold) { 1805ad80e367SPeter Maydell c->parent_phases.hold(obj, type); 1806503819a3SPeter Maydell } 180710a83cb9SPrem Mallappa 180810a83cb9SPrem Mallappa smmuv3_init_regs(s); 180910a83cb9SPrem Mallappa } 181010a83cb9SPrem Mallappa 181110a83cb9SPrem Mallappa static void smmu_realize(DeviceState *d, Error **errp) 181210a83cb9SPrem Mallappa { 181310a83cb9SPrem Mallappa SMMUState *sys = ARM_SMMU(d); 181410a83cb9SPrem Mallappa SMMUv3State *s = ARM_SMMUV3(sys); 181510a83cb9SPrem Mallappa SMMUv3Class *c = ARM_SMMUV3_GET_CLASS(s); 181610a83cb9SPrem Mallappa SysBusDevice *dev = SYS_BUS_DEVICE(d); 181710a83cb9SPrem Mallappa Error *local_err = NULL; 181810a83cb9SPrem Mallappa 181910a83cb9SPrem Mallappa c->parent_realize(d, &local_err); 182010a83cb9SPrem Mallappa if (local_err) { 182110a83cb9SPrem Mallappa error_propagate(errp, local_err); 182210a83cb9SPrem Mallappa return; 182310a83cb9SPrem Mallappa } 182410a83cb9SPrem Mallappa 182532cfd7f3SEric Auger qemu_mutex_init(&s->mutex); 182632cfd7f3SEric Auger 182710a83cb9SPrem Mallappa memory_region_init_io(&sys->iomem, OBJECT(s), 182810a83cb9SPrem Mallappa &smmu_mem_ops, sys, TYPE_ARM_SMMUV3, 0x20000); 182910a83cb9SPrem Mallappa 183010a83cb9SPrem Mallappa sys->mrtypename = TYPE_SMMUV3_IOMMU_MEMORY_REGION; 183110a83cb9SPrem Mallappa 183210a83cb9SPrem Mallappa sysbus_init_mmio(dev, &sys->iomem); 183310a83cb9SPrem Mallappa 183410a83cb9SPrem Mallappa smmu_init_irq(s, dev); 183510a83cb9SPrem Mallappa } 183610a83cb9SPrem Mallappa 183710a83cb9SPrem Mallappa static const VMStateDescription vmstate_smmuv3_queue = { 183810a83cb9SPrem Mallappa .name = "smmuv3_queue", 183910a83cb9SPrem Mallappa .version_id = 1, 184010a83cb9SPrem Mallappa .minimum_version_id = 1, 1841607ef570SRichard Henderson .fields = (const VMStateField[]) { 184210a83cb9SPrem Mallappa VMSTATE_UINT64(base, SMMUQueue), 184310a83cb9SPrem Mallappa VMSTATE_UINT32(prod, SMMUQueue), 184410a83cb9SPrem Mallappa VMSTATE_UINT32(cons, SMMUQueue), 184510a83cb9SPrem Mallappa VMSTATE_UINT8(log2size, SMMUQueue), 1846758b71f7SDr. David Alan Gilbert VMSTATE_END_OF_LIST(), 184710a83cb9SPrem Mallappa }, 184810a83cb9SPrem Mallappa }; 184910a83cb9SPrem Mallappa 1850c2ecb424SMostafa Saleh static bool smmuv3_gbpa_needed(void *opaque) 1851c2ecb424SMostafa Saleh { 1852c2ecb424SMostafa Saleh SMMUv3State *s = opaque; 1853c2ecb424SMostafa Saleh 1854c2ecb424SMostafa Saleh /* Only migrate GBPA if it has different reset value. */ 1855c2ecb424SMostafa Saleh return s->gbpa != SMMU_GBPA_RESET_VAL; 1856c2ecb424SMostafa Saleh } 1857c2ecb424SMostafa Saleh 1858c2ecb424SMostafa Saleh static const VMStateDescription vmstate_gbpa = { 1859c2ecb424SMostafa Saleh .name = "smmuv3/gbpa", 1860c2ecb424SMostafa Saleh .version_id = 1, 1861c2ecb424SMostafa Saleh .minimum_version_id = 1, 1862c2ecb424SMostafa Saleh .needed = smmuv3_gbpa_needed, 1863607ef570SRichard Henderson .fields = (const VMStateField[]) { 1864c2ecb424SMostafa Saleh VMSTATE_UINT32(gbpa, SMMUv3State), 1865c2ecb424SMostafa Saleh VMSTATE_END_OF_LIST() 1866c2ecb424SMostafa Saleh } 1867c2ecb424SMostafa Saleh }; 1868c2ecb424SMostafa Saleh 186910a83cb9SPrem Mallappa static const VMStateDescription vmstate_smmuv3 = { 187010a83cb9SPrem Mallappa .name = "smmuv3", 187110a83cb9SPrem Mallappa .version_id = 1, 187210a83cb9SPrem Mallappa .minimum_version_id = 1, 1873a55aab61SZenghui Yu .priority = MIG_PRI_IOMMU, 1874607ef570SRichard Henderson .fields = (const VMStateField[]) { 187510a83cb9SPrem Mallappa VMSTATE_UINT32(features, SMMUv3State), 187610a83cb9SPrem Mallappa VMSTATE_UINT8(sid_size, SMMUv3State), 187710a83cb9SPrem Mallappa VMSTATE_UINT8(sid_split, SMMUv3State), 187810a83cb9SPrem Mallappa 187910a83cb9SPrem Mallappa VMSTATE_UINT32_ARRAY(cr, SMMUv3State, 3), 188010a83cb9SPrem Mallappa VMSTATE_UINT32(cr0ack, SMMUv3State), 188110a83cb9SPrem Mallappa VMSTATE_UINT32(statusr, SMMUv3State), 188210a83cb9SPrem Mallappa VMSTATE_UINT32(irq_ctrl, SMMUv3State), 188310a83cb9SPrem Mallappa VMSTATE_UINT32(gerror, SMMUv3State), 188410a83cb9SPrem Mallappa VMSTATE_UINT32(gerrorn, SMMUv3State), 188510a83cb9SPrem Mallappa VMSTATE_UINT64(gerror_irq_cfg0, SMMUv3State), 188610a83cb9SPrem Mallappa VMSTATE_UINT32(gerror_irq_cfg1, SMMUv3State), 188710a83cb9SPrem Mallappa VMSTATE_UINT32(gerror_irq_cfg2, SMMUv3State), 188810a83cb9SPrem Mallappa VMSTATE_UINT64(strtab_base, SMMUv3State), 188910a83cb9SPrem Mallappa VMSTATE_UINT32(strtab_base_cfg, SMMUv3State), 189010a83cb9SPrem Mallappa VMSTATE_UINT64(eventq_irq_cfg0, SMMUv3State), 189110a83cb9SPrem Mallappa VMSTATE_UINT32(eventq_irq_cfg1, SMMUv3State), 189210a83cb9SPrem Mallappa VMSTATE_UINT32(eventq_irq_cfg2, SMMUv3State), 189310a83cb9SPrem Mallappa 189410a83cb9SPrem Mallappa VMSTATE_STRUCT(cmdq, SMMUv3State, 0, vmstate_smmuv3_queue, SMMUQueue), 189510a83cb9SPrem Mallappa VMSTATE_STRUCT(eventq, SMMUv3State, 0, vmstate_smmuv3_queue, SMMUQueue), 189610a83cb9SPrem Mallappa 189710a83cb9SPrem Mallappa VMSTATE_END_OF_LIST(), 189810a83cb9SPrem Mallappa }, 1899607ef570SRichard Henderson .subsections = (const VMStateDescription * const []) { 1900c2ecb424SMostafa Saleh &vmstate_gbpa, 1901c2ecb424SMostafa Saleh NULL 1902c2ecb424SMostafa Saleh } 190310a83cb9SPrem Mallappa }; 190410a83cb9SPrem Mallappa 19058cefcc3bSMostafa Saleh static Property smmuv3_properties[] = { 19068cefcc3bSMostafa Saleh /* 19078cefcc3bSMostafa Saleh * Stages of translation advertised. 19088cefcc3bSMostafa Saleh * "1": Stage 1 19098cefcc3bSMostafa Saleh * "2": Stage 2 19108cefcc3bSMostafa Saleh * Defaults to stage 1 19118cefcc3bSMostafa Saleh */ 19128cefcc3bSMostafa Saleh DEFINE_PROP_STRING("stage", SMMUv3State, stage), 19138cefcc3bSMostafa Saleh DEFINE_PROP_END_OF_LIST() 19148cefcc3bSMostafa Saleh }; 19158cefcc3bSMostafa Saleh 191610a83cb9SPrem Mallappa static void smmuv3_instance_init(Object *obj) 191710a83cb9SPrem Mallappa { 191810a83cb9SPrem Mallappa /* Nothing much to do here as of now */ 191910a83cb9SPrem Mallappa } 192010a83cb9SPrem Mallappa 192110a83cb9SPrem Mallappa static void smmuv3_class_init(ObjectClass *klass, void *data) 192210a83cb9SPrem Mallappa { 192310a83cb9SPrem Mallappa DeviceClass *dc = DEVICE_CLASS(klass); 1924503819a3SPeter Maydell ResettableClass *rc = RESETTABLE_CLASS(klass); 192510a83cb9SPrem Mallappa SMMUv3Class *c = ARM_SMMUV3_CLASS(klass); 192610a83cb9SPrem Mallappa 192710a83cb9SPrem Mallappa dc->vmsd = &vmstate_smmuv3; 1928503819a3SPeter Maydell resettable_class_set_parent_phases(rc, NULL, smmu_reset_hold, NULL, 1929503819a3SPeter Maydell &c->parent_phases); 19309953bf34SZhao Liu device_class_set_parent_realize(dc, smmu_realize, 19319953bf34SZhao Liu &c->parent_realize); 19328cefcc3bSMostafa Saleh device_class_set_props(dc, smmuv3_properties); 193310a83cb9SPrem Mallappa } 193410a83cb9SPrem Mallappa 1935549d4005SEric Auger static int smmuv3_notify_flag_changed(IOMMUMemoryRegion *iommu, 19360d1ac82eSEric Auger IOMMUNotifierFlag old, 1937549d4005SEric Auger IOMMUNotifierFlag new, 1938549d4005SEric Auger Error **errp) 19390d1ac82eSEric Auger { 1940832e4222SEric Auger SMMUDevice *sdev = container_of(iommu, SMMUDevice, iommu); 1941832e4222SEric Auger SMMUv3State *s3 = sdev->smmu; 1942832e4222SEric Auger SMMUState *s = &(s3->smmu_state); 1943832e4222SEric Auger 1944958ec334SPeter Xu if (new & IOMMU_NOTIFIER_DEVIOTLB_UNMAP) { 1945958ec334SPeter Xu error_setg(errp, "SMMUv3 does not support dev-iotlb yet"); 1946958ec334SPeter Xu return -EINVAL; 1947958ec334SPeter Xu } 1948958ec334SPeter Xu 1949832e4222SEric Auger if (new & IOMMU_NOTIFIER_MAP) { 1950549d4005SEric Auger error_setg(errp, 1951549d4005SEric Auger "device %02x.%02x.%x requires iommu MAP notifier which is " 1952549d4005SEric Auger "not currently supported", pci_bus_num(sdev->bus), 1953549d4005SEric Auger PCI_SLOT(sdev->devfn), PCI_FUNC(sdev->devfn)); 1954549d4005SEric Auger return -EINVAL; 1955832e4222SEric Auger } 1956832e4222SEric Auger 19570d1ac82eSEric Auger if (old == IOMMU_NOTIFIER_NONE) { 1958832e4222SEric Auger trace_smmuv3_notify_flag_add(iommu->parent_obj.name); 1959c6370441SEric Auger QLIST_INSERT_HEAD(&s->devices_with_notifiers, sdev, next); 1960c6370441SEric Auger } else if (new == IOMMU_NOTIFIER_NONE) { 1961832e4222SEric Auger trace_smmuv3_notify_flag_del(iommu->parent_obj.name); 1962c6370441SEric Auger QLIST_REMOVE(sdev, next); 19630d1ac82eSEric Auger } 1964549d4005SEric Auger return 0; 19650d1ac82eSEric Auger } 19660d1ac82eSEric Auger 196710a83cb9SPrem Mallappa static void smmuv3_iommu_memory_region_class_init(ObjectClass *klass, 196810a83cb9SPrem Mallappa void *data) 196910a83cb9SPrem Mallappa { 19709bde7f06SEric Auger IOMMUMemoryRegionClass *imrc = IOMMU_MEMORY_REGION_CLASS(klass); 19719bde7f06SEric Auger 19729bde7f06SEric Auger imrc->translate = smmuv3_translate; 19730d1ac82eSEric Auger imrc->notify_flag_changed = smmuv3_notify_flag_changed; 197410a83cb9SPrem Mallappa } 197510a83cb9SPrem Mallappa 197610a83cb9SPrem Mallappa static const TypeInfo smmuv3_type_info = { 197710a83cb9SPrem Mallappa .name = TYPE_ARM_SMMUV3, 197810a83cb9SPrem Mallappa .parent = TYPE_ARM_SMMU, 197910a83cb9SPrem Mallappa .instance_size = sizeof(SMMUv3State), 198010a83cb9SPrem Mallappa .instance_init = smmuv3_instance_init, 198110a83cb9SPrem Mallappa .class_size = sizeof(SMMUv3Class), 198210a83cb9SPrem Mallappa .class_init = smmuv3_class_init, 198310a83cb9SPrem Mallappa }; 198410a83cb9SPrem Mallappa 198510a83cb9SPrem Mallappa static const TypeInfo smmuv3_iommu_memory_region_info = { 198610a83cb9SPrem Mallappa .parent = TYPE_IOMMU_MEMORY_REGION, 198710a83cb9SPrem Mallappa .name = TYPE_SMMUV3_IOMMU_MEMORY_REGION, 198810a83cb9SPrem Mallappa .class_init = smmuv3_iommu_memory_region_class_init, 198910a83cb9SPrem Mallappa }; 199010a83cb9SPrem Mallappa 199110a83cb9SPrem Mallappa static void smmuv3_register_types(void) 199210a83cb9SPrem Mallappa { 199310a83cb9SPrem Mallappa type_register(&smmuv3_type_info); 199410a83cb9SPrem Mallappa type_register(&smmuv3_iommu_memory_region_info); 199510a83cb9SPrem Mallappa } 199610a83cb9SPrem Mallappa 199710a83cb9SPrem Mallappa type_init(smmuv3_register_types) 199810a83cb9SPrem Mallappa 1999