xref: /qemu/hw/arm/smmuv3.c (revision 1ea8a6f59b8d6dbcc5d0aa59380ae45a18231b88)
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