xref: /qemu/hw/intc/arm_gicv3_its.c (revision c7ca3ad5e756e263daf082c315e311593ccec3d1)
118f6290aSShashi Mallela /*
218f6290aSShashi Mallela  * ITS emulation for a GICv3-based system
318f6290aSShashi Mallela  *
418f6290aSShashi Mallela  * Copyright Linaro.org 2021
518f6290aSShashi Mallela  *
618f6290aSShashi Mallela  * Authors:
718f6290aSShashi Mallela  *  Shashi Mallela <shashi.mallela@linaro.org>
818f6290aSShashi Mallela  *
918f6290aSShashi Mallela  * This work is licensed under the terms of the GNU GPL, version 2 or (at your
1018f6290aSShashi Mallela  * option) any later version.  See the COPYING file in the top-level directory.
1118f6290aSShashi Mallela  *
1218f6290aSShashi Mallela  */
1318f6290aSShashi Mallela 
1418f6290aSShashi Mallela #include "qemu/osdep.h"
1518f6290aSShashi Mallela #include "qemu/log.h"
16195209d3SPeter Maydell #include "trace.h"
1718f6290aSShashi Mallela #include "hw/qdev-properties.h"
1818f6290aSShashi Mallela #include "hw/intc/arm_gicv3_its_common.h"
1918f6290aSShashi Mallela #include "gicv3_internal.h"
2018f6290aSShashi Mallela #include "qom/object.h"
2118f6290aSShashi Mallela #include "qapi/error.h"
2218f6290aSShashi Mallela 
2318f6290aSShashi Mallela typedef struct GICv3ITSClass GICv3ITSClass;
2418f6290aSShashi Mallela /* This is reusing the GICv3ITSState typedef from ARM_GICV3_ITS_COMMON */
2518f6290aSShashi Mallela DECLARE_OBJ_CHECKERS(GICv3ITSState, GICv3ITSClass,
2618f6290aSShashi Mallela                      ARM_GICV3_ITS, TYPE_ARM_GICV3_ITS)
2718f6290aSShashi Mallela 
2818f6290aSShashi Mallela struct GICv3ITSClass {
2918f6290aSShashi Mallela     GICv3ITSCommonClass parent_class;
3018f6290aSShashi Mallela     void (*parent_reset)(DeviceState *dev);
3118f6290aSShashi Mallela };
3218f6290aSShashi Mallela 
33c694cb4cSShashi Mallela /*
34c694cb4cSShashi Mallela  * This is an internal enum used to distinguish between LPI triggered
35c694cb4cSShashi Mallela  * via command queue and LPI triggered via gits_translater write.
36c694cb4cSShashi Mallela  */
37c694cb4cSShashi Mallela typedef enum ItsCmdType {
38c694cb4cSShashi Mallela     NONE = 0, /* internal indication for GITS_TRANSLATER write */
39c694cb4cSShashi Mallela     CLEAR = 1,
40c694cb4cSShashi Mallela     DISCARD = 2,
41c694cb4cSShashi Mallela     INTERRUPT = 3,
42c694cb4cSShashi Mallela } ItsCmdType;
43c694cb4cSShashi Mallela 
444acf93e1SPeter Maydell typedef struct DTEntry {
454acf93e1SPeter Maydell     bool valid;
464acf93e1SPeter Maydell     unsigned size;
474acf93e1SPeter Maydell     uint64_t ittaddr;
484acf93e1SPeter Maydell } DTEntry;
494acf93e1SPeter Maydell 
50d37cf49bSPeter Maydell typedef struct CTEntry {
51d37cf49bSPeter Maydell     bool valid;
52d37cf49bSPeter Maydell     uint32_t rdbase;
53d37cf49bSPeter Maydell } CTEntry;
54d37cf49bSPeter Maydell 
55244194feSPeter Maydell typedef struct ITEntry {
56244194feSPeter Maydell     bool valid;
57244194feSPeter Maydell     int inttype;
58244194feSPeter Maydell     uint32_t intid;
59244194feSPeter Maydell     uint32_t doorbell;
60244194feSPeter Maydell     uint32_t icid;
61244194feSPeter Maydell     uint32_t vpeid;
62244194feSPeter Maydell } ITEntry;
63244194feSPeter Maydell 
64244194feSPeter Maydell 
65ef011555SPeter Maydell /*
66ef011555SPeter Maydell  * The ITS spec permits a range of CONSTRAINED UNPREDICTABLE options
67ef011555SPeter Maydell  * if a command parameter is not correct. These include both "stall
68ef011555SPeter Maydell  * processing of the command queue" and "ignore this command, and
69ef011555SPeter Maydell  * keep processing the queue". In our implementation we choose that
70ef011555SPeter Maydell  * memory transaction errors reading the command packet provoke a
71ef011555SPeter Maydell  * stall, but errors in parameters cause us to ignore the command
72ef011555SPeter Maydell  * and continue processing.
73ef011555SPeter Maydell  * The process_* functions which handle individual ITS commands all
74ef011555SPeter Maydell  * return an ItsCmdResult which tells process_cmdq() whether it should
75ef011555SPeter Maydell  * stall or keep going.
76ef011555SPeter Maydell  */
77ef011555SPeter Maydell typedef enum ItsCmdResult {
78ef011555SPeter Maydell     CMD_STALL = 0,
79ef011555SPeter Maydell     CMD_CONTINUE = 1,
80ef011555SPeter Maydell } ItsCmdResult;
81ef011555SPeter Maydell 
821b08e436SShashi Mallela static uint64_t baser_base_addr(uint64_t value, uint32_t page_sz)
831b08e436SShashi Mallela {
841b08e436SShashi Mallela     uint64_t result = 0;
851b08e436SShashi Mallela 
861b08e436SShashi Mallela     switch (page_sz) {
871b08e436SShashi Mallela     case GITS_PAGE_SIZE_4K:
881b08e436SShashi Mallela     case GITS_PAGE_SIZE_16K:
891b08e436SShashi Mallela         result = FIELD_EX64(value, GITS_BASER, PHYADDR) << 12;
901b08e436SShashi Mallela         break;
911b08e436SShashi Mallela 
921b08e436SShashi Mallela     case GITS_PAGE_SIZE_64K:
931b08e436SShashi Mallela         result = FIELD_EX64(value, GITS_BASER, PHYADDRL_64K) << 16;
941b08e436SShashi Mallela         result |= FIELD_EX64(value, GITS_BASER, PHYADDRH_64K) << 48;
951b08e436SShashi Mallela         break;
961b08e436SShashi Mallela 
971b08e436SShashi Mallela     default:
981b08e436SShashi Mallela         break;
991b08e436SShashi Mallela     }
1001b08e436SShashi Mallela     return result;
1011b08e436SShashi Mallela }
1021b08e436SShashi Mallela 
103d050f80fSPeter Maydell static uint64_t table_entry_addr(GICv3ITSState *s, TableDesc *td,
104d050f80fSPeter Maydell                                  uint32_t idx, MemTxResult *res)
105d050f80fSPeter Maydell {
106d050f80fSPeter Maydell     /*
107d050f80fSPeter Maydell      * Given a TableDesc describing one of the ITS in-guest-memory
108d050f80fSPeter Maydell      * tables and an index into it, return the guest address
109d050f80fSPeter Maydell      * corresponding to that table entry.
110d050f80fSPeter Maydell      * If there was a memory error reading the L1 table of an
111d050f80fSPeter Maydell      * indirect table, *res is set accordingly, and we return -1.
112d050f80fSPeter Maydell      * If the L1 table entry is marked not valid, we return -1 with
113d050f80fSPeter Maydell      * *res set to MEMTX_OK.
114d050f80fSPeter Maydell      *
115d050f80fSPeter Maydell      * The specification defines the format of level 1 entries of a
116d050f80fSPeter Maydell      * 2-level table, but the format of level 2 entries and the format
117d050f80fSPeter Maydell      * of flat-mapped tables is IMPDEF.
118d050f80fSPeter Maydell      */
119d050f80fSPeter Maydell     AddressSpace *as = &s->gicv3->dma_as;
120d050f80fSPeter Maydell     uint32_t l2idx;
121d050f80fSPeter Maydell     uint64_t l2;
122d050f80fSPeter Maydell     uint32_t num_l2_entries;
123d050f80fSPeter Maydell 
124d050f80fSPeter Maydell     *res = MEMTX_OK;
125d050f80fSPeter Maydell 
126d050f80fSPeter Maydell     if (!td->indirect) {
127d050f80fSPeter Maydell         /* Single level table */
128d050f80fSPeter Maydell         return td->base_addr + idx * td->entry_sz;
129d050f80fSPeter Maydell     }
130d050f80fSPeter Maydell 
131d050f80fSPeter Maydell     /* Two level table */
132d050f80fSPeter Maydell     l2idx = idx / (td->page_sz / L1TABLE_ENTRY_SIZE);
133d050f80fSPeter Maydell 
134d050f80fSPeter Maydell     l2 = address_space_ldq_le(as,
135d050f80fSPeter Maydell                               td->base_addr + (l2idx * L1TABLE_ENTRY_SIZE),
136d050f80fSPeter Maydell                               MEMTXATTRS_UNSPECIFIED, res);
137d050f80fSPeter Maydell     if (*res != MEMTX_OK) {
138d050f80fSPeter Maydell         return -1;
139d050f80fSPeter Maydell     }
140d050f80fSPeter Maydell     if (!(l2 & L2_TABLE_VALID_MASK)) {
141d050f80fSPeter Maydell         return -1;
142d050f80fSPeter Maydell     }
143d050f80fSPeter Maydell 
144d050f80fSPeter Maydell     num_l2_entries = td->page_sz / td->entry_sz;
145d050f80fSPeter Maydell     return (l2 & ((1ULL << 51) - 1)) + (idx % num_l2_entries) * td->entry_sz;
146d050f80fSPeter Maydell }
147d050f80fSPeter Maydell 
148d37cf49bSPeter Maydell /*
149d37cf49bSPeter Maydell  * Read the Collection Table entry at index @icid. On success (including
150d37cf49bSPeter Maydell  * successfully determining that there is no valid CTE for this index),
151d37cf49bSPeter Maydell  * we return MEMTX_OK and populate the CTEntry struct @cte accordingly.
152d37cf49bSPeter Maydell  * If there is an error reading memory then we return the error code.
153d37cf49bSPeter Maydell  */
154d37cf49bSPeter Maydell static MemTxResult get_cte(GICv3ITSState *s, uint16_t icid, CTEntry *cte)
155c694cb4cSShashi Mallela {
156c694cb4cSShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
157d37cf49bSPeter Maydell     MemTxResult res = MEMTX_OK;
158d37cf49bSPeter Maydell     uint64_t entry_addr = table_entry_addr(s, &s->ct, icid, &res);
159d37cf49bSPeter Maydell     uint64_t cteval;
160c694cb4cSShashi Mallela 
161d050f80fSPeter Maydell     if (entry_addr == -1) {
162d37cf49bSPeter Maydell         /* No L2 table entry, i.e. no valid CTE, or a memory error */
163d37cf49bSPeter Maydell         cte->valid = false;
164930f40e9SPeter Maydell         goto out;
165c694cb4cSShashi Mallela     }
166c694cb4cSShashi Mallela 
167d37cf49bSPeter Maydell     cteval = address_space_ldq_le(as, entry_addr, MEMTXATTRS_UNSPECIFIED, &res);
168d37cf49bSPeter Maydell     if (res != MEMTX_OK) {
169930f40e9SPeter Maydell         goto out;
170d37cf49bSPeter Maydell     }
171d37cf49bSPeter Maydell     cte->valid = FIELD_EX64(cteval, CTE, VALID);
172d37cf49bSPeter Maydell     cte->rdbase = FIELD_EX64(cteval, CTE, RDBASE);
173930f40e9SPeter Maydell out:
174930f40e9SPeter Maydell     if (res != MEMTX_OK) {
175930f40e9SPeter Maydell         trace_gicv3_its_cte_read_fault(icid);
176930f40e9SPeter Maydell     } else {
177930f40e9SPeter Maydell         trace_gicv3_its_cte_read(icid, cte->valid, cte->rdbase);
178930f40e9SPeter Maydell     }
179930f40e9SPeter Maydell     return res;
180c694cb4cSShashi Mallela }
181c694cb4cSShashi Mallela 
1827eb54267SPeter Maydell /*
1837eb54267SPeter Maydell  * Update the Interrupt Table entry at index @evinted in the table specified
1847eb54267SPeter Maydell  * by the dte @dte. Returns true on success, false if there was a memory
1857eb54267SPeter Maydell  * access error.
1867eb54267SPeter Maydell  */
1874acf93e1SPeter Maydell static bool update_ite(GICv3ITSState *s, uint32_t eventid, const DTEntry *dte,
1887eb54267SPeter Maydell                        const ITEntry *ite)
189c694cb4cSShashi Mallela {
190c694cb4cSShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
191c694cb4cSShashi Mallela     MemTxResult res = MEMTX_OK;
192a1ce993dSPeter Maydell     hwaddr iteaddr = dte->ittaddr + eventid * ITS_ITT_ENTRY_SIZE;
1937eb54267SPeter Maydell     uint64_t itel = 0;
1947eb54267SPeter Maydell     uint32_t iteh = 0;
195c694cb4cSShashi Mallela 
196930f40e9SPeter Maydell     trace_gicv3_its_ite_write(dte->ittaddr, eventid, ite->valid,
197930f40e9SPeter Maydell                               ite->inttype, ite->intid, ite->icid,
198930f40e9SPeter Maydell                               ite->vpeid, ite->doorbell);
199930f40e9SPeter Maydell 
2007eb54267SPeter Maydell     if (ite->valid) {
2017eb54267SPeter Maydell         itel = FIELD_DP64(itel, ITE_L, VALID, 1);
2027eb54267SPeter Maydell         itel = FIELD_DP64(itel, ITE_L, INTTYPE, ite->inttype);
2037eb54267SPeter Maydell         itel = FIELD_DP64(itel, ITE_L, INTID, ite->intid);
2047eb54267SPeter Maydell         itel = FIELD_DP64(itel, ITE_L, ICID, ite->icid);
2057eb54267SPeter Maydell         itel = FIELD_DP64(itel, ITE_L, VPEID, ite->vpeid);
2067eb54267SPeter Maydell         iteh = FIELD_DP32(iteh, ITE_H, DOORBELL, ite->doorbell);
207c694cb4cSShashi Mallela     }
2087eb54267SPeter Maydell 
2097eb54267SPeter Maydell     address_space_stq_le(as, iteaddr, itel, MEMTXATTRS_UNSPECIFIED, &res);
210c694cb4cSShashi Mallela     if (res != MEMTX_OK) {
211c694cb4cSShashi Mallela         return false;
212c694cb4cSShashi Mallela     }
2137eb54267SPeter Maydell     address_space_stl_le(as, iteaddr + 8, iteh, MEMTXATTRS_UNSPECIFIED, &res);
2147eb54267SPeter Maydell     return res == MEMTX_OK;
215c694cb4cSShashi Mallela }
216c694cb4cSShashi Mallela 
217244194feSPeter Maydell /*
218244194feSPeter Maydell  * Read the Interrupt Table entry at index @eventid from the table specified
219244194feSPeter Maydell  * by the DTE @dte. On success, we return MEMTX_OK and populate the ITEntry
220244194feSPeter Maydell  * struct @ite accordingly. If there is an error reading memory then we return
221244194feSPeter Maydell  * the error code.
222244194feSPeter Maydell  */
223244194feSPeter Maydell static MemTxResult get_ite(GICv3ITSState *s, uint32_t eventid,
224244194feSPeter Maydell                            const DTEntry *dte, ITEntry *ite)
225c694cb4cSShashi Mallela {
226c694cb4cSShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
227244194feSPeter Maydell     MemTxResult res = MEMTX_OK;
228244194feSPeter Maydell     uint64_t itel;
229244194feSPeter Maydell     uint32_t iteh;
230a1ce993dSPeter Maydell     hwaddr iteaddr = dte->ittaddr + eventid * ITS_ITT_ENTRY_SIZE;
231c694cb4cSShashi Mallela 
232244194feSPeter Maydell     itel = address_space_ldq_le(as, iteaddr, MEMTXATTRS_UNSPECIFIED, &res);
233244194feSPeter Maydell     if (res != MEMTX_OK) {
234930f40e9SPeter Maydell         trace_gicv3_its_ite_read_fault(dte->ittaddr, eventid);
235244194feSPeter Maydell         return res;
2362954b93fSPeter Maydell     }
237c694cb4cSShashi Mallela 
238244194feSPeter Maydell     iteh = address_space_ldl_le(as, iteaddr + 8, MEMTXATTRS_UNSPECIFIED, &res);
239244194feSPeter Maydell     if (res != MEMTX_OK) {
240930f40e9SPeter Maydell         trace_gicv3_its_ite_read_fault(dte->ittaddr, eventid);
241244194feSPeter Maydell         return res;
2422954b93fSPeter Maydell     }
243c694cb4cSShashi Mallela 
244244194feSPeter Maydell     ite->valid = FIELD_EX64(itel, ITE_L, VALID);
245244194feSPeter Maydell     ite->inttype = FIELD_EX64(itel, ITE_L, INTTYPE);
246244194feSPeter Maydell     ite->intid = FIELD_EX64(itel, ITE_L, INTID);
247244194feSPeter Maydell     ite->icid = FIELD_EX64(itel, ITE_L, ICID);
248244194feSPeter Maydell     ite->vpeid = FIELD_EX64(itel, ITE_L, VPEID);
249244194feSPeter Maydell     ite->doorbell = FIELD_EX64(iteh, ITE_H, DOORBELL);
250930f40e9SPeter Maydell     trace_gicv3_its_ite_read(dte->ittaddr, eventid, ite->valid,
251930f40e9SPeter Maydell                              ite->inttype, ite->intid, ite->icid,
252930f40e9SPeter Maydell                              ite->vpeid, ite->doorbell);
253244194feSPeter Maydell     return MEMTX_OK;
254c694cb4cSShashi Mallela }
255c694cb4cSShashi Mallela 
2564acf93e1SPeter Maydell /*
2574acf93e1SPeter Maydell  * Read the Device Table entry at index @devid. On success (including
2584acf93e1SPeter Maydell  * successfully determining that there is no valid DTE for this index),
2594acf93e1SPeter Maydell  * we return MEMTX_OK and populate the DTEntry struct accordingly.
2604acf93e1SPeter Maydell  * If there is an error reading memory then we return the error code.
2614acf93e1SPeter Maydell  */
2624acf93e1SPeter Maydell static MemTxResult get_dte(GICv3ITSState *s, uint32_t devid, DTEntry *dte)
263c694cb4cSShashi Mallela {
2644acf93e1SPeter Maydell     MemTxResult res = MEMTX_OK;
265c694cb4cSShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
2664acf93e1SPeter Maydell     uint64_t entry_addr = table_entry_addr(s, &s->dt, devid, &res);
2674acf93e1SPeter Maydell     uint64_t dteval;
268c694cb4cSShashi Mallela 
269d050f80fSPeter Maydell     if (entry_addr == -1) {
2704acf93e1SPeter Maydell         /* No L2 table entry, i.e. no valid DTE, or a memory error */
2714acf93e1SPeter Maydell         dte->valid = false;
272930f40e9SPeter Maydell         goto out;
273c694cb4cSShashi Mallela     }
2744acf93e1SPeter Maydell     dteval = address_space_ldq_le(as, entry_addr, MEMTXATTRS_UNSPECIFIED, &res);
2754acf93e1SPeter Maydell     if (res != MEMTX_OK) {
276930f40e9SPeter Maydell         goto out;
2774acf93e1SPeter Maydell     }
2784acf93e1SPeter Maydell     dte->valid = FIELD_EX64(dteval, DTE, VALID);
2794acf93e1SPeter Maydell     dte->size = FIELD_EX64(dteval, DTE, SIZE);
2804acf93e1SPeter Maydell     /* DTE word field stores bits [51:8] of the ITT address */
2814acf93e1SPeter Maydell     dte->ittaddr = FIELD_EX64(dteval, DTE, ITTADDR) << ITTADDR_SHIFT;
282930f40e9SPeter Maydell out:
283930f40e9SPeter Maydell     if (res != MEMTX_OK) {
284930f40e9SPeter Maydell         trace_gicv3_its_dte_read_fault(devid);
285930f40e9SPeter Maydell     } else {
286930f40e9SPeter Maydell         trace_gicv3_its_dte_read(devid, dte->valid, dte->size, dte->ittaddr);
287930f40e9SPeter Maydell     }
288930f40e9SPeter Maydell     return res;
289c694cb4cSShashi Mallela }
290c694cb4cSShashi Mallela 
291c694cb4cSShashi Mallela /*
292c694cb4cSShashi Mallela  * This function handles the processing of following commands based on
293c694cb4cSShashi Mallela  * the ItsCmdType parameter passed:-
294c694cb4cSShashi Mallela  * 1. triggering of lpi interrupt translation via ITS INT command
295c694cb4cSShashi Mallela  * 2. triggering of lpi interrupt translation via gits_translater register
296c694cb4cSShashi Mallela  * 3. handling of ITS CLEAR command
297c694cb4cSShashi Mallela  * 4. handling of ITS DISCARD command
298c694cb4cSShashi Mallela  */
299b6f96009SPeter Maydell static ItsCmdResult do_process_its_cmd(GICv3ITSState *s, uint32_t devid,
300b6f96009SPeter Maydell                                        uint32_t eventid, ItsCmdType cmd)
301c694cb4cSShashi Mallela {
3028f809f69SPeter Maydell     uint64_t num_eventids;
3034acf93e1SPeter Maydell     DTEntry dte;
304d37cf49bSPeter Maydell     CTEntry cte;
305244194feSPeter Maydell     ITEntry ite;
306c694cb4cSShashi Mallela 
3078b8bb014SPeter Maydell     if (devid >= s->dt.num_entries) {
308b13148d9SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
309b13148d9SPeter Maydell                       "%s: invalid command attributes: devid %d>=%d",
3108b8bb014SPeter Maydell                       __func__, devid, s->dt.num_entries);
311b13148d9SPeter Maydell         return CMD_CONTINUE;
312b13148d9SPeter Maydell     }
313b13148d9SPeter Maydell 
3144acf93e1SPeter Maydell     if (get_dte(s, devid, &dte) != MEMTX_OK) {
315593a7cc2SPeter Maydell         return CMD_STALL;
316c694cb4cSShashi Mallela     }
3174acf93e1SPeter Maydell     if (!dte.valid) {
318229c57b1SAlex Bennée         qemu_log_mask(LOG_GUEST_ERROR,
319229c57b1SAlex Bennée                       "%s: invalid command attributes: "
3204acf93e1SPeter Maydell                       "invalid dte for %d\n", __func__, devid);
321593a7cc2SPeter Maydell         return CMD_CONTINUE;
322c694cb4cSShashi Mallela     }
323c694cb4cSShashi Mallela 
3244acf93e1SPeter Maydell     num_eventids = 1ULL << (dte.size + 1);
325b13148d9SPeter Maydell     if (eventid >= num_eventids) {
326b13148d9SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
327b13148d9SPeter Maydell                       "%s: invalid command attributes: eventid %d >= %"
328b13148d9SPeter Maydell                       PRId64 "\n",
329b13148d9SPeter Maydell                       __func__, eventid, num_eventids);
330b13148d9SPeter Maydell         return CMD_CONTINUE;
331b13148d9SPeter Maydell     }
332b13148d9SPeter Maydell 
333244194feSPeter Maydell     if (get_ite(s, eventid, &dte, &ite) != MEMTX_OK) {
334be0ed8fbSPeter Maydell         return CMD_STALL;
335be0ed8fbSPeter Maydell     }
336be0ed8fbSPeter Maydell 
337244194feSPeter Maydell     if (!ite.valid || ite.inttype != ITE_INTTYPE_PHYSICAL) {
338be0ed8fbSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
339be0ed8fbSPeter Maydell                       "%s: invalid command attributes: invalid ITE\n",
340be0ed8fbSPeter Maydell                       __func__);
341be0ed8fbSPeter Maydell         return CMD_CONTINUE;
342be0ed8fbSPeter Maydell     }
343be0ed8fbSPeter Maydell 
344244194feSPeter Maydell     if (ite.icid >= s->ct.num_entries) {
34558b88779SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
34658b88779SPeter Maydell                       "%s: invalid ICID 0x%x in ITE (table corrupted?)\n",
347244194feSPeter Maydell                       __func__, ite.icid);
34858b88779SPeter Maydell         return CMD_CONTINUE;
34958b88779SPeter Maydell     }
35058b88779SPeter Maydell 
351244194feSPeter Maydell     if (get_cte(s, ite.icid, &cte) != MEMTX_OK) {
352be0ed8fbSPeter Maydell         return CMD_STALL;
353be0ed8fbSPeter Maydell     }
354d37cf49bSPeter Maydell     if (!cte.valid) {
355be0ed8fbSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
356d37cf49bSPeter Maydell                       "%s: invalid command attributes: invalid CTE\n",
357d37cf49bSPeter Maydell                       __func__);
358be0ed8fbSPeter Maydell         return CMD_CONTINUE;
359be0ed8fbSPeter Maydell     }
360be0ed8fbSPeter Maydell 
361c694cb4cSShashi Mallela     /*
362c694cb4cSShashi Mallela      * Current implementation only supports rdbase == procnum
363c694cb4cSShashi Mallela      * Hence rdbase physical address is ignored
364c694cb4cSShashi Mallela      */
365d37cf49bSPeter Maydell     if (cte.rdbase >= s->gicv3->num_cpu) {
366593a7cc2SPeter Maydell         return CMD_CONTINUE;
36717fb5e36SShashi Mallela     }
36817fb5e36SShashi Mallela 
36917fb5e36SShashi Mallela     if ((cmd == CLEAR) || (cmd == DISCARD)) {
370244194feSPeter Maydell         gicv3_redist_process_lpi(&s->gicv3->cpu[cte.rdbase], ite.intid, 0);
37117fb5e36SShashi Mallela     } else {
372244194feSPeter Maydell         gicv3_redist_process_lpi(&s->gicv3->cpu[cte.rdbase], ite.intid, 1);
37317fb5e36SShashi Mallela     }
37417fb5e36SShashi Mallela 
375c694cb4cSShashi Mallela     if (cmd == DISCARD) {
3767eb54267SPeter Maydell         ITEntry ite = {};
377c694cb4cSShashi Mallela         /* remove mapping from interrupt translation table */
3787eb54267SPeter Maydell         ite.valid = false;
3797eb54267SPeter Maydell         return update_ite(s, eventid, &dte, &ite) ? CMD_CONTINUE : CMD_STALL;
380c694cb4cSShashi Mallela     }
381593a7cc2SPeter Maydell     return CMD_CONTINUE;
382c694cb4cSShashi Mallela }
383b6f96009SPeter Maydell static ItsCmdResult process_its_cmd(GICv3ITSState *s, const uint64_t *cmdpkt,
384b6f96009SPeter Maydell                                     ItsCmdType cmd)
385c694cb4cSShashi Mallela {
386b6f96009SPeter Maydell     uint32_t devid, eventid;
387b6f96009SPeter Maydell 
388b6f96009SPeter Maydell     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
389b6f96009SPeter Maydell     eventid = cmdpkt[1] & EVENTID_MASK;
390e4050980SPeter Maydell     switch (cmd) {
391e4050980SPeter Maydell     case INTERRUPT:
392e4050980SPeter Maydell         trace_gicv3_its_cmd_int(devid, eventid);
393e4050980SPeter Maydell         break;
394e4050980SPeter Maydell     case CLEAR:
395e4050980SPeter Maydell         trace_gicv3_its_cmd_clear(devid, eventid);
396e4050980SPeter Maydell         break;
397e4050980SPeter Maydell     case DISCARD:
398e4050980SPeter Maydell         trace_gicv3_its_cmd_discard(devid, eventid);
399e4050980SPeter Maydell         break;
400e4050980SPeter Maydell     default:
401e4050980SPeter Maydell         g_assert_not_reached();
402e4050980SPeter Maydell     }
403b6f96009SPeter Maydell     return do_process_its_cmd(s, devid, eventid, cmd);
404b6f96009SPeter Maydell }
405b6f96009SPeter Maydell 
406b6f96009SPeter Maydell static ItsCmdResult process_mapti(GICv3ITSState *s, const uint64_t *cmdpkt,
407b6f96009SPeter Maydell                                   bool ignore_pInt)
408b6f96009SPeter Maydell {
409c694cb4cSShashi Mallela     uint32_t devid, eventid;
410c694cb4cSShashi Mallela     uint32_t pIntid = 0;
4118f809f69SPeter Maydell     uint64_t num_eventids;
412905720f1SPeter Maydell     uint32_t num_intids;
413c694cb4cSShashi Mallela     uint16_t icid = 0;
4144acf93e1SPeter Maydell     DTEntry dte;
4157eb54267SPeter Maydell     ITEntry ite;
416c694cb4cSShashi Mallela 
417b6f96009SPeter Maydell     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
418b6f96009SPeter Maydell     eventid = cmdpkt[1] & EVENTID_MASK;
419e4050980SPeter Maydell     icid = cmdpkt[2] & ICID_MASK;
420c694cb4cSShashi Mallela 
421b87fab1cSPeter Maydell     if (ignore_pInt) {
422b87fab1cSPeter Maydell         pIntid = eventid;
423e4050980SPeter Maydell         trace_gicv3_its_cmd_mapi(devid, eventid, icid);
424b87fab1cSPeter Maydell     } else {
425b6f96009SPeter Maydell         pIntid = (cmdpkt[1] & pINTID_MASK) >> pINTID_SHIFT;
426e4050980SPeter Maydell         trace_gicv3_its_cmd_mapti(devid, eventid, icid, pIntid);
427c694cb4cSShashi Mallela     }
428c694cb4cSShashi Mallela 
4298b8bb014SPeter Maydell     if (devid >= s->dt.num_entries) {
430b13148d9SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
431b13148d9SPeter Maydell                       "%s: invalid command attributes: devid %d>=%d",
4328b8bb014SPeter Maydell                       __func__, devid, s->dt.num_entries);
433b13148d9SPeter Maydell         return CMD_CONTINUE;
434b13148d9SPeter Maydell     }
435b13148d9SPeter Maydell 
4364acf93e1SPeter Maydell     if (get_dte(s, devid, &dte) != MEMTX_OK) {
4370241f731SPeter Maydell         return CMD_STALL;
438c694cb4cSShashi Mallela     }
4394acf93e1SPeter Maydell     num_eventids = 1ULL << (dte.size + 1);
440905720f1SPeter Maydell     num_intids = 1ULL << (GICD_TYPER_IDBITS + 1);
441c694cb4cSShashi Mallela 
442d7d359c4SPeter Maydell     if (icid >= s->ct.num_entries) {
443c694cb4cSShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
444d7d359c4SPeter Maydell                       "%s: invalid ICID 0x%x >= 0x%x\n",
445d7d359c4SPeter Maydell                       __func__, icid, s->ct.num_entries);
446d7d359c4SPeter Maydell         return CMD_CONTINUE;
447d7d359c4SPeter Maydell     }
448d7d359c4SPeter Maydell 
449d7d359c4SPeter Maydell     if (!dte.valid) {
450d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
451d7d359c4SPeter Maydell                       "%s: no valid DTE for devid 0x%x\n", __func__, devid);
452d7d359c4SPeter Maydell         return CMD_CONTINUE;
453d7d359c4SPeter Maydell     }
454d7d359c4SPeter Maydell 
455d7d359c4SPeter Maydell     if (eventid >= num_eventids) {
456d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
457d7d359c4SPeter Maydell                       "%s: invalid event ID 0x%x >= 0x%" PRIx64 "\n",
458d7d359c4SPeter Maydell                       __func__, eventid, num_eventids);
459d7d359c4SPeter Maydell         return CMD_CONTINUE;
460d7d359c4SPeter Maydell     }
461d7d359c4SPeter Maydell 
462d7d359c4SPeter Maydell     if (pIntid < GICV3_LPI_INTID_START || pIntid >= num_intids) {
463d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
464d7d359c4SPeter Maydell                       "%s: invalid interrupt ID 0x%x\n", __func__, pIntid);
4650241f731SPeter Maydell         return CMD_CONTINUE;
4660241f731SPeter Maydell     }
4670241f731SPeter Maydell 
468c694cb4cSShashi Mallela     /* add ite entry to interrupt translation table */
4697eb54267SPeter Maydell     ite.valid = true;
4707eb54267SPeter Maydell     ite.inttype = ITE_INTTYPE_PHYSICAL;
4717eb54267SPeter Maydell     ite.intid = pIntid;
4727eb54267SPeter Maydell     ite.icid = icid;
4737eb54267SPeter Maydell     ite.doorbell = INTID_SPURIOUS;
4747eb54267SPeter Maydell     ite.vpeid = 0;
4757eb54267SPeter Maydell     return update_ite(s, eventid, &dte, &ite) ? CMD_CONTINUE : CMD_STALL;
476c694cb4cSShashi Mallela }
477c694cb4cSShashi Mallela 
47806985cc3SPeter Maydell /*
47906985cc3SPeter Maydell  * Update the Collection Table entry for @icid to @cte. Returns true
48006985cc3SPeter Maydell  * on success, false if there was a memory access error.
48106985cc3SPeter Maydell  */
48206985cc3SPeter Maydell static bool update_cte(GICv3ITSState *s, uint16_t icid, const CTEntry *cte)
4837eca39e0SShashi Mallela {
4847eca39e0SShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
485d050f80fSPeter Maydell     uint64_t entry_addr;
48606985cc3SPeter Maydell     uint64_t cteval = 0;
4877eca39e0SShashi Mallela     MemTxResult res = MEMTX_OK;
4887eca39e0SShashi Mallela 
489930f40e9SPeter Maydell     trace_gicv3_its_cte_write(icid, cte->valid, cte->rdbase);
490930f40e9SPeter Maydell 
49106985cc3SPeter Maydell     if (cte->valid) {
4927eca39e0SShashi Mallela         /* add mapping entry to collection table */
49306985cc3SPeter Maydell         cteval = FIELD_DP64(cteval, CTE, VALID, 1);
49406985cc3SPeter Maydell         cteval = FIELD_DP64(cteval, CTE, RDBASE, cte->rdbase);
4957eca39e0SShashi Mallela     }
4967eca39e0SShashi Mallela 
497d050f80fSPeter Maydell     entry_addr = table_entry_addr(s, &s->ct, icid, &res);
4987eca39e0SShashi Mallela     if (res != MEMTX_OK) {
499d050f80fSPeter Maydell         /* memory access error: stall */
5007eca39e0SShashi Mallela         return false;
5017eca39e0SShashi Mallela     }
502d050f80fSPeter Maydell     if (entry_addr == -1) {
503d050f80fSPeter Maydell         /* No L2 table for this index: discard write and continue */
5047eca39e0SShashi Mallela         return true;
5057eca39e0SShashi Mallela     }
506d050f80fSPeter Maydell 
50706985cc3SPeter Maydell     address_space_stq_le(as, entry_addr, cteval, MEMTXATTRS_UNSPECIFIED, &res);
508d050f80fSPeter Maydell     return res == MEMTX_OK;
5097eca39e0SShashi Mallela }
5107eca39e0SShashi Mallela 
511b6f96009SPeter Maydell static ItsCmdResult process_mapc(GICv3ITSState *s, const uint64_t *cmdpkt)
5127eca39e0SShashi Mallela {
5137eca39e0SShashi Mallela     uint16_t icid;
51406985cc3SPeter Maydell     CTEntry cte;
5157eca39e0SShashi Mallela 
516b6f96009SPeter Maydell     icid = cmdpkt[2] & ICID_MASK;
51784d43d2eSPeter Maydell     cte.valid = cmdpkt[2] & CMD_FIELD_VALID_MASK;
51884d43d2eSPeter Maydell     if (cte.valid) {
51906985cc3SPeter Maydell         cte.rdbase = (cmdpkt[2] & R_MAPC_RDBASE_MASK) >> R_MAPC_RDBASE_SHIFT;
52006985cc3SPeter Maydell         cte.rdbase &= RDBASE_PROCNUM_MASK;
52184d43d2eSPeter Maydell     } else {
52284d43d2eSPeter Maydell         cte.rdbase = 0;
52384d43d2eSPeter Maydell     }
524e4050980SPeter Maydell     trace_gicv3_its_cmd_mapc(icid, cte.rdbase, cte.valid);
5257eca39e0SShashi Mallela 
52684d43d2eSPeter Maydell     if (icid >= s->ct.num_entries) {
527*c7ca3ad5SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR, "ITS MAPC: invalid ICID 0x%x\n", icid);
52884d43d2eSPeter Maydell         return CMD_CONTINUE;
52984d43d2eSPeter Maydell     }
53084d43d2eSPeter Maydell     if (cte.valid && cte.rdbase >= s->gicv3->num_cpu) {
5317eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
532*c7ca3ad5SPeter Maydell                       "ITS MAPC: invalid RDBASE %u\n", cte.rdbase);
533f6675196SPeter Maydell         return CMD_CONTINUE;
5347eca39e0SShashi Mallela     }
5357eca39e0SShashi Mallela 
53606985cc3SPeter Maydell     return update_cte(s, icid, &cte) ? CMD_CONTINUE : CMD_STALL;
5377eca39e0SShashi Mallela }
5387eca39e0SShashi Mallela 
53922d62b08SPeter Maydell /*
54022d62b08SPeter Maydell  * Update the Device Table entry for @devid to @dte. Returns true
54122d62b08SPeter Maydell  * on success, false if there was a memory access error.
54222d62b08SPeter Maydell  */
54322d62b08SPeter Maydell static bool update_dte(GICv3ITSState *s, uint32_t devid, const DTEntry *dte)
5447eca39e0SShashi Mallela {
5457eca39e0SShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
546d050f80fSPeter Maydell     uint64_t entry_addr;
54722d62b08SPeter Maydell     uint64_t dteval = 0;
5487eca39e0SShashi Mallela     MemTxResult res = MEMTX_OK;
5497eca39e0SShashi Mallela 
550930f40e9SPeter Maydell     trace_gicv3_its_dte_write(devid, dte->valid, dte->size, dte->ittaddr);
551930f40e9SPeter Maydell 
55222d62b08SPeter Maydell     if (dte->valid) {
5537eca39e0SShashi Mallela         /* add mapping entry to device table */
55422d62b08SPeter Maydell         dteval = FIELD_DP64(dteval, DTE, VALID, 1);
55522d62b08SPeter Maydell         dteval = FIELD_DP64(dteval, DTE, SIZE, dte->size);
55622d62b08SPeter Maydell         dteval = FIELD_DP64(dteval, DTE, ITTADDR, dte->ittaddr);
5577eca39e0SShashi Mallela     }
5587eca39e0SShashi Mallela 
559d050f80fSPeter Maydell     entry_addr = table_entry_addr(s, &s->dt, devid, &res);
5607eca39e0SShashi Mallela     if (res != MEMTX_OK) {
561d050f80fSPeter Maydell         /* memory access error: stall */
5627eca39e0SShashi Mallela         return false;
5637eca39e0SShashi Mallela     }
564d050f80fSPeter Maydell     if (entry_addr == -1) {
565d050f80fSPeter Maydell         /* No L2 table for this index: discard write and continue */
5667eca39e0SShashi Mallela         return true;
5677eca39e0SShashi Mallela     }
56822d62b08SPeter Maydell     address_space_stq_le(as, entry_addr, dteval, MEMTXATTRS_UNSPECIFIED, &res);
569d050f80fSPeter Maydell     return res == MEMTX_OK;
5707eca39e0SShashi Mallela }
5717eca39e0SShashi Mallela 
572b6f96009SPeter Maydell static ItsCmdResult process_mapd(GICv3ITSState *s, const uint64_t *cmdpkt)
5737eca39e0SShashi Mallela {
5747eca39e0SShashi Mallela     uint32_t devid;
57522d62b08SPeter Maydell     DTEntry dte;
5767eca39e0SShashi Mallela 
577b6f96009SPeter Maydell     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
57822d62b08SPeter Maydell     dte.size = cmdpkt[1] & SIZE_MASK;
57922d62b08SPeter Maydell     dte.ittaddr = (cmdpkt[2] & ITTADDR_MASK) >> ITTADDR_SHIFT;
58022d62b08SPeter Maydell     dte.valid = cmdpkt[2] & CMD_FIELD_VALID_MASK;
5817eca39e0SShashi Mallela 
582e4050980SPeter Maydell     trace_gicv3_its_cmd_mapd(devid, dte.size, dte.ittaddr, dte.valid);
583e4050980SPeter Maydell 
584d7d359c4SPeter Maydell     if (devid >= s->dt.num_entries) {
5857eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
586d7d359c4SPeter Maydell                       "ITS MAPD: invalid device ID field 0x%x >= 0x%x\n",
587d7d359c4SPeter Maydell                       devid, s->dt.num_entries);
588d7d359c4SPeter Maydell         return CMD_CONTINUE;
589d7d359c4SPeter Maydell     }
590d7d359c4SPeter Maydell 
591d7d359c4SPeter Maydell     if (dte.size > FIELD_EX64(s->typer, GITS_TYPER, IDBITS)) {
592d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
593d7d359c4SPeter Maydell                       "ITS MAPD: invalid size %d\n", dte.size);
59400d46e72SPeter Maydell         return CMD_CONTINUE;
5957eca39e0SShashi Mallela     }
5967eca39e0SShashi Mallela 
59722d62b08SPeter Maydell     return update_dte(s, devid, &dte) ? CMD_CONTINUE : CMD_STALL;
5987eca39e0SShashi Mallela }
5997eca39e0SShashi Mallela 
600b6f96009SPeter Maydell static ItsCmdResult process_movall(GICv3ITSState *s, const uint64_t *cmdpkt)
601f6d1d9b4SPeter Maydell {
602f6d1d9b4SPeter Maydell     uint64_t rd1, rd2;
603f6d1d9b4SPeter Maydell 
604b6f96009SPeter Maydell     rd1 = FIELD_EX64(cmdpkt[2], MOVALL_2, RDBASE1);
605b6f96009SPeter Maydell     rd2 = FIELD_EX64(cmdpkt[3], MOVALL_3, RDBASE2);
606f6d1d9b4SPeter Maydell 
607e4050980SPeter Maydell     trace_gicv3_its_cmd_movall(rd1, rd2);
608e4050980SPeter Maydell 
609f6d1d9b4SPeter Maydell     if (rd1 >= s->gicv3->num_cpu) {
610f6d1d9b4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
611f6d1d9b4SPeter Maydell                       "%s: RDBASE1 %" PRId64
612f6d1d9b4SPeter Maydell                       " out of range (must be less than %d)\n",
613f6d1d9b4SPeter Maydell                       __func__, rd1, s->gicv3->num_cpu);
614f6d1d9b4SPeter Maydell         return CMD_CONTINUE;
615f6d1d9b4SPeter Maydell     }
616f6d1d9b4SPeter Maydell     if (rd2 >= s->gicv3->num_cpu) {
617f6d1d9b4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
618f6d1d9b4SPeter Maydell                       "%s: RDBASE2 %" PRId64
619f6d1d9b4SPeter Maydell                       " out of range (must be less than %d)\n",
620f6d1d9b4SPeter Maydell                       __func__, rd2, s->gicv3->num_cpu);
621f6d1d9b4SPeter Maydell         return CMD_CONTINUE;
622f6d1d9b4SPeter Maydell     }
623f6d1d9b4SPeter Maydell 
624f6d1d9b4SPeter Maydell     if (rd1 == rd2) {
625f6d1d9b4SPeter Maydell         /* Move to same target must succeed as a no-op */
626f6d1d9b4SPeter Maydell         return CMD_CONTINUE;
627f6d1d9b4SPeter Maydell     }
628f6d1d9b4SPeter Maydell 
629f6d1d9b4SPeter Maydell     /* Move all pending LPIs from redistributor 1 to redistributor 2 */
630f6d1d9b4SPeter Maydell     gicv3_redist_movall_lpis(&s->gicv3->cpu[rd1], &s->gicv3->cpu[rd2]);
631f6d1d9b4SPeter Maydell 
632f6d1d9b4SPeter Maydell     return CMD_CONTINUE;
633f6d1d9b4SPeter Maydell }
634f6d1d9b4SPeter Maydell 
635b6f96009SPeter Maydell static ItsCmdResult process_movi(GICv3ITSState *s, const uint64_t *cmdpkt)
636961b4912SPeter Maydell {
637244194feSPeter Maydell     uint32_t devid, eventid;
638244194feSPeter Maydell     uint16_t new_icid;
639961b4912SPeter Maydell     uint64_t num_eventids;
6404acf93e1SPeter Maydell     DTEntry dte;
641d37cf49bSPeter Maydell     CTEntry old_cte, new_cte;
642244194feSPeter Maydell     ITEntry old_ite;
643961b4912SPeter Maydell 
644b6f96009SPeter Maydell     devid = FIELD_EX64(cmdpkt[0], MOVI_0, DEVICEID);
645b6f96009SPeter Maydell     eventid = FIELD_EX64(cmdpkt[1], MOVI_1, EVENTID);
646b6f96009SPeter Maydell     new_icid = FIELD_EX64(cmdpkt[2], MOVI_2, ICID);
647961b4912SPeter Maydell 
648e4050980SPeter Maydell     trace_gicv3_its_cmd_movi(devid, eventid, new_icid);
649e4050980SPeter Maydell 
650961b4912SPeter Maydell     if (devid >= s->dt.num_entries) {
651961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
652961b4912SPeter Maydell                       "%s: invalid command attributes: devid %d>=%d",
653961b4912SPeter Maydell                       __func__, devid, s->dt.num_entries);
654961b4912SPeter Maydell         return CMD_CONTINUE;
655961b4912SPeter Maydell     }
6564acf93e1SPeter Maydell     if (get_dte(s, devid, &dte) != MEMTX_OK) {
657961b4912SPeter Maydell         return CMD_STALL;
658961b4912SPeter Maydell     }
659961b4912SPeter Maydell 
6604acf93e1SPeter Maydell     if (!dte.valid) {
661961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
662961b4912SPeter Maydell                       "%s: invalid command attributes: "
6634acf93e1SPeter Maydell                       "invalid dte for %d\n", __func__, devid);
664961b4912SPeter Maydell         return CMD_CONTINUE;
665961b4912SPeter Maydell     }
666961b4912SPeter Maydell 
6674acf93e1SPeter Maydell     num_eventids = 1ULL << (dte.size + 1);
668961b4912SPeter Maydell     if (eventid >= num_eventids) {
669961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
670961b4912SPeter Maydell                       "%s: invalid command attributes: eventid %d >= %"
671961b4912SPeter Maydell                       PRId64 "\n",
672961b4912SPeter Maydell                       __func__, eventid, num_eventids);
673961b4912SPeter Maydell         return CMD_CONTINUE;
674961b4912SPeter Maydell     }
675961b4912SPeter Maydell 
676244194feSPeter Maydell     if (get_ite(s, eventid, &dte, &old_ite) != MEMTX_OK) {
677961b4912SPeter Maydell         return CMD_STALL;
678961b4912SPeter Maydell     }
679961b4912SPeter Maydell 
680244194feSPeter Maydell     if (!old_ite.valid || old_ite.inttype != ITE_INTTYPE_PHYSICAL) {
681961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
682961b4912SPeter Maydell                       "%s: invalid command attributes: invalid ITE\n",
683961b4912SPeter Maydell                       __func__);
684961b4912SPeter Maydell         return CMD_CONTINUE;
685961b4912SPeter Maydell     }
686961b4912SPeter Maydell 
687244194feSPeter Maydell     if (old_ite.icid >= s->ct.num_entries) {
688961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
689961b4912SPeter Maydell                       "%s: invalid ICID 0x%x in ITE (table corrupted?)\n",
690244194feSPeter Maydell                       __func__, old_ite.icid);
691961b4912SPeter Maydell         return CMD_CONTINUE;
692961b4912SPeter Maydell     }
693961b4912SPeter Maydell 
694961b4912SPeter Maydell     if (new_icid >= s->ct.num_entries) {
695961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
696961b4912SPeter Maydell                       "%s: invalid command attributes: ICID 0x%x\n",
697961b4912SPeter Maydell                       __func__, new_icid);
698961b4912SPeter Maydell         return CMD_CONTINUE;
699961b4912SPeter Maydell     }
700961b4912SPeter Maydell 
701244194feSPeter Maydell     if (get_cte(s, old_ite.icid, &old_cte) != MEMTX_OK) {
702961b4912SPeter Maydell         return CMD_STALL;
703961b4912SPeter Maydell     }
704d37cf49bSPeter Maydell     if (!old_cte.valid) {
705961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
706961b4912SPeter Maydell                       "%s: invalid command attributes: "
707d37cf49bSPeter Maydell                       "invalid CTE for old ICID 0x%x\n",
708244194feSPeter Maydell                       __func__, old_ite.icid);
709961b4912SPeter Maydell         return CMD_CONTINUE;
710961b4912SPeter Maydell     }
711961b4912SPeter Maydell 
712d37cf49bSPeter Maydell     if (get_cte(s, new_icid, &new_cte) != MEMTX_OK) {
713961b4912SPeter Maydell         return CMD_STALL;
714961b4912SPeter Maydell     }
715d37cf49bSPeter Maydell     if (!new_cte.valid) {
716961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
717961b4912SPeter Maydell                       "%s: invalid command attributes: "
718d37cf49bSPeter Maydell                       "invalid CTE for new ICID 0x%x\n",
719d37cf49bSPeter Maydell                       __func__, new_icid);
720961b4912SPeter Maydell         return CMD_CONTINUE;
721961b4912SPeter Maydell     }
722961b4912SPeter Maydell 
723d37cf49bSPeter Maydell     if (old_cte.rdbase >= s->gicv3->num_cpu) {
724961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
725d37cf49bSPeter Maydell                       "%s: CTE has invalid rdbase 0x%x\n",
726d37cf49bSPeter Maydell                       __func__, old_cte.rdbase);
727961b4912SPeter Maydell         return CMD_CONTINUE;
728961b4912SPeter Maydell     }
729961b4912SPeter Maydell 
730d37cf49bSPeter Maydell     if (new_cte.rdbase >= s->gicv3->num_cpu) {
731961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
732d37cf49bSPeter Maydell                       "%s: CTE has invalid rdbase 0x%x\n",
733d37cf49bSPeter Maydell                       __func__, new_cte.rdbase);
734961b4912SPeter Maydell         return CMD_CONTINUE;
735961b4912SPeter Maydell     }
736961b4912SPeter Maydell 
737d37cf49bSPeter Maydell     if (old_cte.rdbase != new_cte.rdbase) {
738961b4912SPeter Maydell         /* Move the LPI from the old redistributor to the new one */
739d37cf49bSPeter Maydell         gicv3_redist_mov_lpi(&s->gicv3->cpu[old_cte.rdbase],
740d37cf49bSPeter Maydell                              &s->gicv3->cpu[new_cte.rdbase],
741244194feSPeter Maydell                              old_ite.intid);
742961b4912SPeter Maydell     }
743961b4912SPeter Maydell 
744961b4912SPeter Maydell     /* Update the ICID field in the interrupt translation table entry */
7457eb54267SPeter Maydell     old_ite.icid = new_icid;
7467eb54267SPeter Maydell     return update_ite(s, eventid, &dte, &old_ite) ? CMD_CONTINUE : CMD_STALL;
747961b4912SPeter Maydell }
748961b4912SPeter Maydell 
7497eca39e0SShashi Mallela /*
7507eca39e0SShashi Mallela  * Current implementation blocks until all
7517eca39e0SShashi Mallela  * commands are processed
7527eca39e0SShashi Mallela  */
7537eca39e0SShashi Mallela static void process_cmdq(GICv3ITSState *s)
7547eca39e0SShashi Mallela {
7557eca39e0SShashi Mallela     uint32_t wr_offset = 0;
7567eca39e0SShashi Mallela     uint32_t rd_offset = 0;
7577eca39e0SShashi Mallela     uint32_t cq_offset = 0;
7587eca39e0SShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
7597eca39e0SShashi Mallela     uint8_t cmd;
76017fb5e36SShashi Mallela     int i;
7617eca39e0SShashi Mallela 
7628d2d6dd9SPeter Maydell     if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
7637eca39e0SShashi Mallela         return;
7647eca39e0SShashi Mallela     }
7657eca39e0SShashi Mallela 
7667eca39e0SShashi Mallela     wr_offset = FIELD_EX64(s->cwriter, GITS_CWRITER, OFFSET);
7677eca39e0SShashi Mallela 
76880dcd37fSPeter Maydell     if (wr_offset >= s->cq.num_entries) {
7697eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
7707eca39e0SShashi Mallela                       "%s: invalid write offset "
7717eca39e0SShashi Mallela                       "%d\n", __func__, wr_offset);
7727eca39e0SShashi Mallela         return;
7737eca39e0SShashi Mallela     }
7747eca39e0SShashi Mallela 
7757eca39e0SShashi Mallela     rd_offset = FIELD_EX64(s->creadr, GITS_CREADR, OFFSET);
7767eca39e0SShashi Mallela 
77780dcd37fSPeter Maydell     if (rd_offset >= s->cq.num_entries) {
7787eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
7797eca39e0SShashi Mallela                       "%s: invalid read offset "
7807eca39e0SShashi Mallela                       "%d\n", __func__, rd_offset);
7817eca39e0SShashi Mallela         return;
7827eca39e0SShashi Mallela     }
7837eca39e0SShashi Mallela 
7847eca39e0SShashi Mallela     while (wr_offset != rd_offset) {
785ef011555SPeter Maydell         ItsCmdResult result = CMD_CONTINUE;
786b6f96009SPeter Maydell         void *hostmem;
787b6f96009SPeter Maydell         hwaddr buflen;
788b6f96009SPeter Maydell         uint64_t cmdpkt[GITS_CMDQ_ENTRY_WORDS];
789ef011555SPeter Maydell 
7907eca39e0SShashi Mallela         cq_offset = (rd_offset * GITS_CMDQ_ENTRY_SIZE);
791b6f96009SPeter Maydell 
792b6f96009SPeter Maydell         buflen = GITS_CMDQ_ENTRY_SIZE;
793b6f96009SPeter Maydell         hostmem = address_space_map(as, s->cq.base_addr + cq_offset,
794b6f96009SPeter Maydell                                     &buflen, false, MEMTXATTRS_UNSPECIFIED);
795b6f96009SPeter Maydell         if (!hostmem || buflen != GITS_CMDQ_ENTRY_SIZE) {
796b6f96009SPeter Maydell             if (hostmem) {
797b6f96009SPeter Maydell                 address_space_unmap(as, hostmem, buflen, false, 0);
798b6f96009SPeter Maydell             }
799f0b4b2a2SPeter Maydell             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, STALLED, 1);
800f0b4b2a2SPeter Maydell             qemu_log_mask(LOG_GUEST_ERROR,
801f0b4b2a2SPeter Maydell                           "%s: could not read command at 0x%" PRIx64 "\n",
802f0b4b2a2SPeter Maydell                           __func__, s->cq.base_addr + cq_offset);
803f0b4b2a2SPeter Maydell             break;
8047eca39e0SShashi Mallela         }
805b6f96009SPeter Maydell         for (i = 0; i < ARRAY_SIZE(cmdpkt); i++) {
806b6f96009SPeter Maydell             cmdpkt[i] = ldq_le_p(hostmem + i * sizeof(uint64_t));
807b6f96009SPeter Maydell         }
808b6f96009SPeter Maydell         address_space_unmap(as, hostmem, buflen, false, 0);
809f0b4b2a2SPeter Maydell 
810b6f96009SPeter Maydell         cmd = cmdpkt[0] & CMD_MASK;
8117eca39e0SShashi Mallela 
812195209d3SPeter Maydell         trace_gicv3_its_process_command(rd_offset, cmd);
813195209d3SPeter Maydell 
8147eca39e0SShashi Mallela         switch (cmd) {
8157eca39e0SShashi Mallela         case GITS_CMD_INT:
816b6f96009SPeter Maydell             result = process_its_cmd(s, cmdpkt, INTERRUPT);
8177eca39e0SShashi Mallela             break;
8187eca39e0SShashi Mallela         case GITS_CMD_CLEAR:
819b6f96009SPeter Maydell             result = process_its_cmd(s, cmdpkt, CLEAR);
8207eca39e0SShashi Mallela             break;
8217eca39e0SShashi Mallela         case GITS_CMD_SYNC:
8227eca39e0SShashi Mallela             /*
8237eca39e0SShashi Mallela              * Current implementation makes a blocking synchronous call
8247eca39e0SShashi Mallela              * for every command issued earlier, hence the internal state
8257eca39e0SShashi Mallela              * is already consistent by the time SYNC command is executed.
8267eca39e0SShashi Mallela              * Hence no further processing is required for SYNC command.
8277eca39e0SShashi Mallela              */
828e4050980SPeter Maydell             trace_gicv3_its_cmd_sync();
8297eca39e0SShashi Mallela             break;
8307eca39e0SShashi Mallela         case GITS_CMD_MAPD:
831b6f96009SPeter Maydell             result = process_mapd(s, cmdpkt);
8327eca39e0SShashi Mallela             break;
8337eca39e0SShashi Mallela         case GITS_CMD_MAPC:
834b6f96009SPeter Maydell             result = process_mapc(s, cmdpkt);
8357eca39e0SShashi Mallela             break;
8367eca39e0SShashi Mallela         case GITS_CMD_MAPTI:
837b6f96009SPeter Maydell             result = process_mapti(s, cmdpkt, false);
8387eca39e0SShashi Mallela             break;
8397eca39e0SShashi Mallela         case GITS_CMD_MAPI:
840b6f96009SPeter Maydell             result = process_mapti(s, cmdpkt, true);
8417eca39e0SShashi Mallela             break;
8427eca39e0SShashi Mallela         case GITS_CMD_DISCARD:
843b6f96009SPeter Maydell             result = process_its_cmd(s, cmdpkt, DISCARD);
8447eca39e0SShashi Mallela             break;
8457eca39e0SShashi Mallela         case GITS_CMD_INV:
8467eca39e0SShashi Mallela         case GITS_CMD_INVALL:
84717fb5e36SShashi Mallela             /*
84817fb5e36SShashi Mallela              * Current implementation doesn't cache any ITS tables,
84917fb5e36SShashi Mallela              * but the calculated lpi priority information. We only
85017fb5e36SShashi Mallela              * need to trigger lpi priority re-calculation to be in
85117fb5e36SShashi Mallela              * sync with LPI config table or pending table changes.
85217fb5e36SShashi Mallela              */
853e4050980SPeter Maydell             trace_gicv3_its_cmd_inv();
85417fb5e36SShashi Mallela             for (i = 0; i < s->gicv3->num_cpu; i++) {
85517fb5e36SShashi Mallela                 gicv3_redist_update_lpi(&s->gicv3->cpu[i]);
85617fb5e36SShashi Mallela             }
8577eca39e0SShashi Mallela             break;
858961b4912SPeter Maydell         case GITS_CMD_MOVI:
859b6f96009SPeter Maydell             result = process_movi(s, cmdpkt);
860961b4912SPeter Maydell             break;
861f6d1d9b4SPeter Maydell         case GITS_CMD_MOVALL:
862b6f96009SPeter Maydell             result = process_movall(s, cmdpkt);
863f6d1d9b4SPeter Maydell             break;
8647eca39e0SShashi Mallela         default:
865e4050980SPeter Maydell             trace_gicv3_its_cmd_unknown(cmd);
8667eca39e0SShashi Mallela             break;
8677eca39e0SShashi Mallela         }
868ef011555SPeter Maydell         if (result == CMD_CONTINUE) {
8697eca39e0SShashi Mallela             rd_offset++;
87080dcd37fSPeter Maydell             rd_offset %= s->cq.num_entries;
8717eca39e0SShashi Mallela             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, OFFSET, rd_offset);
8727eca39e0SShashi Mallela         } else {
873ef011555SPeter Maydell             /* CMD_STALL */
8747eca39e0SShashi Mallela             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, STALLED, 1);
8757eca39e0SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
876ef011555SPeter Maydell                           "%s: 0x%x cmd processing failed, stalling\n",
877ef011555SPeter Maydell                           __func__, cmd);
8787eca39e0SShashi Mallela             break;
8797eca39e0SShashi Mallela         }
8807eca39e0SShashi Mallela     }
8817eca39e0SShashi Mallela }
8827eca39e0SShashi Mallela 
8831b08e436SShashi Mallela /*
8841b08e436SShashi Mallela  * This function extracts the ITS Device and Collection table specific
8851b08e436SShashi Mallela  * parameters (like base_addr, size etc) from GITS_BASER register.
8861b08e436SShashi Mallela  * It is called during ITS enable and also during post_load migration
8871b08e436SShashi Mallela  */
8881b08e436SShashi Mallela static void extract_table_params(GICv3ITSState *s)
8891b08e436SShashi Mallela {
8901b08e436SShashi Mallela     uint16_t num_pages = 0;
8911b08e436SShashi Mallela     uint8_t  page_sz_type;
8921b08e436SShashi Mallela     uint8_t type;
8931b08e436SShashi Mallela     uint32_t page_sz = 0;
8941b08e436SShashi Mallela     uint64_t value;
8951b08e436SShashi Mallela 
8961b08e436SShashi Mallela     for (int i = 0; i < 8; i++) {
897e5487a41SPeter Maydell         TableDesc *td;
898e5487a41SPeter Maydell         int idbits;
899e5487a41SPeter Maydell 
9001b08e436SShashi Mallela         value = s->baser[i];
9011b08e436SShashi Mallela 
9021b08e436SShashi Mallela         if (!value) {
9031b08e436SShashi Mallela             continue;
9041b08e436SShashi Mallela         }
9051b08e436SShashi Mallela 
9061b08e436SShashi Mallela         page_sz_type = FIELD_EX64(value, GITS_BASER, PAGESIZE);
9071b08e436SShashi Mallela 
9081b08e436SShashi Mallela         switch (page_sz_type) {
9091b08e436SShashi Mallela         case 0:
9101b08e436SShashi Mallela             page_sz = GITS_PAGE_SIZE_4K;
9111b08e436SShashi Mallela             break;
9121b08e436SShashi Mallela 
9131b08e436SShashi Mallela         case 1:
9141b08e436SShashi Mallela             page_sz = GITS_PAGE_SIZE_16K;
9151b08e436SShashi Mallela             break;
9161b08e436SShashi Mallela 
9171b08e436SShashi Mallela         case 2:
9181b08e436SShashi Mallela         case 3:
9191b08e436SShashi Mallela             page_sz = GITS_PAGE_SIZE_64K;
9201b08e436SShashi Mallela             break;
9211b08e436SShashi Mallela 
9221b08e436SShashi Mallela         default:
9231b08e436SShashi Mallela             g_assert_not_reached();
9241b08e436SShashi Mallela         }
9251b08e436SShashi Mallela 
9261b08e436SShashi Mallela         num_pages = FIELD_EX64(value, GITS_BASER, SIZE) + 1;
9271b08e436SShashi Mallela 
9281b08e436SShashi Mallela         type = FIELD_EX64(value, GITS_BASER, TYPE);
9291b08e436SShashi Mallela 
9301b08e436SShashi Mallela         switch (type) {
9311b08e436SShashi Mallela         case GITS_BASER_TYPE_DEVICE:
932e5487a41SPeter Maydell             td = &s->dt;
933e5487a41SPeter Maydell             idbits = FIELD_EX64(s->typer, GITS_TYPER, DEVBITS) + 1;
93462df780eSPeter Maydell             break;
9351b08e436SShashi Mallela         case GITS_BASER_TYPE_COLLECTION:
936e5487a41SPeter Maydell             td = &s->ct;
9371b08e436SShashi Mallela             if (FIELD_EX64(s->typer, GITS_TYPER, CIL)) {
938e5487a41SPeter Maydell                 idbits = FIELD_EX64(s->typer, GITS_TYPER, CIDBITS) + 1;
9391b08e436SShashi Mallela             } else {
9401b08e436SShashi Mallela                 /* 16-bit CollectionId supported when CIL == 0 */
941e5487a41SPeter Maydell                 idbits = 16;
9421b08e436SShashi Mallela             }
9431b08e436SShashi Mallela             break;
9441b08e436SShashi Mallela         default:
945e5487a41SPeter Maydell             /*
946e5487a41SPeter Maydell              * GITS_BASER<n>.TYPE is read-only, so GITS_BASER_RO_MASK
947e5487a41SPeter Maydell              * ensures we will only see type values corresponding to
948e5487a41SPeter Maydell              * the values set up in gicv3_its_reset().
949e5487a41SPeter Maydell              */
950e5487a41SPeter Maydell             g_assert_not_reached();
9511b08e436SShashi Mallela         }
952e5487a41SPeter Maydell 
953e5487a41SPeter Maydell         memset(td, 0, sizeof(*td));
954e5487a41SPeter Maydell         /*
955e5487a41SPeter Maydell          * If GITS_BASER<n>.Valid is 0 for any <n> then we will not process
956e5487a41SPeter Maydell          * interrupts. (GITS_TYPER.HCC is 0 for this implementation, so we
957e5487a41SPeter Maydell          * do not have a special case where the GITS_BASER<n>.Valid bit is 0
958e5487a41SPeter Maydell          * for the register corresponding to the Collection table but we
959e5487a41SPeter Maydell          * still have to process interrupts using non-memory-backed
960e5487a41SPeter Maydell          * Collection table entries.)
961da4680ceSPeter Maydell          * The specification makes it UNPREDICTABLE to enable the ITS without
962da4680ceSPeter Maydell          * marking each BASER<n> as valid. We choose to handle these as if
963da4680ceSPeter Maydell          * the table was zero-sized, so commands using the table will fail
964da4680ceSPeter Maydell          * and interrupts requested via GITS_TRANSLATER writes will be ignored.
965da4680ceSPeter Maydell          * This happens automatically by leaving the num_entries field at
966da4680ceSPeter Maydell          * zero, which will be caught by the bounds checks we have before
967da4680ceSPeter Maydell          * every table lookup anyway.
968e5487a41SPeter Maydell          */
969da4680ceSPeter Maydell         if (!FIELD_EX64(value, GITS_BASER, VALID)) {
970e5487a41SPeter Maydell             continue;
971e5487a41SPeter Maydell         }
972e5487a41SPeter Maydell         td->page_sz = page_sz;
973e5487a41SPeter Maydell         td->indirect = FIELD_EX64(value, GITS_BASER, INDIRECT);
9749ae85431SPeter Maydell         td->entry_sz = FIELD_EX64(value, GITS_BASER, ENTRYSIZE) + 1;
975e5487a41SPeter Maydell         td->base_addr = baser_base_addr(value, page_sz);
976e5487a41SPeter Maydell         if (!td->indirect) {
97780dcd37fSPeter Maydell             td->num_entries = (num_pages * page_sz) / td->entry_sz;
978e5487a41SPeter Maydell         } else {
97980dcd37fSPeter Maydell             td->num_entries = (((num_pages * page_sz) /
980e5487a41SPeter Maydell                                   L1TABLE_ENTRY_SIZE) *
981e5487a41SPeter Maydell                                  (page_sz / td->entry_sz));
982e5487a41SPeter Maydell         }
9838b8bb014SPeter Maydell         td->num_entries = MIN(td->num_entries, 1ULL << idbits);
9841b08e436SShashi Mallela     }
9851b08e436SShashi Mallela }
9861b08e436SShashi Mallela 
9871b08e436SShashi Mallela static void extract_cmdq_params(GICv3ITSState *s)
9881b08e436SShashi Mallela {
9891b08e436SShashi Mallela     uint16_t num_pages = 0;
9901b08e436SShashi Mallela     uint64_t value = s->cbaser;
9911b08e436SShashi Mallela 
9921b08e436SShashi Mallela     num_pages = FIELD_EX64(value, GITS_CBASER, SIZE) + 1;
9931b08e436SShashi Mallela 
9941b08e436SShashi Mallela     memset(&s->cq, 0 , sizeof(s->cq));
9951b08e436SShashi Mallela 
996da4680ceSPeter Maydell     if (FIELD_EX64(value, GITS_CBASER, VALID)) {
99780dcd37fSPeter Maydell         s->cq.num_entries = (num_pages * GITS_PAGE_SIZE_4K) /
9981b08e436SShashi Mallela                              GITS_CMDQ_ENTRY_SIZE;
9991b08e436SShashi Mallela         s->cq.base_addr = FIELD_EX64(value, GITS_CBASER, PHYADDR);
10001b08e436SShashi Mallela         s->cq.base_addr <<= R_GITS_CBASER_PHYADDR_SHIFT;
10011b08e436SShashi Mallela     }
10021b08e436SShashi Mallela }
10031b08e436SShashi Mallela 
10047e062b98SPeter Maydell static MemTxResult gicv3_its_translation_read(void *opaque, hwaddr offset,
10057e062b98SPeter Maydell                                               uint64_t *data, unsigned size,
10067e062b98SPeter Maydell                                               MemTxAttrs attrs)
10077e062b98SPeter Maydell {
10087e062b98SPeter Maydell     /*
10097e062b98SPeter Maydell      * GITS_TRANSLATER is write-only, and all other addresses
10107e062b98SPeter Maydell      * in the interrupt translation space frame are RES0.
10117e062b98SPeter Maydell      */
10127e062b98SPeter Maydell     *data = 0;
10137e062b98SPeter Maydell     return MEMTX_OK;
10147e062b98SPeter Maydell }
10157e062b98SPeter Maydell 
101618f6290aSShashi Mallela static MemTxResult gicv3_its_translation_write(void *opaque, hwaddr offset,
101718f6290aSShashi Mallela                                                uint64_t data, unsigned size,
101818f6290aSShashi Mallela                                                MemTxAttrs attrs)
101918f6290aSShashi Mallela {
1020c694cb4cSShashi Mallela     GICv3ITSState *s = (GICv3ITSState *)opaque;
1021c694cb4cSShashi Mallela     bool result = true;
1022c694cb4cSShashi Mallela 
1023195209d3SPeter Maydell     trace_gicv3_its_translation_write(offset, data, size, attrs.requester_id);
1024195209d3SPeter Maydell 
1025c694cb4cSShashi Mallela     switch (offset) {
1026c694cb4cSShashi Mallela     case GITS_TRANSLATER:
10278d2d6dd9SPeter Maydell         if (s->ctlr & R_GITS_CTLR_ENABLED_MASK) {
1028b6f96009SPeter Maydell             result = do_process_its_cmd(s, attrs.requester_id, data, NONE);
1029c694cb4cSShashi Mallela         }
1030c694cb4cSShashi Mallela         break;
1031c694cb4cSShashi Mallela     default:
1032c694cb4cSShashi Mallela         break;
1033c694cb4cSShashi Mallela     }
1034c694cb4cSShashi Mallela 
1035c694cb4cSShashi Mallela     if (result) {
103618f6290aSShashi Mallela         return MEMTX_OK;
1037c694cb4cSShashi Mallela     } else {
1038c694cb4cSShashi Mallela         return MEMTX_ERROR;
1039c694cb4cSShashi Mallela     }
104018f6290aSShashi Mallela }
104118f6290aSShashi Mallela 
104218f6290aSShashi Mallela static bool its_writel(GICv3ITSState *s, hwaddr offset,
104318f6290aSShashi Mallela                               uint64_t value, MemTxAttrs attrs)
104418f6290aSShashi Mallela {
104518f6290aSShashi Mallela     bool result = true;
10461b08e436SShashi Mallela     int index;
104718f6290aSShashi Mallela 
10481b08e436SShashi Mallela     switch (offset) {
10491b08e436SShashi Mallela     case GITS_CTLR:
10502f459cd1SShashi Mallela         if (value & R_GITS_CTLR_ENABLED_MASK) {
10518d2d6dd9SPeter Maydell             s->ctlr |= R_GITS_CTLR_ENABLED_MASK;
10521b08e436SShashi Mallela             extract_table_params(s);
10531b08e436SShashi Mallela             extract_cmdq_params(s);
10547eca39e0SShashi Mallela             process_cmdq(s);
10552f459cd1SShashi Mallela         } else {
10568d2d6dd9SPeter Maydell             s->ctlr &= ~R_GITS_CTLR_ENABLED_MASK;
10571b08e436SShashi Mallela         }
10581b08e436SShashi Mallela         break;
10591b08e436SShashi Mallela     case GITS_CBASER:
10601b08e436SShashi Mallela         /*
10611b08e436SShashi Mallela          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
10621b08e436SShashi Mallela          *                 already enabled
10631b08e436SShashi Mallela          */
10648d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
10651b08e436SShashi Mallela             s->cbaser = deposit64(s->cbaser, 0, 32, value);
10661b08e436SShashi Mallela             s->creadr = 0;
10671b08e436SShashi Mallela         }
10681b08e436SShashi Mallela         break;
10691b08e436SShashi Mallela     case GITS_CBASER + 4:
10701b08e436SShashi Mallela         /*
10711b08e436SShashi Mallela          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
10721b08e436SShashi Mallela          *                 already enabled
10731b08e436SShashi Mallela          */
10748d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
10751b08e436SShashi Mallela             s->cbaser = deposit64(s->cbaser, 32, 32, value);
10761b08e436SShashi Mallela             s->creadr = 0;
10771b08e436SShashi Mallela         }
10781b08e436SShashi Mallela         break;
10791b08e436SShashi Mallela     case GITS_CWRITER:
10801b08e436SShashi Mallela         s->cwriter = deposit64(s->cwriter, 0, 32,
10811b08e436SShashi Mallela                                (value & ~R_GITS_CWRITER_RETRY_MASK));
10827eca39e0SShashi Mallela         if (s->cwriter != s->creadr) {
10837eca39e0SShashi Mallela             process_cmdq(s);
10847eca39e0SShashi Mallela         }
10851b08e436SShashi Mallela         break;
10861b08e436SShashi Mallela     case GITS_CWRITER + 4:
10871b08e436SShashi Mallela         s->cwriter = deposit64(s->cwriter, 32, 32, value);
10881b08e436SShashi Mallela         break;
10891b08e436SShashi Mallela     case GITS_CREADR:
10901b08e436SShashi Mallela         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
10911b08e436SShashi Mallela             s->creadr = deposit64(s->creadr, 0, 32,
10921b08e436SShashi Mallela                                   (value & ~R_GITS_CREADR_STALLED_MASK));
10931b08e436SShashi Mallela         } else {
10941b08e436SShashi Mallela             /* RO register, ignore the write */
10951b08e436SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
10961b08e436SShashi Mallela                           "%s: invalid guest write to RO register at offset "
10971b08e436SShashi Mallela                           TARGET_FMT_plx "\n", __func__, offset);
10981b08e436SShashi Mallela         }
10991b08e436SShashi Mallela         break;
11001b08e436SShashi Mallela     case GITS_CREADR + 4:
11011b08e436SShashi Mallela         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
11021b08e436SShashi Mallela             s->creadr = deposit64(s->creadr, 32, 32, value);
11031b08e436SShashi Mallela         } else {
11041b08e436SShashi Mallela             /* RO register, ignore the write */
11051b08e436SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
11061b08e436SShashi Mallela                           "%s: invalid guest write to RO register at offset "
11071b08e436SShashi Mallela                           TARGET_FMT_plx "\n", __func__, offset);
11081b08e436SShashi Mallela         }
11091b08e436SShashi Mallela         break;
11101b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
11111b08e436SShashi Mallela         /*
11121b08e436SShashi Mallela          * IMPDEF choice:- GITS_BASERn register becomes RO if ITS is
11131b08e436SShashi Mallela          *                 already enabled
11141b08e436SShashi Mallela          */
11158d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
11161b08e436SShashi Mallela             index = (offset - GITS_BASER) / 8;
11171b08e436SShashi Mallela 
11180ffe88e6SPeter Maydell             if (s->baser[index] == 0) {
11190ffe88e6SPeter Maydell                 /* Unimplemented GITS_BASERn: RAZ/WI */
11200ffe88e6SPeter Maydell                 break;
11210ffe88e6SPeter Maydell             }
11221b08e436SShashi Mallela             if (offset & 7) {
11231b08e436SShashi Mallela                 value <<= 32;
11241b08e436SShashi Mallela                 value &= ~GITS_BASER_RO_MASK;
11251b08e436SShashi Mallela                 s->baser[index] &= GITS_BASER_RO_MASK | MAKE_64BIT_MASK(0, 32);
11261b08e436SShashi Mallela                 s->baser[index] |= value;
11271b08e436SShashi Mallela             } else {
11281b08e436SShashi Mallela                 value &= ~GITS_BASER_RO_MASK;
11291b08e436SShashi Mallela                 s->baser[index] &= GITS_BASER_RO_MASK | MAKE_64BIT_MASK(32, 32);
11301b08e436SShashi Mallela                 s->baser[index] |= value;
11311b08e436SShashi Mallela             }
11321b08e436SShashi Mallela         }
11331b08e436SShashi Mallela         break;
11341b08e436SShashi Mallela     case GITS_IIDR:
11351b08e436SShashi Mallela     case GITS_IDREGS ... GITS_IDREGS + 0x2f:
11361b08e436SShashi Mallela         /* RO registers, ignore the write */
11371b08e436SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
11381b08e436SShashi Mallela                       "%s: invalid guest write to RO register at offset "
11391b08e436SShashi Mallela                       TARGET_FMT_plx "\n", __func__, offset);
11401b08e436SShashi Mallela         break;
11411b08e436SShashi Mallela     default:
11421b08e436SShashi Mallela         result = false;
11431b08e436SShashi Mallela         break;
11441b08e436SShashi Mallela     }
114518f6290aSShashi Mallela     return result;
114618f6290aSShashi Mallela }
114718f6290aSShashi Mallela 
114818f6290aSShashi Mallela static bool its_readl(GICv3ITSState *s, hwaddr offset,
114918f6290aSShashi Mallela                              uint64_t *data, MemTxAttrs attrs)
115018f6290aSShashi Mallela {
115118f6290aSShashi Mallela     bool result = true;
11521b08e436SShashi Mallela     int index;
115318f6290aSShashi Mallela 
11541b08e436SShashi Mallela     switch (offset) {
11551b08e436SShashi Mallela     case GITS_CTLR:
11561b08e436SShashi Mallela         *data = s->ctlr;
11571b08e436SShashi Mallela         break;
11581b08e436SShashi Mallela     case GITS_IIDR:
11591b08e436SShashi Mallela         *data = gicv3_iidr();
11601b08e436SShashi Mallela         break;
11611b08e436SShashi Mallela     case GITS_IDREGS ... GITS_IDREGS + 0x2f:
11621b08e436SShashi Mallela         /* ID registers */
11631b08e436SShashi Mallela         *data = gicv3_idreg(offset - GITS_IDREGS);
11641b08e436SShashi Mallela         break;
11651b08e436SShashi Mallela     case GITS_TYPER:
11661b08e436SShashi Mallela         *data = extract64(s->typer, 0, 32);
11671b08e436SShashi Mallela         break;
11681b08e436SShashi Mallela     case GITS_TYPER + 4:
11691b08e436SShashi Mallela         *data = extract64(s->typer, 32, 32);
11701b08e436SShashi Mallela         break;
11711b08e436SShashi Mallela     case GITS_CBASER:
11721b08e436SShashi Mallela         *data = extract64(s->cbaser, 0, 32);
11731b08e436SShashi Mallela         break;
11741b08e436SShashi Mallela     case GITS_CBASER + 4:
11751b08e436SShashi Mallela         *data = extract64(s->cbaser, 32, 32);
11761b08e436SShashi Mallela         break;
11771b08e436SShashi Mallela     case GITS_CREADR:
11781b08e436SShashi Mallela         *data = extract64(s->creadr, 0, 32);
11791b08e436SShashi Mallela         break;
11801b08e436SShashi Mallela     case GITS_CREADR + 4:
11811b08e436SShashi Mallela         *data = extract64(s->creadr, 32, 32);
11821b08e436SShashi Mallela         break;
11831b08e436SShashi Mallela     case GITS_CWRITER:
11841b08e436SShashi Mallela         *data = extract64(s->cwriter, 0, 32);
11851b08e436SShashi Mallela         break;
11861b08e436SShashi Mallela     case GITS_CWRITER + 4:
11871b08e436SShashi Mallela         *data = extract64(s->cwriter, 32, 32);
11881b08e436SShashi Mallela         break;
11891b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
11901b08e436SShashi Mallela         index = (offset - GITS_BASER) / 8;
11911b08e436SShashi Mallela         if (offset & 7) {
11921b08e436SShashi Mallela             *data = extract64(s->baser[index], 32, 32);
11931b08e436SShashi Mallela         } else {
11941b08e436SShashi Mallela             *data = extract64(s->baser[index], 0, 32);
11951b08e436SShashi Mallela         }
11961b08e436SShashi Mallela         break;
11971b08e436SShashi Mallela     default:
11981b08e436SShashi Mallela         result = false;
11991b08e436SShashi Mallela         break;
12001b08e436SShashi Mallela     }
120118f6290aSShashi Mallela     return result;
120218f6290aSShashi Mallela }
120318f6290aSShashi Mallela 
120418f6290aSShashi Mallela static bool its_writell(GICv3ITSState *s, hwaddr offset,
120518f6290aSShashi Mallela                                uint64_t value, MemTxAttrs attrs)
120618f6290aSShashi Mallela {
120718f6290aSShashi Mallela     bool result = true;
12081b08e436SShashi Mallela     int index;
120918f6290aSShashi Mallela 
12101b08e436SShashi Mallela     switch (offset) {
12111b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
12121b08e436SShashi Mallela         /*
12131b08e436SShashi Mallela          * IMPDEF choice:- GITS_BASERn register becomes RO if ITS is
12141b08e436SShashi Mallela          *                 already enabled
12151b08e436SShashi Mallela          */
12168d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
12171b08e436SShashi Mallela             index = (offset - GITS_BASER) / 8;
12180ffe88e6SPeter Maydell             if (s->baser[index] == 0) {
12190ffe88e6SPeter Maydell                 /* Unimplemented GITS_BASERn: RAZ/WI */
12200ffe88e6SPeter Maydell                 break;
12210ffe88e6SPeter Maydell             }
12221b08e436SShashi Mallela             s->baser[index] &= GITS_BASER_RO_MASK;
12231b08e436SShashi Mallela             s->baser[index] |= (value & ~GITS_BASER_RO_MASK);
12241b08e436SShashi Mallela         }
12251b08e436SShashi Mallela         break;
12261b08e436SShashi Mallela     case GITS_CBASER:
12271b08e436SShashi Mallela         /*
12281b08e436SShashi Mallela          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
12291b08e436SShashi Mallela          *                 already enabled
12301b08e436SShashi Mallela          */
12318d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
12321b08e436SShashi Mallela             s->cbaser = value;
12331b08e436SShashi Mallela             s->creadr = 0;
12341b08e436SShashi Mallela         }
12351b08e436SShashi Mallela         break;
12361b08e436SShashi Mallela     case GITS_CWRITER:
12371b08e436SShashi Mallela         s->cwriter = value & ~R_GITS_CWRITER_RETRY_MASK;
12387eca39e0SShashi Mallela         if (s->cwriter != s->creadr) {
12397eca39e0SShashi Mallela             process_cmdq(s);
12407eca39e0SShashi Mallela         }
12411b08e436SShashi Mallela         break;
12421b08e436SShashi Mallela     case GITS_CREADR:
12431b08e436SShashi Mallela         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
12441b08e436SShashi Mallela             s->creadr = value & ~R_GITS_CREADR_STALLED_MASK;
12451b08e436SShashi Mallela         } else {
12461b08e436SShashi Mallela             /* RO register, ignore the write */
12471b08e436SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
12481b08e436SShashi Mallela                           "%s: invalid guest write to RO register at offset "
12491b08e436SShashi Mallela                           TARGET_FMT_plx "\n", __func__, offset);
12501b08e436SShashi Mallela         }
12511b08e436SShashi Mallela         break;
12521b08e436SShashi Mallela     case GITS_TYPER:
12531b08e436SShashi Mallela         /* RO registers, ignore the write */
12541b08e436SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
12551b08e436SShashi Mallela                       "%s: invalid guest write to RO register at offset "
12561b08e436SShashi Mallela                       TARGET_FMT_plx "\n", __func__, offset);
12571b08e436SShashi Mallela         break;
12581b08e436SShashi Mallela     default:
12591b08e436SShashi Mallela         result = false;
12601b08e436SShashi Mallela         break;
12611b08e436SShashi Mallela     }
126218f6290aSShashi Mallela     return result;
126318f6290aSShashi Mallela }
126418f6290aSShashi Mallela 
126518f6290aSShashi Mallela static bool its_readll(GICv3ITSState *s, hwaddr offset,
126618f6290aSShashi Mallela                               uint64_t *data, MemTxAttrs attrs)
126718f6290aSShashi Mallela {
126818f6290aSShashi Mallela     bool result = true;
12691b08e436SShashi Mallela     int index;
127018f6290aSShashi Mallela 
12711b08e436SShashi Mallela     switch (offset) {
12721b08e436SShashi Mallela     case GITS_TYPER:
12731b08e436SShashi Mallela         *data = s->typer;
12741b08e436SShashi Mallela         break;
12751b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
12761b08e436SShashi Mallela         index = (offset - GITS_BASER) / 8;
12771b08e436SShashi Mallela         *data = s->baser[index];
12781b08e436SShashi Mallela         break;
12791b08e436SShashi Mallela     case GITS_CBASER:
12801b08e436SShashi Mallela         *data = s->cbaser;
12811b08e436SShashi Mallela         break;
12821b08e436SShashi Mallela     case GITS_CREADR:
12831b08e436SShashi Mallela         *data = s->creadr;
12841b08e436SShashi Mallela         break;
12851b08e436SShashi Mallela     case GITS_CWRITER:
12861b08e436SShashi Mallela         *data = s->cwriter;
12871b08e436SShashi Mallela         break;
12881b08e436SShashi Mallela     default:
12891b08e436SShashi Mallela         result = false;
12901b08e436SShashi Mallela         break;
12911b08e436SShashi Mallela     }
129218f6290aSShashi Mallela     return result;
129318f6290aSShashi Mallela }
129418f6290aSShashi Mallela 
129518f6290aSShashi Mallela static MemTxResult gicv3_its_read(void *opaque, hwaddr offset, uint64_t *data,
129618f6290aSShashi Mallela                                   unsigned size, MemTxAttrs attrs)
129718f6290aSShashi Mallela {
129818f6290aSShashi Mallela     GICv3ITSState *s = (GICv3ITSState *)opaque;
129918f6290aSShashi Mallela     bool result;
130018f6290aSShashi Mallela 
130118f6290aSShashi Mallela     switch (size) {
130218f6290aSShashi Mallela     case 4:
130318f6290aSShashi Mallela         result = its_readl(s, offset, data, attrs);
130418f6290aSShashi Mallela         break;
130518f6290aSShashi Mallela     case 8:
130618f6290aSShashi Mallela         result = its_readll(s, offset, data, attrs);
130718f6290aSShashi Mallela         break;
130818f6290aSShashi Mallela     default:
130918f6290aSShashi Mallela         result = false;
131018f6290aSShashi Mallela         break;
131118f6290aSShashi Mallela     }
131218f6290aSShashi Mallela 
131318f6290aSShashi Mallela     if (!result) {
131418f6290aSShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
131518f6290aSShashi Mallela                       "%s: invalid guest read at offset " TARGET_FMT_plx
131618f6290aSShashi Mallela                       " size %u\n", __func__, offset, size);
1317195209d3SPeter Maydell         trace_gicv3_its_badread(offset, size);
131818f6290aSShashi Mallela         /*
131918f6290aSShashi Mallela          * The spec requires that reserved registers are RAZ/WI;
132018f6290aSShashi Mallela          * so use false returns from leaf functions as a way to
132118f6290aSShashi Mallela          * trigger the guest-error logging but don't return it to
132218f6290aSShashi Mallela          * the caller, or we'll cause a spurious guest data abort.
132318f6290aSShashi Mallela          */
132418f6290aSShashi Mallela         *data = 0;
1325195209d3SPeter Maydell     } else {
1326195209d3SPeter Maydell         trace_gicv3_its_read(offset, *data, size);
132718f6290aSShashi Mallela     }
132818f6290aSShashi Mallela     return MEMTX_OK;
132918f6290aSShashi Mallela }
133018f6290aSShashi Mallela 
133118f6290aSShashi Mallela static MemTxResult gicv3_its_write(void *opaque, hwaddr offset, uint64_t data,
133218f6290aSShashi Mallela                                    unsigned size, MemTxAttrs attrs)
133318f6290aSShashi Mallela {
133418f6290aSShashi Mallela     GICv3ITSState *s = (GICv3ITSState *)opaque;
133518f6290aSShashi Mallela     bool result;
133618f6290aSShashi Mallela 
133718f6290aSShashi Mallela     switch (size) {
133818f6290aSShashi Mallela     case 4:
133918f6290aSShashi Mallela         result = its_writel(s, offset, data, attrs);
134018f6290aSShashi Mallela         break;
134118f6290aSShashi Mallela     case 8:
134218f6290aSShashi Mallela         result = its_writell(s, offset, data, attrs);
134318f6290aSShashi Mallela         break;
134418f6290aSShashi Mallela     default:
134518f6290aSShashi Mallela         result = false;
134618f6290aSShashi Mallela         break;
134718f6290aSShashi Mallela     }
134818f6290aSShashi Mallela 
134918f6290aSShashi Mallela     if (!result) {
135018f6290aSShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
135118f6290aSShashi Mallela                       "%s: invalid guest write at offset " TARGET_FMT_plx
135218f6290aSShashi Mallela                       " size %u\n", __func__, offset, size);
1353195209d3SPeter Maydell         trace_gicv3_its_badwrite(offset, data, size);
135418f6290aSShashi Mallela         /*
135518f6290aSShashi Mallela          * The spec requires that reserved registers are RAZ/WI;
135618f6290aSShashi Mallela          * so use false returns from leaf functions as a way to
135718f6290aSShashi Mallela          * trigger the guest-error logging but don't return it to
135818f6290aSShashi Mallela          * the caller, or we'll cause a spurious guest data abort.
135918f6290aSShashi Mallela          */
1360195209d3SPeter Maydell     } else {
1361195209d3SPeter Maydell         trace_gicv3_its_write(offset, data, size);
136218f6290aSShashi Mallela     }
136318f6290aSShashi Mallela     return MEMTX_OK;
136418f6290aSShashi Mallela }
136518f6290aSShashi Mallela 
136618f6290aSShashi Mallela static const MemoryRegionOps gicv3_its_control_ops = {
136718f6290aSShashi Mallela     .read_with_attrs = gicv3_its_read,
136818f6290aSShashi Mallela     .write_with_attrs = gicv3_its_write,
136918f6290aSShashi Mallela     .valid.min_access_size = 4,
137018f6290aSShashi Mallela     .valid.max_access_size = 8,
137118f6290aSShashi Mallela     .impl.min_access_size = 4,
137218f6290aSShashi Mallela     .impl.max_access_size = 8,
137318f6290aSShashi Mallela     .endianness = DEVICE_NATIVE_ENDIAN,
137418f6290aSShashi Mallela };
137518f6290aSShashi Mallela 
137618f6290aSShashi Mallela static const MemoryRegionOps gicv3_its_translation_ops = {
13777e062b98SPeter Maydell     .read_with_attrs = gicv3_its_translation_read,
137818f6290aSShashi Mallela     .write_with_attrs = gicv3_its_translation_write,
137918f6290aSShashi Mallela     .valid.min_access_size = 2,
138018f6290aSShashi Mallela     .valid.max_access_size = 4,
138118f6290aSShashi Mallela     .impl.min_access_size = 2,
138218f6290aSShashi Mallela     .impl.max_access_size = 4,
138318f6290aSShashi Mallela     .endianness = DEVICE_NATIVE_ENDIAN,
138418f6290aSShashi Mallela };
138518f6290aSShashi Mallela 
138618f6290aSShashi Mallela static void gicv3_arm_its_realize(DeviceState *dev, Error **errp)
138718f6290aSShashi Mallela {
138818f6290aSShashi Mallela     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
138918f6290aSShashi Mallela     int i;
139018f6290aSShashi Mallela 
139118f6290aSShashi Mallela     for (i = 0; i < s->gicv3->num_cpu; i++) {
139218f6290aSShashi Mallela         if (!(s->gicv3->cpu[i].gicr_typer & GICR_TYPER_PLPIS)) {
139318f6290aSShashi Mallela             error_setg(errp, "Physical LPI not supported by CPU %d", i);
139418f6290aSShashi Mallela             return;
139518f6290aSShashi Mallela         }
139618f6290aSShashi Mallela     }
139718f6290aSShashi Mallela 
139818f6290aSShashi Mallela     gicv3_its_init_mmio(s, &gicv3_its_control_ops, &gicv3_its_translation_ops);
139918f6290aSShashi Mallela 
140018f6290aSShashi Mallela     /* set the ITS default features supported */
1401764d6ba1SPeter Maydell     s->typer = FIELD_DP64(s->typer, GITS_TYPER, PHYSICAL, 1);
140218f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, ITT_ENTRY_SIZE,
140318f6290aSShashi Mallela                           ITS_ITT_ENTRY_SIZE - 1);
140418f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, IDBITS, ITS_IDBITS);
140518f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, DEVBITS, ITS_DEVBITS);
140618f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, CIL, 1);
140718f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, CIDBITS, ITS_CIDBITS);
140818f6290aSShashi Mallela }
140918f6290aSShashi Mallela 
141018f6290aSShashi Mallela static void gicv3_its_reset(DeviceState *dev)
141118f6290aSShashi Mallela {
141218f6290aSShashi Mallela     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
141318f6290aSShashi Mallela     GICv3ITSClass *c = ARM_GICV3_ITS_GET_CLASS(s);
141418f6290aSShashi Mallela 
141518f6290aSShashi Mallela     c->parent_reset(dev);
141618f6290aSShashi Mallela 
141718f6290aSShashi Mallela     /* Quiescent bit reset to 1 */
141818f6290aSShashi Mallela     s->ctlr = FIELD_DP32(s->ctlr, GITS_CTLR, QUIESCENT, 1);
141918f6290aSShashi Mallela 
142018f6290aSShashi Mallela     /*
142118f6290aSShashi Mallela      * setting GITS_BASER0.Type = 0b001 (Device)
142218f6290aSShashi Mallela      *         GITS_BASER1.Type = 0b100 (Collection Table)
142318f6290aSShashi Mallela      *         GITS_BASER<n>.Type,where n = 3 to 7 are 0b00 (Unimplemented)
142418f6290aSShashi Mallela      *         GITS_BASER<0,1>.Page_Size = 64KB
142518f6290aSShashi Mallela      * and default translation table entry size to 16 bytes
142618f6290aSShashi Mallela      */
142718f6290aSShashi Mallela     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, TYPE,
142818f6290aSShashi Mallela                              GITS_BASER_TYPE_DEVICE);
142918f6290aSShashi Mallela     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, PAGESIZE,
143018f6290aSShashi Mallela                              GITS_BASER_PAGESIZE_64K);
143118f6290aSShashi Mallela     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, ENTRYSIZE,
143218f6290aSShashi Mallela                              GITS_DTE_SIZE - 1);
143318f6290aSShashi Mallela 
143418f6290aSShashi Mallela     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, TYPE,
143518f6290aSShashi Mallela                              GITS_BASER_TYPE_COLLECTION);
143618f6290aSShashi Mallela     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, PAGESIZE,
143718f6290aSShashi Mallela                              GITS_BASER_PAGESIZE_64K);
143818f6290aSShashi Mallela     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, ENTRYSIZE,
143918f6290aSShashi Mallela                              GITS_CTE_SIZE - 1);
144018f6290aSShashi Mallela }
144118f6290aSShashi Mallela 
14421b08e436SShashi Mallela static void gicv3_its_post_load(GICv3ITSState *s)
14431b08e436SShashi Mallela {
14448d2d6dd9SPeter Maydell     if (s->ctlr & R_GITS_CTLR_ENABLED_MASK) {
14451b08e436SShashi Mallela         extract_table_params(s);
14461b08e436SShashi Mallela         extract_cmdq_params(s);
14471b08e436SShashi Mallela     }
14481b08e436SShashi Mallela }
14491b08e436SShashi Mallela 
145018f6290aSShashi Mallela static Property gicv3_its_props[] = {
145118f6290aSShashi Mallela     DEFINE_PROP_LINK("parent-gicv3", GICv3ITSState, gicv3, "arm-gicv3",
145218f6290aSShashi Mallela                      GICv3State *),
145318f6290aSShashi Mallela     DEFINE_PROP_END_OF_LIST(),
145418f6290aSShashi Mallela };
145518f6290aSShashi Mallela 
145618f6290aSShashi Mallela static void gicv3_its_class_init(ObjectClass *klass, void *data)
145718f6290aSShashi Mallela {
145818f6290aSShashi Mallela     DeviceClass *dc = DEVICE_CLASS(klass);
145918f6290aSShashi Mallela     GICv3ITSClass *ic = ARM_GICV3_ITS_CLASS(klass);
14601b08e436SShashi Mallela     GICv3ITSCommonClass *icc = ARM_GICV3_ITS_COMMON_CLASS(klass);
146118f6290aSShashi Mallela 
146218f6290aSShashi Mallela     dc->realize = gicv3_arm_its_realize;
146318f6290aSShashi Mallela     device_class_set_props(dc, gicv3_its_props);
146418f6290aSShashi Mallela     device_class_set_parent_reset(dc, gicv3_its_reset, &ic->parent_reset);
14651b08e436SShashi Mallela     icc->post_load = gicv3_its_post_load;
146618f6290aSShashi Mallela }
146718f6290aSShashi Mallela 
146818f6290aSShashi Mallela static const TypeInfo gicv3_its_info = {
146918f6290aSShashi Mallela     .name = TYPE_ARM_GICV3_ITS,
147018f6290aSShashi Mallela     .parent = TYPE_ARM_GICV3_ITS_COMMON,
147118f6290aSShashi Mallela     .instance_size = sizeof(GICv3ITSState),
147218f6290aSShashi Mallela     .class_init = gicv3_its_class_init,
147318f6290aSShashi Mallela     .class_size = sizeof(GICv3ITSClass),
147418f6290aSShashi Mallela };
147518f6290aSShashi Mallela 
147618f6290aSShashi Mallela static void gicv3_its_register_types(void)
147718f6290aSShashi Mallela {
147818f6290aSShashi Mallela     type_register_static(&gicv3_its_info);
147918f6290aSShashi Mallela }
148018f6290aSShashi Mallela 
148118f6290aSShashi Mallela type_init(gicv3_its_register_types)
1482