xref: /qemu/hw/intc/arm_gicv3_its.c (revision f76ba95a03921b71c2a2f2069e1ddf890796f1e5)
1 /*
2  * ITS emulation for a GICv3-based system
3  *
4  * Copyright Linaro.org 2021
5  *
6  * Authors:
7  *  Shashi Mallela <shashi.mallela@linaro.org>
8  *
9  * This work is licensed under the terms of the GNU GPL, version 2 or (at your
10  * option) any later version.  See the COPYING file in the top-level directory.
11  *
12  */
13 
14 #include "qemu/osdep.h"
15 #include "qemu/log.h"
16 #include "trace.h"
17 #include "hw/qdev-properties.h"
18 #include "hw/intc/arm_gicv3_its_common.h"
19 #include "gicv3_internal.h"
20 #include "qom/object.h"
21 #include "qapi/error.h"
22 
23 typedef struct GICv3ITSClass GICv3ITSClass;
24 /* This is reusing the GICv3ITSState typedef from ARM_GICV3_ITS_COMMON */
25 DECLARE_OBJ_CHECKERS(GICv3ITSState, GICv3ITSClass,
26                      ARM_GICV3_ITS, TYPE_ARM_GICV3_ITS)
27 
28 struct GICv3ITSClass {
29     GICv3ITSCommonClass parent_class;
30     void (*parent_reset)(DeviceState *dev);
31 };
32 
33 /*
34  * This is an internal enum used to distinguish between LPI triggered
35  * via command queue and LPI triggered via gits_translater write.
36  */
37 typedef enum ItsCmdType {
38     NONE = 0, /* internal indication for GITS_TRANSLATER write */
39     CLEAR = 1,
40     DISCARD = 2,
41     INTERRUPT = 3,
42 } ItsCmdType;
43 
44 typedef struct DTEntry {
45     bool valid;
46     unsigned size;
47     uint64_t ittaddr;
48 } DTEntry;
49 
50 typedef struct CTEntry {
51     bool valid;
52     uint32_t rdbase;
53 } CTEntry;
54 
55 typedef struct ITEntry {
56     bool valid;
57     int inttype;
58     uint32_t intid;
59     uint32_t doorbell;
60     uint32_t icid;
61     uint32_t vpeid;
62 } ITEntry;
63 
64 typedef struct VTEntry {
65     bool valid;
66     unsigned vptsize;
67     uint32_t rdbase;
68     uint64_t vptaddr;
69 } VTEntry;
70 
71 /*
72  * The ITS spec permits a range of CONSTRAINED UNPREDICTABLE options
73  * if a command parameter is not correct. These include both "stall
74  * processing of the command queue" and "ignore this command, and
75  * keep processing the queue". In our implementation we choose that
76  * memory transaction errors reading the command packet provoke a
77  * stall, but errors in parameters cause us to ignore the command
78  * and continue processing.
79  * The process_* functions which handle individual ITS commands all
80  * return an ItsCmdResult which tells process_cmdq() whether it should
81  * stall, keep going because of an error, or keep going because the
82  * command was a success.
83  */
84 typedef enum ItsCmdResult {
85     CMD_STALL = 0,
86     CMD_CONTINUE = 1,
87     CMD_CONTINUE_OK = 2,
88 } ItsCmdResult;
89 
90 /* True if the ITS supports the GICv4 virtual LPI feature */
91 static bool its_feature_virtual(GICv3ITSState *s)
92 {
93     return s->typer & R_GITS_TYPER_VIRTUAL_MASK;
94 }
95 
96 static inline bool intid_in_lpi_range(uint32_t id)
97 {
98     return id >= GICV3_LPI_INTID_START &&
99         id < (1 << (GICD_TYPER_IDBITS + 1));
100 }
101 
102 static inline bool valid_doorbell(uint32_t id)
103 {
104     /* Doorbell fields may be an LPI, or 1023 to mean "no doorbell" */
105     return id == INTID_SPURIOUS || intid_in_lpi_range(id);
106 }
107 
108 static uint64_t baser_base_addr(uint64_t value, uint32_t page_sz)
109 {
110     uint64_t result = 0;
111 
112     switch (page_sz) {
113     case GITS_PAGE_SIZE_4K:
114     case GITS_PAGE_SIZE_16K:
115         result = FIELD_EX64(value, GITS_BASER, PHYADDR) << 12;
116         break;
117 
118     case GITS_PAGE_SIZE_64K:
119         result = FIELD_EX64(value, GITS_BASER, PHYADDRL_64K) << 16;
120         result |= FIELD_EX64(value, GITS_BASER, PHYADDRH_64K) << 48;
121         break;
122 
123     default:
124         break;
125     }
126     return result;
127 }
128 
129 static uint64_t table_entry_addr(GICv3ITSState *s, TableDesc *td,
130                                  uint32_t idx, MemTxResult *res)
131 {
132     /*
133      * Given a TableDesc describing one of the ITS in-guest-memory
134      * tables and an index into it, return the guest address
135      * corresponding to that table entry.
136      * If there was a memory error reading the L1 table of an
137      * indirect table, *res is set accordingly, and we return -1.
138      * If the L1 table entry is marked not valid, we return -1 with
139      * *res set to MEMTX_OK.
140      *
141      * The specification defines the format of level 1 entries of a
142      * 2-level table, but the format of level 2 entries and the format
143      * of flat-mapped tables is IMPDEF.
144      */
145     AddressSpace *as = &s->gicv3->dma_as;
146     uint32_t l2idx;
147     uint64_t l2;
148     uint32_t num_l2_entries;
149 
150     *res = MEMTX_OK;
151 
152     if (!td->indirect) {
153         /* Single level table */
154         return td->base_addr + idx * td->entry_sz;
155     }
156 
157     /* Two level table */
158     l2idx = idx / (td->page_sz / L1TABLE_ENTRY_SIZE);
159 
160     l2 = address_space_ldq_le(as,
161                               td->base_addr + (l2idx * L1TABLE_ENTRY_SIZE),
162                               MEMTXATTRS_UNSPECIFIED, res);
163     if (*res != MEMTX_OK) {
164         return -1;
165     }
166     if (!(l2 & L2_TABLE_VALID_MASK)) {
167         return -1;
168     }
169 
170     num_l2_entries = td->page_sz / td->entry_sz;
171     return (l2 & ((1ULL << 51) - 1)) + (idx % num_l2_entries) * td->entry_sz;
172 }
173 
174 /*
175  * Read the Collection Table entry at index @icid. On success (including
176  * successfully determining that there is no valid CTE for this index),
177  * we return MEMTX_OK and populate the CTEntry struct @cte accordingly.
178  * If there is an error reading memory then we return the error code.
179  */
180 static MemTxResult get_cte(GICv3ITSState *s, uint16_t icid, CTEntry *cte)
181 {
182     AddressSpace *as = &s->gicv3->dma_as;
183     MemTxResult res = MEMTX_OK;
184     uint64_t entry_addr = table_entry_addr(s, &s->ct, icid, &res);
185     uint64_t cteval;
186 
187     if (entry_addr == -1) {
188         /* No L2 table entry, i.e. no valid CTE, or a memory error */
189         cte->valid = false;
190         goto out;
191     }
192 
193     cteval = address_space_ldq_le(as, entry_addr, MEMTXATTRS_UNSPECIFIED, &res);
194     if (res != MEMTX_OK) {
195         goto out;
196     }
197     cte->valid = FIELD_EX64(cteval, CTE, VALID);
198     cte->rdbase = FIELD_EX64(cteval, CTE, RDBASE);
199 out:
200     if (res != MEMTX_OK) {
201         trace_gicv3_its_cte_read_fault(icid);
202     } else {
203         trace_gicv3_its_cte_read(icid, cte->valid, cte->rdbase);
204     }
205     return res;
206 }
207 
208 /*
209  * Update the Interrupt Table entry at index @evinted in the table specified
210  * by the dte @dte. Returns true on success, false if there was a memory
211  * access error.
212  */
213 static bool update_ite(GICv3ITSState *s, uint32_t eventid, const DTEntry *dte,
214                        const ITEntry *ite)
215 {
216     AddressSpace *as = &s->gicv3->dma_as;
217     MemTxResult res = MEMTX_OK;
218     hwaddr iteaddr = dte->ittaddr + eventid * ITS_ITT_ENTRY_SIZE;
219     uint64_t itel = 0;
220     uint32_t iteh = 0;
221 
222     trace_gicv3_its_ite_write(dte->ittaddr, eventid, ite->valid,
223                               ite->inttype, ite->intid, ite->icid,
224                               ite->vpeid, ite->doorbell);
225 
226     if (ite->valid) {
227         itel = FIELD_DP64(itel, ITE_L, VALID, 1);
228         itel = FIELD_DP64(itel, ITE_L, INTTYPE, ite->inttype);
229         itel = FIELD_DP64(itel, ITE_L, INTID, ite->intid);
230         itel = FIELD_DP64(itel, ITE_L, ICID, ite->icid);
231         itel = FIELD_DP64(itel, ITE_L, VPEID, ite->vpeid);
232         iteh = FIELD_DP32(iteh, ITE_H, DOORBELL, ite->doorbell);
233     }
234 
235     address_space_stq_le(as, iteaddr, itel, MEMTXATTRS_UNSPECIFIED, &res);
236     if (res != MEMTX_OK) {
237         return false;
238     }
239     address_space_stl_le(as, iteaddr + 8, iteh, MEMTXATTRS_UNSPECIFIED, &res);
240     return res == MEMTX_OK;
241 }
242 
243 /*
244  * Read the Interrupt Table entry at index @eventid from the table specified
245  * by the DTE @dte. On success, we return MEMTX_OK and populate the ITEntry
246  * struct @ite accordingly. If there is an error reading memory then we return
247  * the error code.
248  */
249 static MemTxResult get_ite(GICv3ITSState *s, uint32_t eventid,
250                            const DTEntry *dte, ITEntry *ite)
251 {
252     AddressSpace *as = &s->gicv3->dma_as;
253     MemTxResult res = MEMTX_OK;
254     uint64_t itel;
255     uint32_t iteh;
256     hwaddr iteaddr = dte->ittaddr + eventid * ITS_ITT_ENTRY_SIZE;
257 
258     itel = address_space_ldq_le(as, iteaddr, MEMTXATTRS_UNSPECIFIED, &res);
259     if (res != MEMTX_OK) {
260         trace_gicv3_its_ite_read_fault(dte->ittaddr, eventid);
261         return res;
262     }
263 
264     iteh = address_space_ldl_le(as, iteaddr + 8, MEMTXATTRS_UNSPECIFIED, &res);
265     if (res != MEMTX_OK) {
266         trace_gicv3_its_ite_read_fault(dte->ittaddr, eventid);
267         return res;
268     }
269 
270     ite->valid = FIELD_EX64(itel, ITE_L, VALID);
271     ite->inttype = FIELD_EX64(itel, ITE_L, INTTYPE);
272     ite->intid = FIELD_EX64(itel, ITE_L, INTID);
273     ite->icid = FIELD_EX64(itel, ITE_L, ICID);
274     ite->vpeid = FIELD_EX64(itel, ITE_L, VPEID);
275     ite->doorbell = FIELD_EX64(iteh, ITE_H, DOORBELL);
276     trace_gicv3_its_ite_read(dte->ittaddr, eventid, ite->valid,
277                              ite->inttype, ite->intid, ite->icid,
278                              ite->vpeid, ite->doorbell);
279     return MEMTX_OK;
280 }
281 
282 /*
283  * Read the Device Table entry at index @devid. On success (including
284  * successfully determining that there is no valid DTE for this index),
285  * we return MEMTX_OK and populate the DTEntry struct accordingly.
286  * If there is an error reading memory then we return the error code.
287  */
288 static MemTxResult get_dte(GICv3ITSState *s, uint32_t devid, DTEntry *dte)
289 {
290     MemTxResult res = MEMTX_OK;
291     AddressSpace *as = &s->gicv3->dma_as;
292     uint64_t entry_addr = table_entry_addr(s, &s->dt, devid, &res);
293     uint64_t dteval;
294 
295     if (entry_addr == -1) {
296         /* No L2 table entry, i.e. no valid DTE, or a memory error */
297         dte->valid = false;
298         goto out;
299     }
300     dteval = address_space_ldq_le(as, entry_addr, MEMTXATTRS_UNSPECIFIED, &res);
301     if (res != MEMTX_OK) {
302         goto out;
303     }
304     dte->valid = FIELD_EX64(dteval, DTE, VALID);
305     dte->size = FIELD_EX64(dteval, DTE, SIZE);
306     /* DTE word field stores bits [51:8] of the ITT address */
307     dte->ittaddr = FIELD_EX64(dteval, DTE, ITTADDR) << ITTADDR_SHIFT;
308 out:
309     if (res != MEMTX_OK) {
310         trace_gicv3_its_dte_read_fault(devid);
311     } else {
312         trace_gicv3_its_dte_read(devid, dte->valid, dte->size, dte->ittaddr);
313     }
314     return res;
315 }
316 
317 /*
318  * Read the vPE Table entry at index @vpeid. On success (including
319  * successfully determining that there is no valid entry for this index),
320  * we return MEMTX_OK and populate the VTEntry struct accordingly.
321  * If there is an error reading memory then we return the error code.
322  */
323 static MemTxResult get_vte(GICv3ITSState *s, uint32_t vpeid, VTEntry *vte)
324 {
325     MemTxResult res = MEMTX_OK;
326     AddressSpace *as = &s->gicv3->dma_as;
327     uint64_t entry_addr = table_entry_addr(s, &s->vpet, vpeid, &res);
328     uint64_t vteval;
329 
330     if (entry_addr == -1) {
331         /* No L2 table entry, i.e. no valid VTE, or a memory error */
332         vte->valid = false;
333         goto out;
334     }
335     vteval = address_space_ldq_le(as, entry_addr, MEMTXATTRS_UNSPECIFIED, &res);
336     if (res != MEMTX_OK) {
337         goto out;
338     }
339     vte->valid = FIELD_EX64(vteval, VTE, VALID);
340     vte->vptsize = FIELD_EX64(vteval, VTE, VPTSIZE);
341     vte->vptaddr = FIELD_EX64(vteval, VTE, VPTADDR);
342     vte->rdbase = FIELD_EX64(vteval, VTE, RDBASE);
343 out:
344     if (res != MEMTX_OK) {
345         trace_gicv3_its_vte_read_fault(vpeid);
346     } else {
347         trace_gicv3_its_vte_read(vpeid, vte->valid, vte->vptsize,
348                                  vte->vptaddr, vte->rdbase);
349     }
350     return res;
351 }
352 
353 /*
354  * Given a (DeviceID, EventID), look up the corresponding ITE, including
355  * checking for the various invalid-value cases. If we find a valid ITE,
356  * fill in @ite and @dte and return CMD_CONTINUE_OK. Otherwise return
357  * CMD_STALL or CMD_CONTINUE as appropriate (and the contents of @ite
358  * should not be relied on).
359  *
360  * The string @who is purely for the LOG_GUEST_ERROR messages,
361  * and should indicate the name of the calling function or similar.
362  */
363 static ItsCmdResult lookup_ite(GICv3ITSState *s, const char *who,
364                                uint32_t devid, uint32_t eventid, ITEntry *ite,
365                                DTEntry *dte)
366 {
367     uint64_t num_eventids;
368 
369     if (devid >= s->dt.num_entries) {
370         qemu_log_mask(LOG_GUEST_ERROR,
371                       "%s: invalid command attributes: devid %d>=%d",
372                       who, devid, s->dt.num_entries);
373         return CMD_CONTINUE;
374     }
375 
376     if (get_dte(s, devid, dte) != MEMTX_OK) {
377         return CMD_STALL;
378     }
379     if (!dte->valid) {
380         qemu_log_mask(LOG_GUEST_ERROR,
381                       "%s: invalid command attributes: "
382                       "invalid dte for %d\n", who, devid);
383         return CMD_CONTINUE;
384     }
385 
386     num_eventids = 1ULL << (dte->size + 1);
387     if (eventid >= num_eventids) {
388         qemu_log_mask(LOG_GUEST_ERROR,
389                       "%s: invalid command attributes: eventid %d >= %"
390                       PRId64 "\n", who, eventid, num_eventids);
391         return CMD_CONTINUE;
392     }
393 
394     if (get_ite(s, eventid, dte, ite) != MEMTX_OK) {
395         return CMD_STALL;
396     }
397 
398     if (!ite->valid) {
399         qemu_log_mask(LOG_GUEST_ERROR,
400                       "%s: invalid command attributes: invalid ITE\n", who);
401         return CMD_CONTINUE;
402     }
403 
404     return CMD_CONTINUE_OK;
405 }
406 
407 /*
408  * Given an ICID, look up the corresponding CTE, including checking for various
409  * invalid-value cases. If we find a valid CTE, fill in @cte and return
410  * CMD_CONTINUE_OK; otherwise return CMD_STALL or CMD_CONTINUE (and the
411  * contents of @cte should not be relied on).
412  *
413  * The string @who is purely for the LOG_GUEST_ERROR messages,
414  * and should indicate the name of the calling function or similar.
415  */
416 static ItsCmdResult lookup_cte(GICv3ITSState *s, const char *who,
417                                uint32_t icid, CTEntry *cte)
418 {
419     if (icid >= s->ct.num_entries) {
420         qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid ICID 0x%x\n", who, icid);
421         return CMD_CONTINUE;
422     }
423     if (get_cte(s, icid, cte) != MEMTX_OK) {
424         return CMD_STALL;
425     }
426     if (!cte->valid) {
427         qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid CTE\n", who);
428         return CMD_CONTINUE;
429     }
430     if (cte->rdbase >= s->gicv3->num_cpu) {
431         return CMD_CONTINUE;
432     }
433     return CMD_CONTINUE_OK;
434 }
435 
436 /*
437  * Given a VPEID, look up the corresponding VTE, including checking
438  * for various invalid-value cases. if we find a valid VTE, fill in @vte
439  * and return CMD_CONTINUE_OK; otherwise return CMD_STALL or CMD_CONTINUE
440  * (and the contents of @vte should not be relied on).
441  *
442  * The string @who is purely for the LOG_GUEST_ERROR messages,
443  * and should indicate the name of the calling function or similar.
444  */
445 static ItsCmdResult lookup_vte(GICv3ITSState *s, const char *who,
446                                uint32_t vpeid, VTEntry *vte)
447 {
448     if (vpeid >= s->vpet.num_entries) {
449         qemu_log_mask(LOG_GUEST_ERROR, "%s: invalid VPEID 0x%x\n", who, vpeid);
450         return CMD_CONTINUE;
451     }
452 
453     if (get_vte(s, vpeid, vte) != MEMTX_OK) {
454         return CMD_STALL;
455     }
456     if (!vte->valid) {
457         qemu_log_mask(LOG_GUEST_ERROR,
458                       "%s: invalid VTE for VPEID 0x%x\n", who, vpeid);
459         return CMD_CONTINUE;
460     }
461 
462     if (vte->rdbase >= s->gicv3->num_cpu) {
463         return CMD_CONTINUE;
464     }
465     return CMD_CONTINUE_OK;
466 }
467 
468 static ItsCmdResult process_its_cmd_phys(GICv3ITSState *s, const ITEntry *ite,
469                                          int irqlevel)
470 {
471     CTEntry cte;
472     ItsCmdResult cmdres;
473 
474     cmdres = lookup_cte(s, __func__, ite->icid, &cte);
475     if (cmdres != CMD_CONTINUE_OK) {
476         return cmdres;
477     }
478     gicv3_redist_process_lpi(&s->gicv3->cpu[cte.rdbase], ite->intid, irqlevel);
479     return CMD_CONTINUE_OK;
480 }
481 
482 static ItsCmdResult process_its_cmd_virt(GICv3ITSState *s, const ITEntry *ite,
483                                          int irqlevel)
484 {
485     VTEntry vte;
486     ItsCmdResult cmdres;
487 
488     cmdres = lookup_vte(s, __func__, ite->vpeid, &vte);
489     if (cmdres != CMD_CONTINUE_OK) {
490         return cmdres;
491     }
492 
493     if (!intid_in_lpi_range(ite->intid) ||
494         ite->intid >= (1ULL << (vte.vptsize + 1))) {
495         qemu_log_mask(LOG_GUEST_ERROR, "%s: intid 0x%x out of range\n",
496                       __func__, ite->intid);
497         return CMD_CONTINUE;
498     }
499 
500     /*
501      * For QEMU the actual pending of the vLPI is handled in the
502      * redistributor code
503      */
504     gicv3_redist_process_vlpi(&s->gicv3->cpu[vte.rdbase], ite->intid,
505                               vte.vptaddr << 16, ite->doorbell, irqlevel);
506     return CMD_CONTINUE_OK;
507 }
508 
509 /*
510  * This function handles the processing of following commands based on
511  * the ItsCmdType parameter passed:-
512  * 1. triggering of lpi interrupt translation via ITS INT command
513  * 2. triggering of lpi interrupt translation via gits_translater register
514  * 3. handling of ITS CLEAR command
515  * 4. handling of ITS DISCARD command
516  */
517 static ItsCmdResult do_process_its_cmd(GICv3ITSState *s, uint32_t devid,
518                                        uint32_t eventid, ItsCmdType cmd)
519 {
520     DTEntry dte;
521     ITEntry ite;
522     ItsCmdResult cmdres;
523     int irqlevel;
524 
525     cmdres = lookup_ite(s, __func__, devid, eventid, &ite, &dte);
526     if (cmdres != CMD_CONTINUE_OK) {
527         return cmdres;
528     }
529 
530     irqlevel = (cmd == CLEAR || cmd == DISCARD) ? 0 : 1;
531 
532     switch (ite.inttype) {
533     case ITE_INTTYPE_PHYSICAL:
534         cmdres = process_its_cmd_phys(s, &ite, irqlevel);
535         break;
536     case ITE_INTTYPE_VIRTUAL:
537         if (!its_feature_virtual(s)) {
538             /* Can't happen unless guest is illegally writing to table memory */
539             qemu_log_mask(LOG_GUEST_ERROR,
540                           "%s: invalid type %d in ITE (table corrupted?)\n",
541                           __func__, ite.inttype);
542             return CMD_CONTINUE;
543         }
544         cmdres = process_its_cmd_virt(s, &ite, irqlevel);
545         break;
546     default:
547         g_assert_not_reached();
548     }
549 
550     if (cmdres == CMD_CONTINUE_OK && cmd == DISCARD) {
551         ITEntry ite = {};
552         /* remove mapping from interrupt translation table */
553         ite.valid = false;
554         return update_ite(s, eventid, &dte, &ite) ? CMD_CONTINUE_OK : CMD_STALL;
555     }
556     return CMD_CONTINUE_OK;
557 }
558 
559 static ItsCmdResult process_its_cmd(GICv3ITSState *s, const uint64_t *cmdpkt,
560                                     ItsCmdType cmd)
561 {
562     uint32_t devid, eventid;
563 
564     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
565     eventid = cmdpkt[1] & EVENTID_MASK;
566     switch (cmd) {
567     case INTERRUPT:
568         trace_gicv3_its_cmd_int(devid, eventid);
569         break;
570     case CLEAR:
571         trace_gicv3_its_cmd_clear(devid, eventid);
572         break;
573     case DISCARD:
574         trace_gicv3_its_cmd_discard(devid, eventid);
575         break;
576     default:
577         g_assert_not_reached();
578     }
579     return do_process_its_cmd(s, devid, eventid, cmd);
580 }
581 
582 static ItsCmdResult process_mapti(GICv3ITSState *s, const uint64_t *cmdpkt,
583                                   bool ignore_pInt)
584 {
585     uint32_t devid, eventid;
586     uint32_t pIntid = 0;
587     uint64_t num_eventids;
588     uint16_t icid = 0;
589     DTEntry dte;
590     ITEntry ite;
591 
592     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
593     eventid = cmdpkt[1] & EVENTID_MASK;
594     icid = cmdpkt[2] & ICID_MASK;
595 
596     if (ignore_pInt) {
597         pIntid = eventid;
598         trace_gicv3_its_cmd_mapi(devid, eventid, icid);
599     } else {
600         pIntid = (cmdpkt[1] & pINTID_MASK) >> pINTID_SHIFT;
601         trace_gicv3_its_cmd_mapti(devid, eventid, icid, pIntid);
602     }
603 
604     if (devid >= s->dt.num_entries) {
605         qemu_log_mask(LOG_GUEST_ERROR,
606                       "%s: invalid command attributes: devid %d>=%d",
607                       __func__, devid, s->dt.num_entries);
608         return CMD_CONTINUE;
609     }
610 
611     if (get_dte(s, devid, &dte) != MEMTX_OK) {
612         return CMD_STALL;
613     }
614     num_eventids = 1ULL << (dte.size + 1);
615 
616     if (icid >= s->ct.num_entries) {
617         qemu_log_mask(LOG_GUEST_ERROR,
618                       "%s: invalid ICID 0x%x >= 0x%x\n",
619                       __func__, icid, s->ct.num_entries);
620         return CMD_CONTINUE;
621     }
622 
623     if (!dte.valid) {
624         qemu_log_mask(LOG_GUEST_ERROR,
625                       "%s: no valid DTE for devid 0x%x\n", __func__, devid);
626         return CMD_CONTINUE;
627     }
628 
629     if (eventid >= num_eventids) {
630         qemu_log_mask(LOG_GUEST_ERROR,
631                       "%s: invalid event ID 0x%x >= 0x%" PRIx64 "\n",
632                       __func__, eventid, num_eventids);
633         return CMD_CONTINUE;
634     }
635 
636     if (!intid_in_lpi_range(pIntid)) {
637         qemu_log_mask(LOG_GUEST_ERROR,
638                       "%s: invalid interrupt ID 0x%x\n", __func__, pIntid);
639         return CMD_CONTINUE;
640     }
641 
642     /* add ite entry to interrupt translation table */
643     ite.valid = true;
644     ite.inttype = ITE_INTTYPE_PHYSICAL;
645     ite.intid = pIntid;
646     ite.icid = icid;
647     ite.doorbell = INTID_SPURIOUS;
648     ite.vpeid = 0;
649     return update_ite(s, eventid, &dte, &ite) ? CMD_CONTINUE_OK : CMD_STALL;
650 }
651 
652 static ItsCmdResult process_vmapti(GICv3ITSState *s, const uint64_t *cmdpkt,
653                                    bool ignore_vintid)
654 {
655     uint32_t devid, eventid, vintid, doorbell, vpeid;
656     uint32_t num_eventids;
657     DTEntry dte;
658     ITEntry ite;
659 
660     if (!its_feature_virtual(s)) {
661         return CMD_CONTINUE;
662     }
663 
664     devid = FIELD_EX64(cmdpkt[0], VMAPTI_0, DEVICEID);
665     eventid = FIELD_EX64(cmdpkt[1], VMAPTI_1, EVENTID);
666     vpeid = FIELD_EX64(cmdpkt[1], VMAPTI_1, VPEID);
667     doorbell = FIELD_EX64(cmdpkt[2], VMAPTI_2, DOORBELL);
668     if (ignore_vintid) {
669         vintid = eventid;
670         trace_gicv3_its_cmd_vmapi(devid, eventid, vpeid, doorbell);
671     } else {
672         vintid = FIELD_EX64(cmdpkt[2], VMAPTI_2, VINTID);
673         trace_gicv3_its_cmd_vmapti(devid, eventid, vpeid, vintid, doorbell);
674     }
675 
676     if (devid >= s->dt.num_entries) {
677         qemu_log_mask(LOG_GUEST_ERROR,
678                       "%s: invalid DeviceID 0x%x (must be less than 0x%x)\n",
679                       __func__, devid, s->dt.num_entries);
680         return CMD_CONTINUE;
681     }
682 
683     if (get_dte(s, devid, &dte) != MEMTX_OK) {
684         return CMD_STALL;
685     }
686 
687     if (!dte.valid) {
688         qemu_log_mask(LOG_GUEST_ERROR,
689                       "%s: no entry in device table for DeviceID 0x%x\n",
690                       __func__, devid);
691         return CMD_CONTINUE;
692     }
693 
694     num_eventids = 1ULL << (dte.size + 1);
695 
696     if (eventid >= num_eventids) {
697         qemu_log_mask(LOG_GUEST_ERROR,
698                       "%s: EventID 0x%x too large for DeviceID 0x%x "
699                       "(must be less than 0x%x)\n",
700                       __func__, eventid, devid, num_eventids);
701         return CMD_CONTINUE;
702     }
703     if (!intid_in_lpi_range(vintid)) {
704         qemu_log_mask(LOG_GUEST_ERROR,
705                       "%s: VIntID 0x%x not a valid LPI\n",
706                       __func__, vintid);
707         return CMD_CONTINUE;
708     }
709     if (!valid_doorbell(doorbell)) {
710         qemu_log_mask(LOG_GUEST_ERROR,
711                       "%s: Doorbell %d not 1023 and not a valid LPI\n",
712                       __func__, doorbell);
713         return CMD_CONTINUE;
714     }
715     if (vpeid >= s->vpet.num_entries) {
716         qemu_log_mask(LOG_GUEST_ERROR,
717                       "%s: VPEID 0x%x out of range (must be less than 0x%x)\n",
718                       __func__, vpeid, s->vpet.num_entries);
719         return CMD_CONTINUE;
720     }
721     /* add ite entry to interrupt translation table */
722     ite.valid = true;
723     ite.inttype = ITE_INTTYPE_VIRTUAL;
724     ite.intid = vintid;
725     ite.icid = 0;
726     ite.doorbell = doorbell;
727     ite.vpeid = vpeid;
728     return update_ite(s, eventid, &dte, &ite) ? CMD_CONTINUE_OK : CMD_STALL;
729 }
730 
731 /*
732  * Update the Collection Table entry for @icid to @cte. Returns true
733  * on success, false if there was a memory access error.
734  */
735 static bool update_cte(GICv3ITSState *s, uint16_t icid, const CTEntry *cte)
736 {
737     AddressSpace *as = &s->gicv3->dma_as;
738     uint64_t entry_addr;
739     uint64_t cteval = 0;
740     MemTxResult res = MEMTX_OK;
741 
742     trace_gicv3_its_cte_write(icid, cte->valid, cte->rdbase);
743 
744     if (cte->valid) {
745         /* add mapping entry to collection table */
746         cteval = FIELD_DP64(cteval, CTE, VALID, 1);
747         cteval = FIELD_DP64(cteval, CTE, RDBASE, cte->rdbase);
748     }
749 
750     entry_addr = table_entry_addr(s, &s->ct, icid, &res);
751     if (res != MEMTX_OK) {
752         /* memory access error: stall */
753         return false;
754     }
755     if (entry_addr == -1) {
756         /* No L2 table for this index: discard write and continue */
757         return true;
758     }
759 
760     address_space_stq_le(as, entry_addr, cteval, MEMTXATTRS_UNSPECIFIED, &res);
761     return res == MEMTX_OK;
762 }
763 
764 static ItsCmdResult process_mapc(GICv3ITSState *s, const uint64_t *cmdpkt)
765 {
766     uint16_t icid;
767     CTEntry cte;
768 
769     icid = cmdpkt[2] & ICID_MASK;
770     cte.valid = cmdpkt[2] & CMD_FIELD_VALID_MASK;
771     if (cte.valid) {
772         cte.rdbase = (cmdpkt[2] & R_MAPC_RDBASE_MASK) >> R_MAPC_RDBASE_SHIFT;
773         cte.rdbase &= RDBASE_PROCNUM_MASK;
774     } else {
775         cte.rdbase = 0;
776     }
777     trace_gicv3_its_cmd_mapc(icid, cte.rdbase, cte.valid);
778 
779     if (icid >= s->ct.num_entries) {
780         qemu_log_mask(LOG_GUEST_ERROR, "ITS MAPC: invalid ICID 0x%x\n", icid);
781         return CMD_CONTINUE;
782     }
783     if (cte.valid && cte.rdbase >= s->gicv3->num_cpu) {
784         qemu_log_mask(LOG_GUEST_ERROR,
785                       "ITS MAPC: invalid RDBASE %u\n", cte.rdbase);
786         return CMD_CONTINUE;
787     }
788 
789     return update_cte(s, icid, &cte) ? CMD_CONTINUE_OK : CMD_STALL;
790 }
791 
792 /*
793  * Update the Device Table entry for @devid to @dte. Returns true
794  * on success, false if there was a memory access error.
795  */
796 static bool update_dte(GICv3ITSState *s, uint32_t devid, const DTEntry *dte)
797 {
798     AddressSpace *as = &s->gicv3->dma_as;
799     uint64_t entry_addr;
800     uint64_t dteval = 0;
801     MemTxResult res = MEMTX_OK;
802 
803     trace_gicv3_its_dte_write(devid, dte->valid, dte->size, dte->ittaddr);
804 
805     if (dte->valid) {
806         /* add mapping entry to device table */
807         dteval = FIELD_DP64(dteval, DTE, VALID, 1);
808         dteval = FIELD_DP64(dteval, DTE, SIZE, dte->size);
809         dteval = FIELD_DP64(dteval, DTE, ITTADDR, dte->ittaddr);
810     }
811 
812     entry_addr = table_entry_addr(s, &s->dt, devid, &res);
813     if (res != MEMTX_OK) {
814         /* memory access error: stall */
815         return false;
816     }
817     if (entry_addr == -1) {
818         /* No L2 table for this index: discard write and continue */
819         return true;
820     }
821     address_space_stq_le(as, entry_addr, dteval, MEMTXATTRS_UNSPECIFIED, &res);
822     return res == MEMTX_OK;
823 }
824 
825 static ItsCmdResult process_mapd(GICv3ITSState *s, const uint64_t *cmdpkt)
826 {
827     uint32_t devid;
828     DTEntry dte;
829 
830     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
831     dte.size = cmdpkt[1] & SIZE_MASK;
832     dte.ittaddr = (cmdpkt[2] & ITTADDR_MASK) >> ITTADDR_SHIFT;
833     dte.valid = cmdpkt[2] & CMD_FIELD_VALID_MASK;
834 
835     trace_gicv3_its_cmd_mapd(devid, dte.size, dte.ittaddr, dte.valid);
836 
837     if (devid >= s->dt.num_entries) {
838         qemu_log_mask(LOG_GUEST_ERROR,
839                       "ITS MAPD: invalid device ID field 0x%x >= 0x%x\n",
840                       devid, s->dt.num_entries);
841         return CMD_CONTINUE;
842     }
843 
844     if (dte.size > FIELD_EX64(s->typer, GITS_TYPER, IDBITS)) {
845         qemu_log_mask(LOG_GUEST_ERROR,
846                       "ITS MAPD: invalid size %d\n", dte.size);
847         return CMD_CONTINUE;
848     }
849 
850     return update_dte(s, devid, &dte) ? CMD_CONTINUE_OK : CMD_STALL;
851 }
852 
853 static ItsCmdResult process_movall(GICv3ITSState *s, const uint64_t *cmdpkt)
854 {
855     uint64_t rd1, rd2;
856 
857     rd1 = FIELD_EX64(cmdpkt[2], MOVALL_2, RDBASE1);
858     rd2 = FIELD_EX64(cmdpkt[3], MOVALL_3, RDBASE2);
859 
860     trace_gicv3_its_cmd_movall(rd1, rd2);
861 
862     if (rd1 >= s->gicv3->num_cpu) {
863         qemu_log_mask(LOG_GUEST_ERROR,
864                       "%s: RDBASE1 %" PRId64
865                       " out of range (must be less than %d)\n",
866                       __func__, rd1, s->gicv3->num_cpu);
867         return CMD_CONTINUE;
868     }
869     if (rd2 >= s->gicv3->num_cpu) {
870         qemu_log_mask(LOG_GUEST_ERROR,
871                       "%s: RDBASE2 %" PRId64
872                       " out of range (must be less than %d)\n",
873                       __func__, rd2, s->gicv3->num_cpu);
874         return CMD_CONTINUE;
875     }
876 
877     if (rd1 == rd2) {
878         /* Move to same target must succeed as a no-op */
879         return CMD_CONTINUE_OK;
880     }
881 
882     /* Move all pending LPIs from redistributor 1 to redistributor 2 */
883     gicv3_redist_movall_lpis(&s->gicv3->cpu[rd1], &s->gicv3->cpu[rd2]);
884 
885     return CMD_CONTINUE_OK;
886 }
887 
888 static ItsCmdResult process_movi(GICv3ITSState *s, const uint64_t *cmdpkt)
889 {
890     uint32_t devid, eventid;
891     uint16_t new_icid;
892     DTEntry dte;
893     CTEntry old_cte, new_cte;
894     ITEntry old_ite;
895     ItsCmdResult cmdres;
896 
897     devid = FIELD_EX64(cmdpkt[0], MOVI_0, DEVICEID);
898     eventid = FIELD_EX64(cmdpkt[1], MOVI_1, EVENTID);
899     new_icid = FIELD_EX64(cmdpkt[2], MOVI_2, ICID);
900 
901     trace_gicv3_its_cmd_movi(devid, eventid, new_icid);
902 
903     cmdres = lookup_ite(s, __func__, devid, eventid, &old_ite, &dte);
904     if (cmdres != CMD_CONTINUE_OK) {
905         return cmdres;
906     }
907 
908     if (old_ite.inttype != ITE_INTTYPE_PHYSICAL) {
909         qemu_log_mask(LOG_GUEST_ERROR,
910                       "%s: invalid command attributes: invalid ITE\n",
911                       __func__);
912         return CMD_CONTINUE;
913     }
914 
915     cmdres = lookup_cte(s, __func__, old_ite.icid, &old_cte);
916     if (cmdres != CMD_CONTINUE_OK) {
917         return cmdres;
918     }
919     cmdres = lookup_cte(s, __func__, new_icid, &new_cte);
920     if (cmdres != CMD_CONTINUE_OK) {
921         return cmdres;
922     }
923 
924     if (old_cte.rdbase != new_cte.rdbase) {
925         /* Move the LPI from the old redistributor to the new one */
926         gicv3_redist_mov_lpi(&s->gicv3->cpu[old_cte.rdbase],
927                              &s->gicv3->cpu[new_cte.rdbase],
928                              old_ite.intid);
929     }
930 
931     /* Update the ICID field in the interrupt translation table entry */
932     old_ite.icid = new_icid;
933     return update_ite(s, eventid, &dte, &old_ite) ? CMD_CONTINUE_OK : CMD_STALL;
934 }
935 
936 /*
937  * Update the vPE Table entry at index @vpeid with the entry @vte.
938  * Returns true on success, false if there was a memory access error.
939  */
940 static bool update_vte(GICv3ITSState *s, uint32_t vpeid, const VTEntry *vte)
941 {
942     AddressSpace *as = &s->gicv3->dma_as;
943     uint64_t entry_addr;
944     uint64_t vteval = 0;
945     MemTxResult res = MEMTX_OK;
946 
947     trace_gicv3_its_vte_write(vpeid, vte->valid, vte->vptsize, vte->vptaddr,
948                               vte->rdbase);
949 
950     if (vte->valid) {
951         vteval = FIELD_DP64(vteval, VTE, VALID, 1);
952         vteval = FIELD_DP64(vteval, VTE, VPTSIZE, vte->vptsize);
953         vteval = FIELD_DP64(vteval, VTE, VPTADDR, vte->vptaddr);
954         vteval = FIELD_DP64(vteval, VTE, RDBASE, vte->rdbase);
955     }
956 
957     entry_addr = table_entry_addr(s, &s->vpet, vpeid, &res);
958     if (res != MEMTX_OK) {
959         return false;
960     }
961     if (entry_addr == -1) {
962         /* No L2 table for this index: discard write and continue */
963         return true;
964     }
965     address_space_stq_le(as, entry_addr, vteval, MEMTXATTRS_UNSPECIFIED, &res);
966     return res == MEMTX_OK;
967 }
968 
969 static ItsCmdResult process_vmapp(GICv3ITSState *s, const uint64_t *cmdpkt)
970 {
971     VTEntry vte;
972     uint32_t vpeid;
973 
974     if (!its_feature_virtual(s)) {
975         return CMD_CONTINUE;
976     }
977 
978     vpeid = FIELD_EX64(cmdpkt[1], VMAPP_1, VPEID);
979     vte.rdbase = FIELD_EX64(cmdpkt[2], VMAPP_2, RDBASE);
980     vte.valid = FIELD_EX64(cmdpkt[2], VMAPP_2, V);
981     vte.vptsize = FIELD_EX64(cmdpkt[3], VMAPP_3, VPTSIZE);
982     vte.vptaddr = FIELD_EX64(cmdpkt[3], VMAPP_3, VPTADDR);
983 
984     trace_gicv3_its_cmd_vmapp(vpeid, vte.rdbase, vte.valid,
985                               vte.vptaddr, vte.vptsize);
986 
987     /*
988      * For GICv4.0 the VPT_size field is only 5 bits, whereas we
989      * define our field macros to include the full GICv4.1 8 bits.
990      * The range check on VPT_size will catch the cases where
991      * the guest set the RES0-in-GICv4.0 bits [7:6].
992      */
993     if (vte.vptsize > FIELD_EX64(s->typer, GITS_TYPER, IDBITS)) {
994         qemu_log_mask(LOG_GUEST_ERROR,
995                       "%s: invalid VPT_size 0x%x\n", __func__, vte.vptsize);
996         return CMD_CONTINUE;
997     }
998 
999     if (vte.valid && vte.rdbase >= s->gicv3->num_cpu) {
1000         qemu_log_mask(LOG_GUEST_ERROR,
1001                       "%s: invalid rdbase 0x%x\n", __func__, vte.rdbase);
1002         return CMD_CONTINUE;
1003     }
1004 
1005     if (vpeid >= s->vpet.num_entries) {
1006         qemu_log_mask(LOG_GUEST_ERROR,
1007                       "%s: VPEID 0x%x out of range (must be less than 0x%x)\n",
1008                       __func__, vpeid, s->vpet.num_entries);
1009         return CMD_CONTINUE;
1010     }
1011 
1012     return update_vte(s, vpeid, &vte) ? CMD_CONTINUE_OK : CMD_STALL;
1013 }
1014 
1015 typedef struct VmovpCallbackData {
1016     uint64_t rdbase;
1017     uint32_t vpeid;
1018     /*
1019      * Overall command result. If more than one callback finds an
1020      * error, STALL beats CONTINUE.
1021      */
1022     ItsCmdResult result;
1023 } VmovpCallbackData;
1024 
1025 static void vmovp_callback(gpointer data, gpointer opaque)
1026 {
1027     /*
1028      * This function is called to update the VPEID field in a VPE
1029      * table entry for this ITS. This might be because of a VMOVP
1030      * command executed on any ITS that is connected to the same GIC
1031      * as this ITS.  We need to read the VPE table entry for the VPEID
1032      * and update its RDBASE field.
1033      */
1034     GICv3ITSState *s = data;
1035     VmovpCallbackData *cbdata = opaque;
1036     VTEntry vte;
1037     ItsCmdResult cmdres;
1038 
1039     cmdres = lookup_vte(s, __func__, cbdata->vpeid, &vte);
1040     switch (cmdres) {
1041     case CMD_STALL:
1042         cbdata->result = CMD_STALL;
1043         return;
1044     case CMD_CONTINUE:
1045         if (cbdata->result != CMD_STALL) {
1046             cbdata->result = CMD_CONTINUE;
1047         }
1048         return;
1049     case CMD_CONTINUE_OK:
1050         break;
1051     }
1052 
1053     vte.rdbase = cbdata->rdbase;
1054     if (!update_vte(s, cbdata->vpeid, &vte)) {
1055         cbdata->result = CMD_STALL;
1056     }
1057 }
1058 
1059 static ItsCmdResult process_vmovp(GICv3ITSState *s, const uint64_t *cmdpkt)
1060 {
1061     VmovpCallbackData cbdata;
1062 
1063     if (!its_feature_virtual(s)) {
1064         return CMD_CONTINUE;
1065     }
1066 
1067     cbdata.vpeid = FIELD_EX64(cmdpkt[1], VMOVP_1, VPEID);
1068     cbdata.rdbase = FIELD_EX64(cmdpkt[2], VMOVP_2, RDBASE);
1069 
1070     trace_gicv3_its_cmd_vmovp(cbdata.vpeid, cbdata.rdbase);
1071 
1072     if (cbdata.rdbase >= s->gicv3->num_cpu) {
1073         return CMD_CONTINUE;
1074     }
1075 
1076     /*
1077      * Our ITS implementation reports GITS_TYPER.VMOVP == 1, which means
1078      * that when the VMOVP command is executed on an ITS to change the
1079      * VPEID field in a VPE table entry the change must be propagated
1080      * to all the ITSes connected to the same GIC.
1081      */
1082     cbdata.result = CMD_CONTINUE_OK;
1083     gicv3_foreach_its(s->gicv3, vmovp_callback, &cbdata);
1084     return cbdata.result;
1085 }
1086 
1087 /*
1088  * Current implementation blocks until all
1089  * commands are processed
1090  */
1091 static void process_cmdq(GICv3ITSState *s)
1092 {
1093     uint32_t wr_offset = 0;
1094     uint32_t rd_offset = 0;
1095     uint32_t cq_offset = 0;
1096     AddressSpace *as = &s->gicv3->dma_as;
1097     uint8_t cmd;
1098     int i;
1099 
1100     if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
1101         return;
1102     }
1103 
1104     wr_offset = FIELD_EX64(s->cwriter, GITS_CWRITER, OFFSET);
1105 
1106     if (wr_offset >= s->cq.num_entries) {
1107         qemu_log_mask(LOG_GUEST_ERROR,
1108                       "%s: invalid write offset "
1109                       "%d\n", __func__, wr_offset);
1110         return;
1111     }
1112 
1113     rd_offset = FIELD_EX64(s->creadr, GITS_CREADR, OFFSET);
1114 
1115     if (rd_offset >= s->cq.num_entries) {
1116         qemu_log_mask(LOG_GUEST_ERROR,
1117                       "%s: invalid read offset "
1118                       "%d\n", __func__, rd_offset);
1119         return;
1120     }
1121 
1122     while (wr_offset != rd_offset) {
1123         ItsCmdResult result = CMD_CONTINUE_OK;
1124         void *hostmem;
1125         hwaddr buflen;
1126         uint64_t cmdpkt[GITS_CMDQ_ENTRY_WORDS];
1127 
1128         cq_offset = (rd_offset * GITS_CMDQ_ENTRY_SIZE);
1129 
1130         buflen = GITS_CMDQ_ENTRY_SIZE;
1131         hostmem = address_space_map(as, s->cq.base_addr + cq_offset,
1132                                     &buflen, false, MEMTXATTRS_UNSPECIFIED);
1133         if (!hostmem || buflen != GITS_CMDQ_ENTRY_SIZE) {
1134             if (hostmem) {
1135                 address_space_unmap(as, hostmem, buflen, false, 0);
1136             }
1137             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, STALLED, 1);
1138             qemu_log_mask(LOG_GUEST_ERROR,
1139                           "%s: could not read command at 0x%" PRIx64 "\n",
1140                           __func__, s->cq.base_addr + cq_offset);
1141             break;
1142         }
1143         for (i = 0; i < ARRAY_SIZE(cmdpkt); i++) {
1144             cmdpkt[i] = ldq_le_p(hostmem + i * sizeof(uint64_t));
1145         }
1146         address_space_unmap(as, hostmem, buflen, false, 0);
1147 
1148         cmd = cmdpkt[0] & CMD_MASK;
1149 
1150         trace_gicv3_its_process_command(rd_offset, cmd);
1151 
1152         switch (cmd) {
1153         case GITS_CMD_INT:
1154             result = process_its_cmd(s, cmdpkt, INTERRUPT);
1155             break;
1156         case GITS_CMD_CLEAR:
1157             result = process_its_cmd(s, cmdpkt, CLEAR);
1158             break;
1159         case GITS_CMD_SYNC:
1160             /*
1161              * Current implementation makes a blocking synchronous call
1162              * for every command issued earlier, hence the internal state
1163              * is already consistent by the time SYNC command is executed.
1164              * Hence no further processing is required for SYNC command.
1165              */
1166             trace_gicv3_its_cmd_sync();
1167             break;
1168         case GITS_CMD_VSYNC:
1169             /*
1170              * VSYNC also is a nop, because our implementation is always
1171              * in sync.
1172              */
1173             if (!its_feature_virtual(s)) {
1174                 result = CMD_CONTINUE;
1175                 break;
1176             }
1177             trace_gicv3_its_cmd_vsync();
1178             break;
1179         case GITS_CMD_MAPD:
1180             result = process_mapd(s, cmdpkt);
1181             break;
1182         case GITS_CMD_MAPC:
1183             result = process_mapc(s, cmdpkt);
1184             break;
1185         case GITS_CMD_MAPTI:
1186             result = process_mapti(s, cmdpkt, false);
1187             break;
1188         case GITS_CMD_MAPI:
1189             result = process_mapti(s, cmdpkt, true);
1190             break;
1191         case GITS_CMD_DISCARD:
1192             result = process_its_cmd(s, cmdpkt, DISCARD);
1193             break;
1194         case GITS_CMD_INV:
1195         case GITS_CMD_INVALL:
1196             /*
1197              * Current implementation doesn't cache any ITS tables,
1198              * but the calculated lpi priority information. We only
1199              * need to trigger lpi priority re-calculation to be in
1200              * sync with LPI config table or pending table changes.
1201              */
1202             trace_gicv3_its_cmd_inv();
1203             for (i = 0; i < s->gicv3->num_cpu; i++) {
1204                 gicv3_redist_update_lpi(&s->gicv3->cpu[i]);
1205             }
1206             break;
1207         case GITS_CMD_MOVI:
1208             result = process_movi(s, cmdpkt);
1209             break;
1210         case GITS_CMD_MOVALL:
1211             result = process_movall(s, cmdpkt);
1212             break;
1213         case GITS_CMD_VMAPTI:
1214             result = process_vmapti(s, cmdpkt, false);
1215             break;
1216         case GITS_CMD_VMAPI:
1217             result = process_vmapti(s, cmdpkt, true);
1218             break;
1219         case GITS_CMD_VMAPP:
1220             result = process_vmapp(s, cmdpkt);
1221             break;
1222         case GITS_CMD_VMOVP:
1223             result = process_vmovp(s, cmdpkt);
1224             break;
1225         default:
1226             trace_gicv3_its_cmd_unknown(cmd);
1227             break;
1228         }
1229         if (result != CMD_STALL) {
1230             /* CMD_CONTINUE or CMD_CONTINUE_OK */
1231             rd_offset++;
1232             rd_offset %= s->cq.num_entries;
1233             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, OFFSET, rd_offset);
1234         } else {
1235             /* CMD_STALL */
1236             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, STALLED, 1);
1237             qemu_log_mask(LOG_GUEST_ERROR,
1238                           "%s: 0x%x cmd processing failed, stalling\n",
1239                           __func__, cmd);
1240             break;
1241         }
1242     }
1243 }
1244 
1245 /*
1246  * This function extracts the ITS Device and Collection table specific
1247  * parameters (like base_addr, size etc) from GITS_BASER register.
1248  * It is called during ITS enable and also during post_load migration
1249  */
1250 static void extract_table_params(GICv3ITSState *s)
1251 {
1252     uint16_t num_pages = 0;
1253     uint8_t  page_sz_type;
1254     uint8_t type;
1255     uint32_t page_sz = 0;
1256     uint64_t value;
1257 
1258     for (int i = 0; i < 8; i++) {
1259         TableDesc *td;
1260         int idbits;
1261 
1262         value = s->baser[i];
1263 
1264         if (!value) {
1265             continue;
1266         }
1267 
1268         page_sz_type = FIELD_EX64(value, GITS_BASER, PAGESIZE);
1269 
1270         switch (page_sz_type) {
1271         case 0:
1272             page_sz = GITS_PAGE_SIZE_4K;
1273             break;
1274 
1275         case 1:
1276             page_sz = GITS_PAGE_SIZE_16K;
1277             break;
1278 
1279         case 2:
1280         case 3:
1281             page_sz = GITS_PAGE_SIZE_64K;
1282             break;
1283 
1284         default:
1285             g_assert_not_reached();
1286         }
1287 
1288         num_pages = FIELD_EX64(value, GITS_BASER, SIZE) + 1;
1289 
1290         type = FIELD_EX64(value, GITS_BASER, TYPE);
1291 
1292         switch (type) {
1293         case GITS_BASER_TYPE_DEVICE:
1294             td = &s->dt;
1295             idbits = FIELD_EX64(s->typer, GITS_TYPER, DEVBITS) + 1;
1296             break;
1297         case GITS_BASER_TYPE_COLLECTION:
1298             td = &s->ct;
1299             if (FIELD_EX64(s->typer, GITS_TYPER, CIL)) {
1300                 idbits = FIELD_EX64(s->typer, GITS_TYPER, CIDBITS) + 1;
1301             } else {
1302                 /* 16-bit CollectionId supported when CIL == 0 */
1303                 idbits = 16;
1304             }
1305             break;
1306         case GITS_BASER_TYPE_VPE:
1307             td = &s->vpet;
1308             /*
1309              * For QEMU vPEIDs are always 16 bits. (GICv4.1 allows an
1310              * implementation to implement fewer bits and report this
1311              * via GICD_TYPER2.)
1312              */
1313             idbits = 16;
1314             break;
1315         default:
1316             /*
1317              * GITS_BASER<n>.TYPE is read-only, so GITS_BASER_RO_MASK
1318              * ensures we will only see type values corresponding to
1319              * the values set up in gicv3_its_reset().
1320              */
1321             g_assert_not_reached();
1322         }
1323 
1324         memset(td, 0, sizeof(*td));
1325         /*
1326          * If GITS_BASER<n>.Valid is 0 for any <n> then we will not process
1327          * interrupts. (GITS_TYPER.HCC is 0 for this implementation, so we
1328          * do not have a special case where the GITS_BASER<n>.Valid bit is 0
1329          * for the register corresponding to the Collection table but we
1330          * still have to process interrupts using non-memory-backed
1331          * Collection table entries.)
1332          * The specification makes it UNPREDICTABLE to enable the ITS without
1333          * marking each BASER<n> as valid. We choose to handle these as if
1334          * the table was zero-sized, so commands using the table will fail
1335          * and interrupts requested via GITS_TRANSLATER writes will be ignored.
1336          * This happens automatically by leaving the num_entries field at
1337          * zero, which will be caught by the bounds checks we have before
1338          * every table lookup anyway.
1339          */
1340         if (!FIELD_EX64(value, GITS_BASER, VALID)) {
1341             continue;
1342         }
1343         td->page_sz = page_sz;
1344         td->indirect = FIELD_EX64(value, GITS_BASER, INDIRECT);
1345         td->entry_sz = FIELD_EX64(value, GITS_BASER, ENTRYSIZE) + 1;
1346         td->base_addr = baser_base_addr(value, page_sz);
1347         if (!td->indirect) {
1348             td->num_entries = (num_pages * page_sz) / td->entry_sz;
1349         } else {
1350             td->num_entries = (((num_pages * page_sz) /
1351                                   L1TABLE_ENTRY_SIZE) *
1352                                  (page_sz / td->entry_sz));
1353         }
1354         td->num_entries = MIN(td->num_entries, 1ULL << idbits);
1355     }
1356 }
1357 
1358 static void extract_cmdq_params(GICv3ITSState *s)
1359 {
1360     uint16_t num_pages = 0;
1361     uint64_t value = s->cbaser;
1362 
1363     num_pages = FIELD_EX64(value, GITS_CBASER, SIZE) + 1;
1364 
1365     memset(&s->cq, 0 , sizeof(s->cq));
1366 
1367     if (FIELD_EX64(value, GITS_CBASER, VALID)) {
1368         s->cq.num_entries = (num_pages * GITS_PAGE_SIZE_4K) /
1369                              GITS_CMDQ_ENTRY_SIZE;
1370         s->cq.base_addr = FIELD_EX64(value, GITS_CBASER, PHYADDR);
1371         s->cq.base_addr <<= R_GITS_CBASER_PHYADDR_SHIFT;
1372     }
1373 }
1374 
1375 static MemTxResult gicv3_its_translation_read(void *opaque, hwaddr offset,
1376                                               uint64_t *data, unsigned size,
1377                                               MemTxAttrs attrs)
1378 {
1379     /*
1380      * GITS_TRANSLATER is write-only, and all other addresses
1381      * in the interrupt translation space frame are RES0.
1382      */
1383     *data = 0;
1384     return MEMTX_OK;
1385 }
1386 
1387 static MemTxResult gicv3_its_translation_write(void *opaque, hwaddr offset,
1388                                                uint64_t data, unsigned size,
1389                                                MemTxAttrs attrs)
1390 {
1391     GICv3ITSState *s = (GICv3ITSState *)opaque;
1392     bool result = true;
1393 
1394     trace_gicv3_its_translation_write(offset, data, size, attrs.requester_id);
1395 
1396     switch (offset) {
1397     case GITS_TRANSLATER:
1398         if (s->ctlr & R_GITS_CTLR_ENABLED_MASK) {
1399             result = do_process_its_cmd(s, attrs.requester_id, data, NONE);
1400         }
1401         break;
1402     default:
1403         break;
1404     }
1405 
1406     if (result) {
1407         return MEMTX_OK;
1408     } else {
1409         return MEMTX_ERROR;
1410     }
1411 }
1412 
1413 static bool its_writel(GICv3ITSState *s, hwaddr offset,
1414                               uint64_t value, MemTxAttrs attrs)
1415 {
1416     bool result = true;
1417     int index;
1418 
1419     switch (offset) {
1420     case GITS_CTLR:
1421         if (value & R_GITS_CTLR_ENABLED_MASK) {
1422             s->ctlr |= R_GITS_CTLR_ENABLED_MASK;
1423             extract_table_params(s);
1424             extract_cmdq_params(s);
1425             process_cmdq(s);
1426         } else {
1427             s->ctlr &= ~R_GITS_CTLR_ENABLED_MASK;
1428         }
1429         break;
1430     case GITS_CBASER:
1431         /*
1432          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
1433          *                 already enabled
1434          */
1435         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
1436             s->cbaser = deposit64(s->cbaser, 0, 32, value);
1437             s->creadr = 0;
1438         }
1439         break;
1440     case GITS_CBASER + 4:
1441         /*
1442          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
1443          *                 already enabled
1444          */
1445         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
1446             s->cbaser = deposit64(s->cbaser, 32, 32, value);
1447             s->creadr = 0;
1448         }
1449         break;
1450     case GITS_CWRITER:
1451         s->cwriter = deposit64(s->cwriter, 0, 32,
1452                                (value & ~R_GITS_CWRITER_RETRY_MASK));
1453         if (s->cwriter != s->creadr) {
1454             process_cmdq(s);
1455         }
1456         break;
1457     case GITS_CWRITER + 4:
1458         s->cwriter = deposit64(s->cwriter, 32, 32, value);
1459         break;
1460     case GITS_CREADR:
1461         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
1462             s->creadr = deposit64(s->creadr, 0, 32,
1463                                   (value & ~R_GITS_CREADR_STALLED_MASK));
1464         } else {
1465             /* RO register, ignore the write */
1466             qemu_log_mask(LOG_GUEST_ERROR,
1467                           "%s: invalid guest write to RO register at offset "
1468                           TARGET_FMT_plx "\n", __func__, offset);
1469         }
1470         break;
1471     case GITS_CREADR + 4:
1472         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
1473             s->creadr = deposit64(s->creadr, 32, 32, value);
1474         } else {
1475             /* RO register, ignore the write */
1476             qemu_log_mask(LOG_GUEST_ERROR,
1477                           "%s: invalid guest write to RO register at offset "
1478                           TARGET_FMT_plx "\n", __func__, offset);
1479         }
1480         break;
1481     case GITS_BASER ... GITS_BASER + 0x3f:
1482         /*
1483          * IMPDEF choice:- GITS_BASERn register becomes RO if ITS is
1484          *                 already enabled
1485          */
1486         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
1487             index = (offset - GITS_BASER) / 8;
1488 
1489             if (s->baser[index] == 0) {
1490                 /* Unimplemented GITS_BASERn: RAZ/WI */
1491                 break;
1492             }
1493             if (offset & 7) {
1494                 value <<= 32;
1495                 value &= ~GITS_BASER_RO_MASK;
1496                 s->baser[index] &= GITS_BASER_RO_MASK | MAKE_64BIT_MASK(0, 32);
1497                 s->baser[index] |= value;
1498             } else {
1499                 value &= ~GITS_BASER_RO_MASK;
1500                 s->baser[index] &= GITS_BASER_RO_MASK | MAKE_64BIT_MASK(32, 32);
1501                 s->baser[index] |= value;
1502             }
1503         }
1504         break;
1505     case GITS_IIDR:
1506     case GITS_IDREGS ... GITS_IDREGS + 0x2f:
1507         /* RO registers, ignore the write */
1508         qemu_log_mask(LOG_GUEST_ERROR,
1509                       "%s: invalid guest write to RO register at offset "
1510                       TARGET_FMT_plx "\n", __func__, offset);
1511         break;
1512     default:
1513         result = false;
1514         break;
1515     }
1516     return result;
1517 }
1518 
1519 static bool its_readl(GICv3ITSState *s, hwaddr offset,
1520                              uint64_t *data, MemTxAttrs attrs)
1521 {
1522     bool result = true;
1523     int index;
1524 
1525     switch (offset) {
1526     case GITS_CTLR:
1527         *data = s->ctlr;
1528         break;
1529     case GITS_IIDR:
1530         *data = gicv3_iidr();
1531         break;
1532     case GITS_IDREGS ... GITS_IDREGS + 0x2f:
1533         /* ID registers */
1534         *data = gicv3_idreg(offset - GITS_IDREGS, GICV3_PIDR0_ITS);
1535         break;
1536     case GITS_TYPER:
1537         *data = extract64(s->typer, 0, 32);
1538         break;
1539     case GITS_TYPER + 4:
1540         *data = extract64(s->typer, 32, 32);
1541         break;
1542     case GITS_CBASER:
1543         *data = extract64(s->cbaser, 0, 32);
1544         break;
1545     case GITS_CBASER + 4:
1546         *data = extract64(s->cbaser, 32, 32);
1547         break;
1548     case GITS_CREADR:
1549         *data = extract64(s->creadr, 0, 32);
1550         break;
1551     case GITS_CREADR + 4:
1552         *data = extract64(s->creadr, 32, 32);
1553         break;
1554     case GITS_CWRITER:
1555         *data = extract64(s->cwriter, 0, 32);
1556         break;
1557     case GITS_CWRITER + 4:
1558         *data = extract64(s->cwriter, 32, 32);
1559         break;
1560     case GITS_BASER ... GITS_BASER + 0x3f:
1561         index = (offset - GITS_BASER) / 8;
1562         if (offset & 7) {
1563             *data = extract64(s->baser[index], 32, 32);
1564         } else {
1565             *data = extract64(s->baser[index], 0, 32);
1566         }
1567         break;
1568     default:
1569         result = false;
1570         break;
1571     }
1572     return result;
1573 }
1574 
1575 static bool its_writell(GICv3ITSState *s, hwaddr offset,
1576                                uint64_t value, MemTxAttrs attrs)
1577 {
1578     bool result = true;
1579     int index;
1580 
1581     switch (offset) {
1582     case GITS_BASER ... GITS_BASER + 0x3f:
1583         /*
1584          * IMPDEF choice:- GITS_BASERn register becomes RO if ITS is
1585          *                 already enabled
1586          */
1587         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
1588             index = (offset - GITS_BASER) / 8;
1589             if (s->baser[index] == 0) {
1590                 /* Unimplemented GITS_BASERn: RAZ/WI */
1591                 break;
1592             }
1593             s->baser[index] &= GITS_BASER_RO_MASK;
1594             s->baser[index] |= (value & ~GITS_BASER_RO_MASK);
1595         }
1596         break;
1597     case GITS_CBASER:
1598         /*
1599          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
1600          *                 already enabled
1601          */
1602         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
1603             s->cbaser = value;
1604             s->creadr = 0;
1605         }
1606         break;
1607     case GITS_CWRITER:
1608         s->cwriter = value & ~R_GITS_CWRITER_RETRY_MASK;
1609         if (s->cwriter != s->creadr) {
1610             process_cmdq(s);
1611         }
1612         break;
1613     case GITS_CREADR:
1614         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
1615             s->creadr = value & ~R_GITS_CREADR_STALLED_MASK;
1616         } else {
1617             /* RO register, ignore the write */
1618             qemu_log_mask(LOG_GUEST_ERROR,
1619                           "%s: invalid guest write to RO register at offset "
1620                           TARGET_FMT_plx "\n", __func__, offset);
1621         }
1622         break;
1623     case GITS_TYPER:
1624         /* RO registers, ignore the write */
1625         qemu_log_mask(LOG_GUEST_ERROR,
1626                       "%s: invalid guest write to RO register at offset "
1627                       TARGET_FMT_plx "\n", __func__, offset);
1628         break;
1629     default:
1630         result = false;
1631         break;
1632     }
1633     return result;
1634 }
1635 
1636 static bool its_readll(GICv3ITSState *s, hwaddr offset,
1637                               uint64_t *data, MemTxAttrs attrs)
1638 {
1639     bool result = true;
1640     int index;
1641 
1642     switch (offset) {
1643     case GITS_TYPER:
1644         *data = s->typer;
1645         break;
1646     case GITS_BASER ... GITS_BASER + 0x3f:
1647         index = (offset - GITS_BASER) / 8;
1648         *data = s->baser[index];
1649         break;
1650     case GITS_CBASER:
1651         *data = s->cbaser;
1652         break;
1653     case GITS_CREADR:
1654         *data = s->creadr;
1655         break;
1656     case GITS_CWRITER:
1657         *data = s->cwriter;
1658         break;
1659     default:
1660         result = false;
1661         break;
1662     }
1663     return result;
1664 }
1665 
1666 static MemTxResult gicv3_its_read(void *opaque, hwaddr offset, uint64_t *data,
1667                                   unsigned size, MemTxAttrs attrs)
1668 {
1669     GICv3ITSState *s = (GICv3ITSState *)opaque;
1670     bool result;
1671 
1672     switch (size) {
1673     case 4:
1674         result = its_readl(s, offset, data, attrs);
1675         break;
1676     case 8:
1677         result = its_readll(s, offset, data, attrs);
1678         break;
1679     default:
1680         result = false;
1681         break;
1682     }
1683 
1684     if (!result) {
1685         qemu_log_mask(LOG_GUEST_ERROR,
1686                       "%s: invalid guest read at offset " TARGET_FMT_plx
1687                       " size %u\n", __func__, offset, size);
1688         trace_gicv3_its_badread(offset, size);
1689         /*
1690          * The spec requires that reserved registers are RAZ/WI;
1691          * so use false returns from leaf functions as a way to
1692          * trigger the guest-error logging but don't return it to
1693          * the caller, or we'll cause a spurious guest data abort.
1694          */
1695         *data = 0;
1696     } else {
1697         trace_gicv3_its_read(offset, *data, size);
1698     }
1699     return MEMTX_OK;
1700 }
1701 
1702 static MemTxResult gicv3_its_write(void *opaque, hwaddr offset, uint64_t data,
1703                                    unsigned size, MemTxAttrs attrs)
1704 {
1705     GICv3ITSState *s = (GICv3ITSState *)opaque;
1706     bool result;
1707 
1708     switch (size) {
1709     case 4:
1710         result = its_writel(s, offset, data, attrs);
1711         break;
1712     case 8:
1713         result = its_writell(s, offset, data, attrs);
1714         break;
1715     default:
1716         result = false;
1717         break;
1718     }
1719 
1720     if (!result) {
1721         qemu_log_mask(LOG_GUEST_ERROR,
1722                       "%s: invalid guest write at offset " TARGET_FMT_plx
1723                       " size %u\n", __func__, offset, size);
1724         trace_gicv3_its_badwrite(offset, data, size);
1725         /*
1726          * The spec requires that reserved registers are RAZ/WI;
1727          * so use false returns from leaf functions as a way to
1728          * trigger the guest-error logging but don't return it to
1729          * the caller, or we'll cause a spurious guest data abort.
1730          */
1731     } else {
1732         trace_gicv3_its_write(offset, data, size);
1733     }
1734     return MEMTX_OK;
1735 }
1736 
1737 static const MemoryRegionOps gicv3_its_control_ops = {
1738     .read_with_attrs = gicv3_its_read,
1739     .write_with_attrs = gicv3_its_write,
1740     .valid.min_access_size = 4,
1741     .valid.max_access_size = 8,
1742     .impl.min_access_size = 4,
1743     .impl.max_access_size = 8,
1744     .endianness = DEVICE_NATIVE_ENDIAN,
1745 };
1746 
1747 static const MemoryRegionOps gicv3_its_translation_ops = {
1748     .read_with_attrs = gicv3_its_translation_read,
1749     .write_with_attrs = gicv3_its_translation_write,
1750     .valid.min_access_size = 2,
1751     .valid.max_access_size = 4,
1752     .impl.min_access_size = 2,
1753     .impl.max_access_size = 4,
1754     .endianness = DEVICE_NATIVE_ENDIAN,
1755 };
1756 
1757 static void gicv3_arm_its_realize(DeviceState *dev, Error **errp)
1758 {
1759     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
1760     int i;
1761 
1762     for (i = 0; i < s->gicv3->num_cpu; i++) {
1763         if (!(s->gicv3->cpu[i].gicr_typer & GICR_TYPER_PLPIS)) {
1764             error_setg(errp, "Physical LPI not supported by CPU %d", i);
1765             return;
1766         }
1767     }
1768 
1769     gicv3_add_its(s->gicv3, dev);
1770 
1771     gicv3_its_init_mmio(s, &gicv3_its_control_ops, &gicv3_its_translation_ops);
1772 
1773     /* set the ITS default features supported */
1774     s->typer = FIELD_DP64(s->typer, GITS_TYPER, PHYSICAL, 1);
1775     s->typer = FIELD_DP64(s->typer, GITS_TYPER, ITT_ENTRY_SIZE,
1776                           ITS_ITT_ENTRY_SIZE - 1);
1777     s->typer = FIELD_DP64(s->typer, GITS_TYPER, IDBITS, ITS_IDBITS);
1778     s->typer = FIELD_DP64(s->typer, GITS_TYPER, DEVBITS, ITS_DEVBITS);
1779     s->typer = FIELD_DP64(s->typer, GITS_TYPER, CIL, 1);
1780     s->typer = FIELD_DP64(s->typer, GITS_TYPER, CIDBITS, ITS_CIDBITS);
1781 }
1782 
1783 static void gicv3_its_reset(DeviceState *dev)
1784 {
1785     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
1786     GICv3ITSClass *c = ARM_GICV3_ITS_GET_CLASS(s);
1787 
1788     c->parent_reset(dev);
1789 
1790     /* Quiescent bit reset to 1 */
1791     s->ctlr = FIELD_DP32(s->ctlr, GITS_CTLR, QUIESCENT, 1);
1792 
1793     /*
1794      * setting GITS_BASER0.Type = 0b001 (Device)
1795      *         GITS_BASER1.Type = 0b100 (Collection Table)
1796      *         GITS_BASER2.Type = 0b010 (vPE) for GICv4 and later
1797      *         GITS_BASER<n>.Type,where n = 3 to 7 are 0b00 (Unimplemented)
1798      *         GITS_BASER<0,1>.Page_Size = 64KB
1799      * and default translation table entry size to 16 bytes
1800      */
1801     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, TYPE,
1802                              GITS_BASER_TYPE_DEVICE);
1803     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, PAGESIZE,
1804                              GITS_BASER_PAGESIZE_64K);
1805     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, ENTRYSIZE,
1806                              GITS_DTE_SIZE - 1);
1807 
1808     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, TYPE,
1809                              GITS_BASER_TYPE_COLLECTION);
1810     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, PAGESIZE,
1811                              GITS_BASER_PAGESIZE_64K);
1812     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, ENTRYSIZE,
1813                              GITS_CTE_SIZE - 1);
1814 
1815     if (its_feature_virtual(s)) {
1816         s->baser[2] = FIELD_DP64(s->baser[2], GITS_BASER, TYPE,
1817                                  GITS_BASER_TYPE_VPE);
1818         s->baser[2] = FIELD_DP64(s->baser[2], GITS_BASER, PAGESIZE,
1819                                  GITS_BASER_PAGESIZE_64K);
1820         s->baser[2] = FIELD_DP64(s->baser[2], GITS_BASER, ENTRYSIZE,
1821                                  GITS_VPE_SIZE - 1);
1822     }
1823 }
1824 
1825 static void gicv3_its_post_load(GICv3ITSState *s)
1826 {
1827     if (s->ctlr & R_GITS_CTLR_ENABLED_MASK) {
1828         extract_table_params(s);
1829         extract_cmdq_params(s);
1830     }
1831 }
1832 
1833 static Property gicv3_its_props[] = {
1834     DEFINE_PROP_LINK("parent-gicv3", GICv3ITSState, gicv3, "arm-gicv3",
1835                      GICv3State *),
1836     DEFINE_PROP_END_OF_LIST(),
1837 };
1838 
1839 static void gicv3_its_class_init(ObjectClass *klass, void *data)
1840 {
1841     DeviceClass *dc = DEVICE_CLASS(klass);
1842     GICv3ITSClass *ic = ARM_GICV3_ITS_CLASS(klass);
1843     GICv3ITSCommonClass *icc = ARM_GICV3_ITS_COMMON_CLASS(klass);
1844 
1845     dc->realize = gicv3_arm_its_realize;
1846     device_class_set_props(dc, gicv3_its_props);
1847     device_class_set_parent_reset(dc, gicv3_its_reset, &ic->parent_reset);
1848     icc->post_load = gicv3_its_post_load;
1849 }
1850 
1851 static const TypeInfo gicv3_its_info = {
1852     .name = TYPE_ARM_GICV3_ITS,
1853     .parent = TYPE_ARM_GICV3_ITS_COMMON,
1854     .instance_size = sizeof(GICv3ITSState),
1855     .class_init = gicv3_its_class_init,
1856     .class_size = sizeof(GICv3ITSClass),
1857 };
1858 
1859 static void gicv3_its_register_types(void)
1860 {
1861     type_register_static(&gicv3_its_info);
1862 }
1863 
1864 type_init(gicv3_its_register_types)
1865