xref: /qemu/hw/intc/arm_gicv3_its.c (revision 2a1990369719e3e202188236483bab0208a87d24)
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 }
383*2a199036SPeter Maydell 
384b6f96009SPeter Maydell static ItsCmdResult process_its_cmd(GICv3ITSState *s, const uint64_t *cmdpkt,
385b6f96009SPeter Maydell                                     ItsCmdType cmd)
386c694cb4cSShashi Mallela {
387b6f96009SPeter Maydell     uint32_t devid, eventid;
388b6f96009SPeter Maydell 
389b6f96009SPeter Maydell     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
390b6f96009SPeter Maydell     eventid = cmdpkt[1] & EVENTID_MASK;
391e4050980SPeter Maydell     switch (cmd) {
392e4050980SPeter Maydell     case INTERRUPT:
393e4050980SPeter Maydell         trace_gicv3_its_cmd_int(devid, eventid);
394e4050980SPeter Maydell         break;
395e4050980SPeter Maydell     case CLEAR:
396e4050980SPeter Maydell         trace_gicv3_its_cmd_clear(devid, eventid);
397e4050980SPeter Maydell         break;
398e4050980SPeter Maydell     case DISCARD:
399e4050980SPeter Maydell         trace_gicv3_its_cmd_discard(devid, eventid);
400e4050980SPeter Maydell         break;
401e4050980SPeter Maydell     default:
402e4050980SPeter Maydell         g_assert_not_reached();
403e4050980SPeter Maydell     }
404b6f96009SPeter Maydell     return do_process_its_cmd(s, devid, eventid, cmd);
405b6f96009SPeter Maydell }
406b6f96009SPeter Maydell 
407b6f96009SPeter Maydell static ItsCmdResult process_mapti(GICv3ITSState *s, const uint64_t *cmdpkt,
408b6f96009SPeter Maydell                                   bool ignore_pInt)
409b6f96009SPeter Maydell {
410c694cb4cSShashi Mallela     uint32_t devid, eventid;
411c694cb4cSShashi Mallela     uint32_t pIntid = 0;
4128f809f69SPeter Maydell     uint64_t num_eventids;
413905720f1SPeter Maydell     uint32_t num_intids;
414c694cb4cSShashi Mallela     uint16_t icid = 0;
4154acf93e1SPeter Maydell     DTEntry dte;
4167eb54267SPeter Maydell     ITEntry ite;
417c694cb4cSShashi Mallela 
418b6f96009SPeter Maydell     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
419b6f96009SPeter Maydell     eventid = cmdpkt[1] & EVENTID_MASK;
420e4050980SPeter Maydell     icid = cmdpkt[2] & ICID_MASK;
421c694cb4cSShashi Mallela 
422b87fab1cSPeter Maydell     if (ignore_pInt) {
423b87fab1cSPeter Maydell         pIntid = eventid;
424e4050980SPeter Maydell         trace_gicv3_its_cmd_mapi(devid, eventid, icid);
425b87fab1cSPeter Maydell     } else {
426b6f96009SPeter Maydell         pIntid = (cmdpkt[1] & pINTID_MASK) >> pINTID_SHIFT;
427e4050980SPeter Maydell         trace_gicv3_its_cmd_mapti(devid, eventid, icid, pIntid);
428c694cb4cSShashi Mallela     }
429c694cb4cSShashi Mallela 
4308b8bb014SPeter Maydell     if (devid >= s->dt.num_entries) {
431b13148d9SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
432b13148d9SPeter Maydell                       "%s: invalid command attributes: devid %d>=%d",
4338b8bb014SPeter Maydell                       __func__, devid, s->dt.num_entries);
434b13148d9SPeter Maydell         return CMD_CONTINUE;
435b13148d9SPeter Maydell     }
436b13148d9SPeter Maydell 
4374acf93e1SPeter Maydell     if (get_dte(s, devid, &dte) != MEMTX_OK) {
4380241f731SPeter Maydell         return CMD_STALL;
439c694cb4cSShashi Mallela     }
4404acf93e1SPeter Maydell     num_eventids = 1ULL << (dte.size + 1);
441905720f1SPeter Maydell     num_intids = 1ULL << (GICD_TYPER_IDBITS + 1);
442c694cb4cSShashi Mallela 
443d7d359c4SPeter Maydell     if (icid >= s->ct.num_entries) {
444c694cb4cSShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
445d7d359c4SPeter Maydell                       "%s: invalid ICID 0x%x >= 0x%x\n",
446d7d359c4SPeter Maydell                       __func__, icid, s->ct.num_entries);
447d7d359c4SPeter Maydell         return CMD_CONTINUE;
448d7d359c4SPeter Maydell     }
449d7d359c4SPeter Maydell 
450d7d359c4SPeter Maydell     if (!dte.valid) {
451d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
452d7d359c4SPeter Maydell                       "%s: no valid DTE for devid 0x%x\n", __func__, devid);
453d7d359c4SPeter Maydell         return CMD_CONTINUE;
454d7d359c4SPeter Maydell     }
455d7d359c4SPeter Maydell 
456d7d359c4SPeter Maydell     if (eventid >= num_eventids) {
457d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
458d7d359c4SPeter Maydell                       "%s: invalid event ID 0x%x >= 0x%" PRIx64 "\n",
459d7d359c4SPeter Maydell                       __func__, eventid, num_eventids);
460d7d359c4SPeter Maydell         return CMD_CONTINUE;
461d7d359c4SPeter Maydell     }
462d7d359c4SPeter Maydell 
463d7d359c4SPeter Maydell     if (pIntid < GICV3_LPI_INTID_START || pIntid >= num_intids) {
464d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
465d7d359c4SPeter Maydell                       "%s: invalid interrupt ID 0x%x\n", __func__, pIntid);
4660241f731SPeter Maydell         return CMD_CONTINUE;
4670241f731SPeter Maydell     }
4680241f731SPeter Maydell 
469c694cb4cSShashi Mallela     /* add ite entry to interrupt translation table */
4707eb54267SPeter Maydell     ite.valid = true;
4717eb54267SPeter Maydell     ite.inttype = ITE_INTTYPE_PHYSICAL;
4727eb54267SPeter Maydell     ite.intid = pIntid;
4737eb54267SPeter Maydell     ite.icid = icid;
4747eb54267SPeter Maydell     ite.doorbell = INTID_SPURIOUS;
4757eb54267SPeter Maydell     ite.vpeid = 0;
4767eb54267SPeter Maydell     return update_ite(s, eventid, &dte, &ite) ? CMD_CONTINUE : CMD_STALL;
477c694cb4cSShashi Mallela }
478c694cb4cSShashi Mallela 
47906985cc3SPeter Maydell /*
48006985cc3SPeter Maydell  * Update the Collection Table entry for @icid to @cte. Returns true
48106985cc3SPeter Maydell  * on success, false if there was a memory access error.
48206985cc3SPeter Maydell  */
48306985cc3SPeter Maydell static bool update_cte(GICv3ITSState *s, uint16_t icid, const CTEntry *cte)
4847eca39e0SShashi Mallela {
4857eca39e0SShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
486d050f80fSPeter Maydell     uint64_t entry_addr;
48706985cc3SPeter Maydell     uint64_t cteval = 0;
4887eca39e0SShashi Mallela     MemTxResult res = MEMTX_OK;
4897eca39e0SShashi Mallela 
490930f40e9SPeter Maydell     trace_gicv3_its_cte_write(icid, cte->valid, cte->rdbase);
491930f40e9SPeter Maydell 
49206985cc3SPeter Maydell     if (cte->valid) {
4937eca39e0SShashi Mallela         /* add mapping entry to collection table */
49406985cc3SPeter Maydell         cteval = FIELD_DP64(cteval, CTE, VALID, 1);
49506985cc3SPeter Maydell         cteval = FIELD_DP64(cteval, CTE, RDBASE, cte->rdbase);
4967eca39e0SShashi Mallela     }
4977eca39e0SShashi Mallela 
498d050f80fSPeter Maydell     entry_addr = table_entry_addr(s, &s->ct, icid, &res);
4997eca39e0SShashi Mallela     if (res != MEMTX_OK) {
500d050f80fSPeter Maydell         /* memory access error: stall */
5017eca39e0SShashi Mallela         return false;
5027eca39e0SShashi Mallela     }
503d050f80fSPeter Maydell     if (entry_addr == -1) {
504d050f80fSPeter Maydell         /* No L2 table for this index: discard write and continue */
5057eca39e0SShashi Mallela         return true;
5067eca39e0SShashi Mallela     }
507d050f80fSPeter Maydell 
50806985cc3SPeter Maydell     address_space_stq_le(as, entry_addr, cteval, MEMTXATTRS_UNSPECIFIED, &res);
509d050f80fSPeter Maydell     return res == MEMTX_OK;
5107eca39e0SShashi Mallela }
5117eca39e0SShashi Mallela 
512b6f96009SPeter Maydell static ItsCmdResult process_mapc(GICv3ITSState *s, const uint64_t *cmdpkt)
5137eca39e0SShashi Mallela {
5147eca39e0SShashi Mallela     uint16_t icid;
51506985cc3SPeter Maydell     CTEntry cte;
5167eca39e0SShashi Mallela 
517b6f96009SPeter Maydell     icid = cmdpkt[2] & ICID_MASK;
51884d43d2eSPeter Maydell     cte.valid = cmdpkt[2] & CMD_FIELD_VALID_MASK;
51984d43d2eSPeter Maydell     if (cte.valid) {
52006985cc3SPeter Maydell         cte.rdbase = (cmdpkt[2] & R_MAPC_RDBASE_MASK) >> R_MAPC_RDBASE_SHIFT;
52106985cc3SPeter Maydell         cte.rdbase &= RDBASE_PROCNUM_MASK;
52284d43d2eSPeter Maydell     } else {
52384d43d2eSPeter Maydell         cte.rdbase = 0;
52484d43d2eSPeter Maydell     }
525e4050980SPeter Maydell     trace_gicv3_its_cmd_mapc(icid, cte.rdbase, cte.valid);
5267eca39e0SShashi Mallela 
52784d43d2eSPeter Maydell     if (icid >= s->ct.num_entries) {
528c7ca3ad5SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR, "ITS MAPC: invalid ICID 0x%x\n", icid);
52984d43d2eSPeter Maydell         return CMD_CONTINUE;
53084d43d2eSPeter Maydell     }
53184d43d2eSPeter Maydell     if (cte.valid && cte.rdbase >= s->gicv3->num_cpu) {
5327eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
533c7ca3ad5SPeter Maydell                       "ITS MAPC: invalid RDBASE %u\n", cte.rdbase);
534f6675196SPeter Maydell         return CMD_CONTINUE;
5357eca39e0SShashi Mallela     }
5367eca39e0SShashi Mallela 
53706985cc3SPeter Maydell     return update_cte(s, icid, &cte) ? CMD_CONTINUE : CMD_STALL;
5387eca39e0SShashi Mallela }
5397eca39e0SShashi Mallela 
54022d62b08SPeter Maydell /*
54122d62b08SPeter Maydell  * Update the Device Table entry for @devid to @dte. Returns true
54222d62b08SPeter Maydell  * on success, false if there was a memory access error.
54322d62b08SPeter Maydell  */
54422d62b08SPeter Maydell static bool update_dte(GICv3ITSState *s, uint32_t devid, const DTEntry *dte)
5457eca39e0SShashi Mallela {
5467eca39e0SShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
547d050f80fSPeter Maydell     uint64_t entry_addr;
54822d62b08SPeter Maydell     uint64_t dteval = 0;
5497eca39e0SShashi Mallela     MemTxResult res = MEMTX_OK;
5507eca39e0SShashi Mallela 
551930f40e9SPeter Maydell     trace_gicv3_its_dte_write(devid, dte->valid, dte->size, dte->ittaddr);
552930f40e9SPeter Maydell 
55322d62b08SPeter Maydell     if (dte->valid) {
5547eca39e0SShashi Mallela         /* add mapping entry to device table */
55522d62b08SPeter Maydell         dteval = FIELD_DP64(dteval, DTE, VALID, 1);
55622d62b08SPeter Maydell         dteval = FIELD_DP64(dteval, DTE, SIZE, dte->size);
55722d62b08SPeter Maydell         dteval = FIELD_DP64(dteval, DTE, ITTADDR, dte->ittaddr);
5587eca39e0SShashi Mallela     }
5597eca39e0SShashi Mallela 
560d050f80fSPeter Maydell     entry_addr = table_entry_addr(s, &s->dt, devid, &res);
5617eca39e0SShashi Mallela     if (res != MEMTX_OK) {
562d050f80fSPeter Maydell         /* memory access error: stall */
5637eca39e0SShashi Mallela         return false;
5647eca39e0SShashi Mallela     }
565d050f80fSPeter Maydell     if (entry_addr == -1) {
566d050f80fSPeter Maydell         /* No L2 table for this index: discard write and continue */
5677eca39e0SShashi Mallela         return true;
5687eca39e0SShashi Mallela     }
56922d62b08SPeter Maydell     address_space_stq_le(as, entry_addr, dteval, MEMTXATTRS_UNSPECIFIED, &res);
570d050f80fSPeter Maydell     return res == MEMTX_OK;
5717eca39e0SShashi Mallela }
5727eca39e0SShashi Mallela 
573b6f96009SPeter Maydell static ItsCmdResult process_mapd(GICv3ITSState *s, const uint64_t *cmdpkt)
5747eca39e0SShashi Mallela {
5757eca39e0SShashi Mallela     uint32_t devid;
57622d62b08SPeter Maydell     DTEntry dte;
5777eca39e0SShashi Mallela 
578b6f96009SPeter Maydell     devid = (cmdpkt[0] & DEVID_MASK) >> DEVID_SHIFT;
57922d62b08SPeter Maydell     dte.size = cmdpkt[1] & SIZE_MASK;
58022d62b08SPeter Maydell     dte.ittaddr = (cmdpkt[2] & ITTADDR_MASK) >> ITTADDR_SHIFT;
58122d62b08SPeter Maydell     dte.valid = cmdpkt[2] & CMD_FIELD_VALID_MASK;
5827eca39e0SShashi Mallela 
583e4050980SPeter Maydell     trace_gicv3_its_cmd_mapd(devid, dte.size, dte.ittaddr, dte.valid);
584e4050980SPeter Maydell 
585d7d359c4SPeter Maydell     if (devid >= s->dt.num_entries) {
5867eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
587d7d359c4SPeter Maydell                       "ITS MAPD: invalid device ID field 0x%x >= 0x%x\n",
588d7d359c4SPeter Maydell                       devid, s->dt.num_entries);
589d7d359c4SPeter Maydell         return CMD_CONTINUE;
590d7d359c4SPeter Maydell     }
591d7d359c4SPeter Maydell 
592d7d359c4SPeter Maydell     if (dte.size > FIELD_EX64(s->typer, GITS_TYPER, IDBITS)) {
593d7d359c4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
594d7d359c4SPeter Maydell                       "ITS MAPD: invalid size %d\n", dte.size);
59500d46e72SPeter Maydell         return CMD_CONTINUE;
5967eca39e0SShashi Mallela     }
5977eca39e0SShashi Mallela 
59822d62b08SPeter Maydell     return update_dte(s, devid, &dte) ? CMD_CONTINUE : CMD_STALL;
5997eca39e0SShashi Mallela }
6007eca39e0SShashi Mallela 
601b6f96009SPeter Maydell static ItsCmdResult process_movall(GICv3ITSState *s, const uint64_t *cmdpkt)
602f6d1d9b4SPeter Maydell {
603f6d1d9b4SPeter Maydell     uint64_t rd1, rd2;
604f6d1d9b4SPeter Maydell 
605b6f96009SPeter Maydell     rd1 = FIELD_EX64(cmdpkt[2], MOVALL_2, RDBASE1);
606b6f96009SPeter Maydell     rd2 = FIELD_EX64(cmdpkt[3], MOVALL_3, RDBASE2);
607f6d1d9b4SPeter Maydell 
608e4050980SPeter Maydell     trace_gicv3_its_cmd_movall(rd1, rd2);
609e4050980SPeter Maydell 
610f6d1d9b4SPeter Maydell     if (rd1 >= s->gicv3->num_cpu) {
611f6d1d9b4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
612f6d1d9b4SPeter Maydell                       "%s: RDBASE1 %" PRId64
613f6d1d9b4SPeter Maydell                       " out of range (must be less than %d)\n",
614f6d1d9b4SPeter Maydell                       __func__, rd1, s->gicv3->num_cpu);
615f6d1d9b4SPeter Maydell         return CMD_CONTINUE;
616f6d1d9b4SPeter Maydell     }
617f6d1d9b4SPeter Maydell     if (rd2 >= s->gicv3->num_cpu) {
618f6d1d9b4SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
619f6d1d9b4SPeter Maydell                       "%s: RDBASE2 %" PRId64
620f6d1d9b4SPeter Maydell                       " out of range (must be less than %d)\n",
621f6d1d9b4SPeter Maydell                       __func__, rd2, s->gicv3->num_cpu);
622f6d1d9b4SPeter Maydell         return CMD_CONTINUE;
623f6d1d9b4SPeter Maydell     }
624f6d1d9b4SPeter Maydell 
625f6d1d9b4SPeter Maydell     if (rd1 == rd2) {
626f6d1d9b4SPeter Maydell         /* Move to same target must succeed as a no-op */
627f6d1d9b4SPeter Maydell         return CMD_CONTINUE;
628f6d1d9b4SPeter Maydell     }
629f6d1d9b4SPeter Maydell 
630f6d1d9b4SPeter Maydell     /* Move all pending LPIs from redistributor 1 to redistributor 2 */
631f6d1d9b4SPeter Maydell     gicv3_redist_movall_lpis(&s->gicv3->cpu[rd1], &s->gicv3->cpu[rd2]);
632f6d1d9b4SPeter Maydell 
633f6d1d9b4SPeter Maydell     return CMD_CONTINUE;
634f6d1d9b4SPeter Maydell }
635f6d1d9b4SPeter Maydell 
636b6f96009SPeter Maydell static ItsCmdResult process_movi(GICv3ITSState *s, const uint64_t *cmdpkt)
637961b4912SPeter Maydell {
638244194feSPeter Maydell     uint32_t devid, eventid;
639244194feSPeter Maydell     uint16_t new_icid;
640961b4912SPeter Maydell     uint64_t num_eventids;
6414acf93e1SPeter Maydell     DTEntry dte;
642d37cf49bSPeter Maydell     CTEntry old_cte, new_cte;
643244194feSPeter Maydell     ITEntry old_ite;
644961b4912SPeter Maydell 
645b6f96009SPeter Maydell     devid = FIELD_EX64(cmdpkt[0], MOVI_0, DEVICEID);
646b6f96009SPeter Maydell     eventid = FIELD_EX64(cmdpkt[1], MOVI_1, EVENTID);
647b6f96009SPeter Maydell     new_icid = FIELD_EX64(cmdpkt[2], MOVI_2, ICID);
648961b4912SPeter Maydell 
649e4050980SPeter Maydell     trace_gicv3_its_cmd_movi(devid, eventid, new_icid);
650e4050980SPeter Maydell 
651961b4912SPeter Maydell     if (devid >= s->dt.num_entries) {
652961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
653961b4912SPeter Maydell                       "%s: invalid command attributes: devid %d>=%d",
654961b4912SPeter Maydell                       __func__, devid, s->dt.num_entries);
655961b4912SPeter Maydell         return CMD_CONTINUE;
656961b4912SPeter Maydell     }
6574acf93e1SPeter Maydell     if (get_dte(s, devid, &dte) != MEMTX_OK) {
658961b4912SPeter Maydell         return CMD_STALL;
659961b4912SPeter Maydell     }
660961b4912SPeter Maydell 
6614acf93e1SPeter Maydell     if (!dte.valid) {
662961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
663961b4912SPeter Maydell                       "%s: invalid command attributes: "
6644acf93e1SPeter Maydell                       "invalid dte for %d\n", __func__, devid);
665961b4912SPeter Maydell         return CMD_CONTINUE;
666961b4912SPeter Maydell     }
667961b4912SPeter Maydell 
6684acf93e1SPeter Maydell     num_eventids = 1ULL << (dte.size + 1);
669961b4912SPeter Maydell     if (eventid >= num_eventids) {
670961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
671961b4912SPeter Maydell                       "%s: invalid command attributes: eventid %d >= %"
672961b4912SPeter Maydell                       PRId64 "\n",
673961b4912SPeter Maydell                       __func__, eventid, num_eventids);
674961b4912SPeter Maydell         return CMD_CONTINUE;
675961b4912SPeter Maydell     }
676961b4912SPeter Maydell 
677244194feSPeter Maydell     if (get_ite(s, eventid, &dte, &old_ite) != MEMTX_OK) {
678961b4912SPeter Maydell         return CMD_STALL;
679961b4912SPeter Maydell     }
680961b4912SPeter Maydell 
681244194feSPeter Maydell     if (!old_ite.valid || old_ite.inttype != ITE_INTTYPE_PHYSICAL) {
682961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
683961b4912SPeter Maydell                       "%s: invalid command attributes: invalid ITE\n",
684961b4912SPeter Maydell                       __func__);
685961b4912SPeter Maydell         return CMD_CONTINUE;
686961b4912SPeter Maydell     }
687961b4912SPeter Maydell 
688244194feSPeter Maydell     if (old_ite.icid >= s->ct.num_entries) {
689961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
690961b4912SPeter Maydell                       "%s: invalid ICID 0x%x in ITE (table corrupted?)\n",
691244194feSPeter Maydell                       __func__, old_ite.icid);
692961b4912SPeter Maydell         return CMD_CONTINUE;
693961b4912SPeter Maydell     }
694961b4912SPeter Maydell 
695961b4912SPeter Maydell     if (new_icid >= s->ct.num_entries) {
696961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
697961b4912SPeter Maydell                       "%s: invalid command attributes: ICID 0x%x\n",
698961b4912SPeter Maydell                       __func__, new_icid);
699961b4912SPeter Maydell         return CMD_CONTINUE;
700961b4912SPeter Maydell     }
701961b4912SPeter Maydell 
702244194feSPeter Maydell     if (get_cte(s, old_ite.icid, &old_cte) != MEMTX_OK) {
703961b4912SPeter Maydell         return CMD_STALL;
704961b4912SPeter Maydell     }
705d37cf49bSPeter Maydell     if (!old_cte.valid) {
706961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
707961b4912SPeter Maydell                       "%s: invalid command attributes: "
708d37cf49bSPeter Maydell                       "invalid CTE for old ICID 0x%x\n",
709244194feSPeter Maydell                       __func__, old_ite.icid);
710961b4912SPeter Maydell         return CMD_CONTINUE;
711961b4912SPeter Maydell     }
712961b4912SPeter Maydell 
713d37cf49bSPeter Maydell     if (get_cte(s, new_icid, &new_cte) != MEMTX_OK) {
714961b4912SPeter Maydell         return CMD_STALL;
715961b4912SPeter Maydell     }
716d37cf49bSPeter Maydell     if (!new_cte.valid) {
717961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
718961b4912SPeter Maydell                       "%s: invalid command attributes: "
719d37cf49bSPeter Maydell                       "invalid CTE for new ICID 0x%x\n",
720d37cf49bSPeter Maydell                       __func__, new_icid);
721961b4912SPeter Maydell         return CMD_CONTINUE;
722961b4912SPeter Maydell     }
723961b4912SPeter Maydell 
724d37cf49bSPeter Maydell     if (old_cte.rdbase >= s->gicv3->num_cpu) {
725961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
726d37cf49bSPeter Maydell                       "%s: CTE has invalid rdbase 0x%x\n",
727d37cf49bSPeter Maydell                       __func__, old_cte.rdbase);
728961b4912SPeter Maydell         return CMD_CONTINUE;
729961b4912SPeter Maydell     }
730961b4912SPeter Maydell 
731d37cf49bSPeter Maydell     if (new_cte.rdbase >= s->gicv3->num_cpu) {
732961b4912SPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
733d37cf49bSPeter Maydell                       "%s: CTE has invalid rdbase 0x%x\n",
734d37cf49bSPeter Maydell                       __func__, new_cte.rdbase);
735961b4912SPeter Maydell         return CMD_CONTINUE;
736961b4912SPeter Maydell     }
737961b4912SPeter Maydell 
738d37cf49bSPeter Maydell     if (old_cte.rdbase != new_cte.rdbase) {
739961b4912SPeter Maydell         /* Move the LPI from the old redistributor to the new one */
740d37cf49bSPeter Maydell         gicv3_redist_mov_lpi(&s->gicv3->cpu[old_cte.rdbase],
741d37cf49bSPeter Maydell                              &s->gicv3->cpu[new_cte.rdbase],
742244194feSPeter Maydell                              old_ite.intid);
743961b4912SPeter Maydell     }
744961b4912SPeter Maydell 
745961b4912SPeter Maydell     /* Update the ICID field in the interrupt translation table entry */
7467eb54267SPeter Maydell     old_ite.icid = new_icid;
7477eb54267SPeter Maydell     return update_ite(s, eventid, &dte, &old_ite) ? CMD_CONTINUE : CMD_STALL;
748961b4912SPeter Maydell }
749961b4912SPeter Maydell 
7507eca39e0SShashi Mallela /*
7517eca39e0SShashi Mallela  * Current implementation blocks until all
7527eca39e0SShashi Mallela  * commands are processed
7537eca39e0SShashi Mallela  */
7547eca39e0SShashi Mallela static void process_cmdq(GICv3ITSState *s)
7557eca39e0SShashi Mallela {
7567eca39e0SShashi Mallela     uint32_t wr_offset = 0;
7577eca39e0SShashi Mallela     uint32_t rd_offset = 0;
7587eca39e0SShashi Mallela     uint32_t cq_offset = 0;
7597eca39e0SShashi Mallela     AddressSpace *as = &s->gicv3->dma_as;
7607eca39e0SShashi Mallela     uint8_t cmd;
76117fb5e36SShashi Mallela     int i;
7627eca39e0SShashi Mallela 
7638d2d6dd9SPeter Maydell     if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
7647eca39e0SShashi Mallela         return;
7657eca39e0SShashi Mallela     }
7667eca39e0SShashi Mallela 
7677eca39e0SShashi Mallela     wr_offset = FIELD_EX64(s->cwriter, GITS_CWRITER, OFFSET);
7687eca39e0SShashi Mallela 
76980dcd37fSPeter Maydell     if (wr_offset >= s->cq.num_entries) {
7707eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
7717eca39e0SShashi Mallela                       "%s: invalid write offset "
7727eca39e0SShashi Mallela                       "%d\n", __func__, wr_offset);
7737eca39e0SShashi Mallela         return;
7747eca39e0SShashi Mallela     }
7757eca39e0SShashi Mallela 
7767eca39e0SShashi Mallela     rd_offset = FIELD_EX64(s->creadr, GITS_CREADR, OFFSET);
7777eca39e0SShashi Mallela 
77880dcd37fSPeter Maydell     if (rd_offset >= s->cq.num_entries) {
7797eca39e0SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
7807eca39e0SShashi Mallela                       "%s: invalid read offset "
7817eca39e0SShashi Mallela                       "%d\n", __func__, rd_offset);
7827eca39e0SShashi Mallela         return;
7837eca39e0SShashi Mallela     }
7847eca39e0SShashi Mallela 
7857eca39e0SShashi Mallela     while (wr_offset != rd_offset) {
786ef011555SPeter Maydell         ItsCmdResult result = CMD_CONTINUE;
787b6f96009SPeter Maydell         void *hostmem;
788b6f96009SPeter Maydell         hwaddr buflen;
789b6f96009SPeter Maydell         uint64_t cmdpkt[GITS_CMDQ_ENTRY_WORDS];
790ef011555SPeter Maydell 
7917eca39e0SShashi Mallela         cq_offset = (rd_offset * GITS_CMDQ_ENTRY_SIZE);
792b6f96009SPeter Maydell 
793b6f96009SPeter Maydell         buflen = GITS_CMDQ_ENTRY_SIZE;
794b6f96009SPeter Maydell         hostmem = address_space_map(as, s->cq.base_addr + cq_offset,
795b6f96009SPeter Maydell                                     &buflen, false, MEMTXATTRS_UNSPECIFIED);
796b6f96009SPeter Maydell         if (!hostmem || buflen != GITS_CMDQ_ENTRY_SIZE) {
797b6f96009SPeter Maydell             if (hostmem) {
798b6f96009SPeter Maydell                 address_space_unmap(as, hostmem, buflen, false, 0);
799b6f96009SPeter Maydell             }
800f0b4b2a2SPeter Maydell             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, STALLED, 1);
801f0b4b2a2SPeter Maydell             qemu_log_mask(LOG_GUEST_ERROR,
802f0b4b2a2SPeter Maydell                           "%s: could not read command at 0x%" PRIx64 "\n",
803f0b4b2a2SPeter Maydell                           __func__, s->cq.base_addr + cq_offset);
804f0b4b2a2SPeter Maydell             break;
8057eca39e0SShashi Mallela         }
806b6f96009SPeter Maydell         for (i = 0; i < ARRAY_SIZE(cmdpkt); i++) {
807b6f96009SPeter Maydell             cmdpkt[i] = ldq_le_p(hostmem + i * sizeof(uint64_t));
808b6f96009SPeter Maydell         }
809b6f96009SPeter Maydell         address_space_unmap(as, hostmem, buflen, false, 0);
810f0b4b2a2SPeter Maydell 
811b6f96009SPeter Maydell         cmd = cmdpkt[0] & CMD_MASK;
8127eca39e0SShashi Mallela 
813195209d3SPeter Maydell         trace_gicv3_its_process_command(rd_offset, cmd);
814195209d3SPeter Maydell 
8157eca39e0SShashi Mallela         switch (cmd) {
8167eca39e0SShashi Mallela         case GITS_CMD_INT:
817b6f96009SPeter Maydell             result = process_its_cmd(s, cmdpkt, INTERRUPT);
8187eca39e0SShashi Mallela             break;
8197eca39e0SShashi Mallela         case GITS_CMD_CLEAR:
820b6f96009SPeter Maydell             result = process_its_cmd(s, cmdpkt, CLEAR);
8217eca39e0SShashi Mallela             break;
8227eca39e0SShashi Mallela         case GITS_CMD_SYNC:
8237eca39e0SShashi Mallela             /*
8247eca39e0SShashi Mallela              * Current implementation makes a blocking synchronous call
8257eca39e0SShashi Mallela              * for every command issued earlier, hence the internal state
8267eca39e0SShashi Mallela              * is already consistent by the time SYNC command is executed.
8277eca39e0SShashi Mallela              * Hence no further processing is required for SYNC command.
8287eca39e0SShashi Mallela              */
829e4050980SPeter Maydell             trace_gicv3_its_cmd_sync();
8307eca39e0SShashi Mallela             break;
8317eca39e0SShashi Mallela         case GITS_CMD_MAPD:
832b6f96009SPeter Maydell             result = process_mapd(s, cmdpkt);
8337eca39e0SShashi Mallela             break;
8347eca39e0SShashi Mallela         case GITS_CMD_MAPC:
835b6f96009SPeter Maydell             result = process_mapc(s, cmdpkt);
8367eca39e0SShashi Mallela             break;
8377eca39e0SShashi Mallela         case GITS_CMD_MAPTI:
838b6f96009SPeter Maydell             result = process_mapti(s, cmdpkt, false);
8397eca39e0SShashi Mallela             break;
8407eca39e0SShashi Mallela         case GITS_CMD_MAPI:
841b6f96009SPeter Maydell             result = process_mapti(s, cmdpkt, true);
8427eca39e0SShashi Mallela             break;
8437eca39e0SShashi Mallela         case GITS_CMD_DISCARD:
844b6f96009SPeter Maydell             result = process_its_cmd(s, cmdpkt, DISCARD);
8457eca39e0SShashi Mallela             break;
8467eca39e0SShashi Mallela         case GITS_CMD_INV:
8477eca39e0SShashi Mallela         case GITS_CMD_INVALL:
84817fb5e36SShashi Mallela             /*
84917fb5e36SShashi Mallela              * Current implementation doesn't cache any ITS tables,
85017fb5e36SShashi Mallela              * but the calculated lpi priority information. We only
85117fb5e36SShashi Mallela              * need to trigger lpi priority re-calculation to be in
85217fb5e36SShashi Mallela              * sync with LPI config table or pending table changes.
85317fb5e36SShashi Mallela              */
854e4050980SPeter Maydell             trace_gicv3_its_cmd_inv();
85517fb5e36SShashi Mallela             for (i = 0; i < s->gicv3->num_cpu; i++) {
85617fb5e36SShashi Mallela                 gicv3_redist_update_lpi(&s->gicv3->cpu[i]);
85717fb5e36SShashi Mallela             }
8587eca39e0SShashi Mallela             break;
859961b4912SPeter Maydell         case GITS_CMD_MOVI:
860b6f96009SPeter Maydell             result = process_movi(s, cmdpkt);
861961b4912SPeter Maydell             break;
862f6d1d9b4SPeter Maydell         case GITS_CMD_MOVALL:
863b6f96009SPeter Maydell             result = process_movall(s, cmdpkt);
864f6d1d9b4SPeter Maydell             break;
8657eca39e0SShashi Mallela         default:
866e4050980SPeter Maydell             trace_gicv3_its_cmd_unknown(cmd);
8677eca39e0SShashi Mallela             break;
8687eca39e0SShashi Mallela         }
869ef011555SPeter Maydell         if (result == CMD_CONTINUE) {
8707eca39e0SShashi Mallela             rd_offset++;
87180dcd37fSPeter Maydell             rd_offset %= s->cq.num_entries;
8727eca39e0SShashi Mallela             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, OFFSET, rd_offset);
8737eca39e0SShashi Mallela         } else {
874ef011555SPeter Maydell             /* CMD_STALL */
8757eca39e0SShashi Mallela             s->creadr = FIELD_DP64(s->creadr, GITS_CREADR, STALLED, 1);
8767eca39e0SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
877ef011555SPeter Maydell                           "%s: 0x%x cmd processing failed, stalling\n",
878ef011555SPeter Maydell                           __func__, cmd);
8797eca39e0SShashi Mallela             break;
8807eca39e0SShashi Mallela         }
8817eca39e0SShashi Mallela     }
8827eca39e0SShashi Mallela }
8837eca39e0SShashi Mallela 
8841b08e436SShashi Mallela /*
8851b08e436SShashi Mallela  * This function extracts the ITS Device and Collection table specific
8861b08e436SShashi Mallela  * parameters (like base_addr, size etc) from GITS_BASER register.
8871b08e436SShashi Mallela  * It is called during ITS enable and also during post_load migration
8881b08e436SShashi Mallela  */
8891b08e436SShashi Mallela static void extract_table_params(GICv3ITSState *s)
8901b08e436SShashi Mallela {
8911b08e436SShashi Mallela     uint16_t num_pages = 0;
8921b08e436SShashi Mallela     uint8_t  page_sz_type;
8931b08e436SShashi Mallela     uint8_t type;
8941b08e436SShashi Mallela     uint32_t page_sz = 0;
8951b08e436SShashi Mallela     uint64_t value;
8961b08e436SShashi Mallela 
8971b08e436SShashi Mallela     for (int i = 0; i < 8; i++) {
898e5487a41SPeter Maydell         TableDesc *td;
899e5487a41SPeter Maydell         int idbits;
900e5487a41SPeter Maydell 
9011b08e436SShashi Mallela         value = s->baser[i];
9021b08e436SShashi Mallela 
9031b08e436SShashi Mallela         if (!value) {
9041b08e436SShashi Mallela             continue;
9051b08e436SShashi Mallela         }
9061b08e436SShashi Mallela 
9071b08e436SShashi Mallela         page_sz_type = FIELD_EX64(value, GITS_BASER, PAGESIZE);
9081b08e436SShashi Mallela 
9091b08e436SShashi Mallela         switch (page_sz_type) {
9101b08e436SShashi Mallela         case 0:
9111b08e436SShashi Mallela             page_sz = GITS_PAGE_SIZE_4K;
9121b08e436SShashi Mallela             break;
9131b08e436SShashi Mallela 
9141b08e436SShashi Mallela         case 1:
9151b08e436SShashi Mallela             page_sz = GITS_PAGE_SIZE_16K;
9161b08e436SShashi Mallela             break;
9171b08e436SShashi Mallela 
9181b08e436SShashi Mallela         case 2:
9191b08e436SShashi Mallela         case 3:
9201b08e436SShashi Mallela             page_sz = GITS_PAGE_SIZE_64K;
9211b08e436SShashi Mallela             break;
9221b08e436SShashi Mallela 
9231b08e436SShashi Mallela         default:
9241b08e436SShashi Mallela             g_assert_not_reached();
9251b08e436SShashi Mallela         }
9261b08e436SShashi Mallela 
9271b08e436SShashi Mallela         num_pages = FIELD_EX64(value, GITS_BASER, SIZE) + 1;
9281b08e436SShashi Mallela 
9291b08e436SShashi Mallela         type = FIELD_EX64(value, GITS_BASER, TYPE);
9301b08e436SShashi Mallela 
9311b08e436SShashi Mallela         switch (type) {
9321b08e436SShashi Mallela         case GITS_BASER_TYPE_DEVICE:
933e5487a41SPeter Maydell             td = &s->dt;
934e5487a41SPeter Maydell             idbits = FIELD_EX64(s->typer, GITS_TYPER, DEVBITS) + 1;
93562df780eSPeter Maydell             break;
9361b08e436SShashi Mallela         case GITS_BASER_TYPE_COLLECTION:
937e5487a41SPeter Maydell             td = &s->ct;
9381b08e436SShashi Mallela             if (FIELD_EX64(s->typer, GITS_TYPER, CIL)) {
939e5487a41SPeter Maydell                 idbits = FIELD_EX64(s->typer, GITS_TYPER, CIDBITS) + 1;
9401b08e436SShashi Mallela             } else {
9411b08e436SShashi Mallela                 /* 16-bit CollectionId supported when CIL == 0 */
942e5487a41SPeter Maydell                 idbits = 16;
9431b08e436SShashi Mallela             }
9441b08e436SShashi Mallela             break;
9451b08e436SShashi Mallela         default:
946e5487a41SPeter Maydell             /*
947e5487a41SPeter Maydell              * GITS_BASER<n>.TYPE is read-only, so GITS_BASER_RO_MASK
948e5487a41SPeter Maydell              * ensures we will only see type values corresponding to
949e5487a41SPeter Maydell              * the values set up in gicv3_its_reset().
950e5487a41SPeter Maydell              */
951e5487a41SPeter Maydell             g_assert_not_reached();
9521b08e436SShashi Mallela         }
953e5487a41SPeter Maydell 
954e5487a41SPeter Maydell         memset(td, 0, sizeof(*td));
955e5487a41SPeter Maydell         /*
956e5487a41SPeter Maydell          * If GITS_BASER<n>.Valid is 0 for any <n> then we will not process
957e5487a41SPeter Maydell          * interrupts. (GITS_TYPER.HCC is 0 for this implementation, so we
958e5487a41SPeter Maydell          * do not have a special case where the GITS_BASER<n>.Valid bit is 0
959e5487a41SPeter Maydell          * for the register corresponding to the Collection table but we
960e5487a41SPeter Maydell          * still have to process interrupts using non-memory-backed
961e5487a41SPeter Maydell          * Collection table entries.)
962da4680ceSPeter Maydell          * The specification makes it UNPREDICTABLE to enable the ITS without
963da4680ceSPeter Maydell          * marking each BASER<n> as valid. We choose to handle these as if
964da4680ceSPeter Maydell          * the table was zero-sized, so commands using the table will fail
965da4680ceSPeter Maydell          * and interrupts requested via GITS_TRANSLATER writes will be ignored.
966da4680ceSPeter Maydell          * This happens automatically by leaving the num_entries field at
967da4680ceSPeter Maydell          * zero, which will be caught by the bounds checks we have before
968da4680ceSPeter Maydell          * every table lookup anyway.
969e5487a41SPeter Maydell          */
970da4680ceSPeter Maydell         if (!FIELD_EX64(value, GITS_BASER, VALID)) {
971e5487a41SPeter Maydell             continue;
972e5487a41SPeter Maydell         }
973e5487a41SPeter Maydell         td->page_sz = page_sz;
974e5487a41SPeter Maydell         td->indirect = FIELD_EX64(value, GITS_BASER, INDIRECT);
9759ae85431SPeter Maydell         td->entry_sz = FIELD_EX64(value, GITS_BASER, ENTRYSIZE) + 1;
976e5487a41SPeter Maydell         td->base_addr = baser_base_addr(value, page_sz);
977e5487a41SPeter Maydell         if (!td->indirect) {
97880dcd37fSPeter Maydell             td->num_entries = (num_pages * page_sz) / td->entry_sz;
979e5487a41SPeter Maydell         } else {
98080dcd37fSPeter Maydell             td->num_entries = (((num_pages * page_sz) /
981e5487a41SPeter Maydell                                   L1TABLE_ENTRY_SIZE) *
982e5487a41SPeter Maydell                                  (page_sz / td->entry_sz));
983e5487a41SPeter Maydell         }
9848b8bb014SPeter Maydell         td->num_entries = MIN(td->num_entries, 1ULL << idbits);
9851b08e436SShashi Mallela     }
9861b08e436SShashi Mallela }
9871b08e436SShashi Mallela 
9881b08e436SShashi Mallela static void extract_cmdq_params(GICv3ITSState *s)
9891b08e436SShashi Mallela {
9901b08e436SShashi Mallela     uint16_t num_pages = 0;
9911b08e436SShashi Mallela     uint64_t value = s->cbaser;
9921b08e436SShashi Mallela 
9931b08e436SShashi Mallela     num_pages = FIELD_EX64(value, GITS_CBASER, SIZE) + 1;
9941b08e436SShashi Mallela 
9951b08e436SShashi Mallela     memset(&s->cq, 0 , sizeof(s->cq));
9961b08e436SShashi Mallela 
997da4680ceSPeter Maydell     if (FIELD_EX64(value, GITS_CBASER, VALID)) {
99880dcd37fSPeter Maydell         s->cq.num_entries = (num_pages * GITS_PAGE_SIZE_4K) /
9991b08e436SShashi Mallela                              GITS_CMDQ_ENTRY_SIZE;
10001b08e436SShashi Mallela         s->cq.base_addr = FIELD_EX64(value, GITS_CBASER, PHYADDR);
10011b08e436SShashi Mallela         s->cq.base_addr <<= R_GITS_CBASER_PHYADDR_SHIFT;
10021b08e436SShashi Mallela     }
10031b08e436SShashi Mallela }
10041b08e436SShashi Mallela 
10057e062b98SPeter Maydell static MemTxResult gicv3_its_translation_read(void *opaque, hwaddr offset,
10067e062b98SPeter Maydell                                               uint64_t *data, unsigned size,
10077e062b98SPeter Maydell                                               MemTxAttrs attrs)
10087e062b98SPeter Maydell {
10097e062b98SPeter Maydell     /*
10107e062b98SPeter Maydell      * GITS_TRANSLATER is write-only, and all other addresses
10117e062b98SPeter Maydell      * in the interrupt translation space frame are RES0.
10127e062b98SPeter Maydell      */
10137e062b98SPeter Maydell     *data = 0;
10147e062b98SPeter Maydell     return MEMTX_OK;
10157e062b98SPeter Maydell }
10167e062b98SPeter Maydell 
101718f6290aSShashi Mallela static MemTxResult gicv3_its_translation_write(void *opaque, hwaddr offset,
101818f6290aSShashi Mallela                                                uint64_t data, unsigned size,
101918f6290aSShashi Mallela                                                MemTxAttrs attrs)
102018f6290aSShashi Mallela {
1021c694cb4cSShashi Mallela     GICv3ITSState *s = (GICv3ITSState *)opaque;
1022c694cb4cSShashi Mallela     bool result = true;
1023c694cb4cSShashi Mallela 
1024195209d3SPeter Maydell     trace_gicv3_its_translation_write(offset, data, size, attrs.requester_id);
1025195209d3SPeter Maydell 
1026c694cb4cSShashi Mallela     switch (offset) {
1027c694cb4cSShashi Mallela     case GITS_TRANSLATER:
10288d2d6dd9SPeter Maydell         if (s->ctlr & R_GITS_CTLR_ENABLED_MASK) {
1029b6f96009SPeter Maydell             result = do_process_its_cmd(s, attrs.requester_id, data, NONE);
1030c694cb4cSShashi Mallela         }
1031c694cb4cSShashi Mallela         break;
1032c694cb4cSShashi Mallela     default:
1033c694cb4cSShashi Mallela         break;
1034c694cb4cSShashi Mallela     }
1035c694cb4cSShashi Mallela 
1036c694cb4cSShashi Mallela     if (result) {
103718f6290aSShashi Mallela         return MEMTX_OK;
1038c694cb4cSShashi Mallela     } else {
1039c694cb4cSShashi Mallela         return MEMTX_ERROR;
1040c694cb4cSShashi Mallela     }
104118f6290aSShashi Mallela }
104218f6290aSShashi Mallela 
104318f6290aSShashi Mallela static bool its_writel(GICv3ITSState *s, hwaddr offset,
104418f6290aSShashi Mallela                               uint64_t value, MemTxAttrs attrs)
104518f6290aSShashi Mallela {
104618f6290aSShashi Mallela     bool result = true;
10471b08e436SShashi Mallela     int index;
104818f6290aSShashi Mallela 
10491b08e436SShashi Mallela     switch (offset) {
10501b08e436SShashi Mallela     case GITS_CTLR:
10512f459cd1SShashi Mallela         if (value & R_GITS_CTLR_ENABLED_MASK) {
10528d2d6dd9SPeter Maydell             s->ctlr |= R_GITS_CTLR_ENABLED_MASK;
10531b08e436SShashi Mallela             extract_table_params(s);
10541b08e436SShashi Mallela             extract_cmdq_params(s);
10557eca39e0SShashi Mallela             process_cmdq(s);
10562f459cd1SShashi Mallela         } else {
10578d2d6dd9SPeter Maydell             s->ctlr &= ~R_GITS_CTLR_ENABLED_MASK;
10581b08e436SShashi Mallela         }
10591b08e436SShashi Mallela         break;
10601b08e436SShashi Mallela     case GITS_CBASER:
10611b08e436SShashi Mallela         /*
10621b08e436SShashi Mallela          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
10631b08e436SShashi Mallela          *                 already enabled
10641b08e436SShashi Mallela          */
10658d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
10661b08e436SShashi Mallela             s->cbaser = deposit64(s->cbaser, 0, 32, value);
10671b08e436SShashi Mallela             s->creadr = 0;
10681b08e436SShashi Mallela         }
10691b08e436SShashi Mallela         break;
10701b08e436SShashi Mallela     case GITS_CBASER + 4:
10711b08e436SShashi Mallela         /*
10721b08e436SShashi Mallela          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
10731b08e436SShashi Mallela          *                 already enabled
10741b08e436SShashi Mallela          */
10758d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
10761b08e436SShashi Mallela             s->cbaser = deposit64(s->cbaser, 32, 32, value);
10771b08e436SShashi Mallela             s->creadr = 0;
10781b08e436SShashi Mallela         }
10791b08e436SShashi Mallela         break;
10801b08e436SShashi Mallela     case GITS_CWRITER:
10811b08e436SShashi Mallela         s->cwriter = deposit64(s->cwriter, 0, 32,
10821b08e436SShashi Mallela                                (value & ~R_GITS_CWRITER_RETRY_MASK));
10837eca39e0SShashi Mallela         if (s->cwriter != s->creadr) {
10847eca39e0SShashi Mallela             process_cmdq(s);
10857eca39e0SShashi Mallela         }
10861b08e436SShashi Mallela         break;
10871b08e436SShashi Mallela     case GITS_CWRITER + 4:
10881b08e436SShashi Mallela         s->cwriter = deposit64(s->cwriter, 32, 32, value);
10891b08e436SShashi Mallela         break;
10901b08e436SShashi Mallela     case GITS_CREADR:
10911b08e436SShashi Mallela         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
10921b08e436SShashi Mallela             s->creadr = deposit64(s->creadr, 0, 32,
10931b08e436SShashi Mallela                                   (value & ~R_GITS_CREADR_STALLED_MASK));
10941b08e436SShashi Mallela         } else {
10951b08e436SShashi Mallela             /* RO register, ignore the write */
10961b08e436SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
10971b08e436SShashi Mallela                           "%s: invalid guest write to RO register at offset "
10981b08e436SShashi Mallela                           TARGET_FMT_plx "\n", __func__, offset);
10991b08e436SShashi Mallela         }
11001b08e436SShashi Mallela         break;
11011b08e436SShashi Mallela     case GITS_CREADR + 4:
11021b08e436SShashi Mallela         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
11031b08e436SShashi Mallela             s->creadr = deposit64(s->creadr, 32, 32, value);
11041b08e436SShashi Mallela         } else {
11051b08e436SShashi Mallela             /* RO register, ignore the write */
11061b08e436SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
11071b08e436SShashi Mallela                           "%s: invalid guest write to RO register at offset "
11081b08e436SShashi Mallela                           TARGET_FMT_plx "\n", __func__, offset);
11091b08e436SShashi Mallela         }
11101b08e436SShashi Mallela         break;
11111b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
11121b08e436SShashi Mallela         /*
11131b08e436SShashi Mallela          * IMPDEF choice:- GITS_BASERn register becomes RO if ITS is
11141b08e436SShashi Mallela          *                 already enabled
11151b08e436SShashi Mallela          */
11168d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
11171b08e436SShashi Mallela             index = (offset - GITS_BASER) / 8;
11181b08e436SShashi Mallela 
11190ffe88e6SPeter Maydell             if (s->baser[index] == 0) {
11200ffe88e6SPeter Maydell                 /* Unimplemented GITS_BASERn: RAZ/WI */
11210ffe88e6SPeter Maydell                 break;
11220ffe88e6SPeter Maydell             }
11231b08e436SShashi Mallela             if (offset & 7) {
11241b08e436SShashi Mallela                 value <<= 32;
11251b08e436SShashi Mallela                 value &= ~GITS_BASER_RO_MASK;
11261b08e436SShashi Mallela                 s->baser[index] &= GITS_BASER_RO_MASK | MAKE_64BIT_MASK(0, 32);
11271b08e436SShashi Mallela                 s->baser[index] |= value;
11281b08e436SShashi Mallela             } else {
11291b08e436SShashi Mallela                 value &= ~GITS_BASER_RO_MASK;
11301b08e436SShashi Mallela                 s->baser[index] &= GITS_BASER_RO_MASK | MAKE_64BIT_MASK(32, 32);
11311b08e436SShashi Mallela                 s->baser[index] |= value;
11321b08e436SShashi Mallela             }
11331b08e436SShashi Mallela         }
11341b08e436SShashi Mallela         break;
11351b08e436SShashi Mallela     case GITS_IIDR:
11361b08e436SShashi Mallela     case GITS_IDREGS ... GITS_IDREGS + 0x2f:
11371b08e436SShashi Mallela         /* RO registers, ignore the write */
11381b08e436SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
11391b08e436SShashi Mallela                       "%s: invalid guest write to RO register at offset "
11401b08e436SShashi Mallela                       TARGET_FMT_plx "\n", __func__, offset);
11411b08e436SShashi Mallela         break;
11421b08e436SShashi Mallela     default:
11431b08e436SShashi Mallela         result = false;
11441b08e436SShashi Mallela         break;
11451b08e436SShashi Mallela     }
114618f6290aSShashi Mallela     return result;
114718f6290aSShashi Mallela }
114818f6290aSShashi Mallela 
114918f6290aSShashi Mallela static bool its_readl(GICv3ITSState *s, hwaddr offset,
115018f6290aSShashi Mallela                              uint64_t *data, MemTxAttrs attrs)
115118f6290aSShashi Mallela {
115218f6290aSShashi Mallela     bool result = true;
11531b08e436SShashi Mallela     int index;
115418f6290aSShashi Mallela 
11551b08e436SShashi Mallela     switch (offset) {
11561b08e436SShashi Mallela     case GITS_CTLR:
11571b08e436SShashi Mallela         *data = s->ctlr;
11581b08e436SShashi Mallela         break;
11591b08e436SShashi Mallela     case GITS_IIDR:
11601b08e436SShashi Mallela         *data = gicv3_iidr();
11611b08e436SShashi Mallela         break;
11621b08e436SShashi Mallela     case GITS_IDREGS ... GITS_IDREGS + 0x2f:
11631b08e436SShashi Mallela         /* ID registers */
11641b08e436SShashi Mallela         *data = gicv3_idreg(offset - GITS_IDREGS);
11651b08e436SShashi Mallela         break;
11661b08e436SShashi Mallela     case GITS_TYPER:
11671b08e436SShashi Mallela         *data = extract64(s->typer, 0, 32);
11681b08e436SShashi Mallela         break;
11691b08e436SShashi Mallela     case GITS_TYPER + 4:
11701b08e436SShashi Mallela         *data = extract64(s->typer, 32, 32);
11711b08e436SShashi Mallela         break;
11721b08e436SShashi Mallela     case GITS_CBASER:
11731b08e436SShashi Mallela         *data = extract64(s->cbaser, 0, 32);
11741b08e436SShashi Mallela         break;
11751b08e436SShashi Mallela     case GITS_CBASER + 4:
11761b08e436SShashi Mallela         *data = extract64(s->cbaser, 32, 32);
11771b08e436SShashi Mallela         break;
11781b08e436SShashi Mallela     case GITS_CREADR:
11791b08e436SShashi Mallela         *data = extract64(s->creadr, 0, 32);
11801b08e436SShashi Mallela         break;
11811b08e436SShashi Mallela     case GITS_CREADR + 4:
11821b08e436SShashi Mallela         *data = extract64(s->creadr, 32, 32);
11831b08e436SShashi Mallela         break;
11841b08e436SShashi Mallela     case GITS_CWRITER:
11851b08e436SShashi Mallela         *data = extract64(s->cwriter, 0, 32);
11861b08e436SShashi Mallela         break;
11871b08e436SShashi Mallela     case GITS_CWRITER + 4:
11881b08e436SShashi Mallela         *data = extract64(s->cwriter, 32, 32);
11891b08e436SShashi Mallela         break;
11901b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
11911b08e436SShashi Mallela         index = (offset - GITS_BASER) / 8;
11921b08e436SShashi Mallela         if (offset & 7) {
11931b08e436SShashi Mallela             *data = extract64(s->baser[index], 32, 32);
11941b08e436SShashi Mallela         } else {
11951b08e436SShashi Mallela             *data = extract64(s->baser[index], 0, 32);
11961b08e436SShashi Mallela         }
11971b08e436SShashi Mallela         break;
11981b08e436SShashi Mallela     default:
11991b08e436SShashi Mallela         result = false;
12001b08e436SShashi Mallela         break;
12011b08e436SShashi Mallela     }
120218f6290aSShashi Mallela     return result;
120318f6290aSShashi Mallela }
120418f6290aSShashi Mallela 
120518f6290aSShashi Mallela static bool its_writell(GICv3ITSState *s, hwaddr offset,
120618f6290aSShashi Mallela                                uint64_t value, MemTxAttrs attrs)
120718f6290aSShashi Mallela {
120818f6290aSShashi Mallela     bool result = true;
12091b08e436SShashi Mallela     int index;
121018f6290aSShashi Mallela 
12111b08e436SShashi Mallela     switch (offset) {
12121b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
12131b08e436SShashi Mallela         /*
12141b08e436SShashi Mallela          * IMPDEF choice:- GITS_BASERn register becomes RO if ITS is
12151b08e436SShashi Mallela          *                 already enabled
12161b08e436SShashi Mallela          */
12178d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
12181b08e436SShashi Mallela             index = (offset - GITS_BASER) / 8;
12190ffe88e6SPeter Maydell             if (s->baser[index] == 0) {
12200ffe88e6SPeter Maydell                 /* Unimplemented GITS_BASERn: RAZ/WI */
12210ffe88e6SPeter Maydell                 break;
12220ffe88e6SPeter Maydell             }
12231b08e436SShashi Mallela             s->baser[index] &= GITS_BASER_RO_MASK;
12241b08e436SShashi Mallela             s->baser[index] |= (value & ~GITS_BASER_RO_MASK);
12251b08e436SShashi Mallela         }
12261b08e436SShashi Mallela         break;
12271b08e436SShashi Mallela     case GITS_CBASER:
12281b08e436SShashi Mallela         /*
12291b08e436SShashi Mallela          * IMPDEF choice:- GITS_CBASER register becomes RO if ITS is
12301b08e436SShashi Mallela          *                 already enabled
12311b08e436SShashi Mallela          */
12328d2d6dd9SPeter Maydell         if (!(s->ctlr & R_GITS_CTLR_ENABLED_MASK)) {
12331b08e436SShashi Mallela             s->cbaser = value;
12341b08e436SShashi Mallela             s->creadr = 0;
12351b08e436SShashi Mallela         }
12361b08e436SShashi Mallela         break;
12371b08e436SShashi Mallela     case GITS_CWRITER:
12381b08e436SShashi Mallela         s->cwriter = value & ~R_GITS_CWRITER_RETRY_MASK;
12397eca39e0SShashi Mallela         if (s->cwriter != s->creadr) {
12407eca39e0SShashi Mallela             process_cmdq(s);
12417eca39e0SShashi Mallela         }
12421b08e436SShashi Mallela         break;
12431b08e436SShashi Mallela     case GITS_CREADR:
12441b08e436SShashi Mallela         if (s->gicv3->gicd_ctlr & GICD_CTLR_DS) {
12451b08e436SShashi Mallela             s->creadr = value & ~R_GITS_CREADR_STALLED_MASK;
12461b08e436SShashi Mallela         } else {
12471b08e436SShashi Mallela             /* RO register, ignore the write */
12481b08e436SShashi Mallela             qemu_log_mask(LOG_GUEST_ERROR,
12491b08e436SShashi Mallela                           "%s: invalid guest write to RO register at offset "
12501b08e436SShashi Mallela                           TARGET_FMT_plx "\n", __func__, offset);
12511b08e436SShashi Mallela         }
12521b08e436SShashi Mallela         break;
12531b08e436SShashi Mallela     case GITS_TYPER:
12541b08e436SShashi Mallela         /* RO registers, ignore the write */
12551b08e436SShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
12561b08e436SShashi Mallela                       "%s: invalid guest write to RO register at offset "
12571b08e436SShashi Mallela                       TARGET_FMT_plx "\n", __func__, offset);
12581b08e436SShashi Mallela         break;
12591b08e436SShashi Mallela     default:
12601b08e436SShashi Mallela         result = false;
12611b08e436SShashi Mallela         break;
12621b08e436SShashi Mallela     }
126318f6290aSShashi Mallela     return result;
126418f6290aSShashi Mallela }
126518f6290aSShashi Mallela 
126618f6290aSShashi Mallela static bool its_readll(GICv3ITSState *s, hwaddr offset,
126718f6290aSShashi Mallela                               uint64_t *data, MemTxAttrs attrs)
126818f6290aSShashi Mallela {
126918f6290aSShashi Mallela     bool result = true;
12701b08e436SShashi Mallela     int index;
127118f6290aSShashi Mallela 
12721b08e436SShashi Mallela     switch (offset) {
12731b08e436SShashi Mallela     case GITS_TYPER:
12741b08e436SShashi Mallela         *data = s->typer;
12751b08e436SShashi Mallela         break;
12761b08e436SShashi Mallela     case GITS_BASER ... GITS_BASER + 0x3f:
12771b08e436SShashi Mallela         index = (offset - GITS_BASER) / 8;
12781b08e436SShashi Mallela         *data = s->baser[index];
12791b08e436SShashi Mallela         break;
12801b08e436SShashi Mallela     case GITS_CBASER:
12811b08e436SShashi Mallela         *data = s->cbaser;
12821b08e436SShashi Mallela         break;
12831b08e436SShashi Mallela     case GITS_CREADR:
12841b08e436SShashi Mallela         *data = s->creadr;
12851b08e436SShashi Mallela         break;
12861b08e436SShashi Mallela     case GITS_CWRITER:
12871b08e436SShashi Mallela         *data = s->cwriter;
12881b08e436SShashi Mallela         break;
12891b08e436SShashi Mallela     default:
12901b08e436SShashi Mallela         result = false;
12911b08e436SShashi Mallela         break;
12921b08e436SShashi Mallela     }
129318f6290aSShashi Mallela     return result;
129418f6290aSShashi Mallela }
129518f6290aSShashi Mallela 
129618f6290aSShashi Mallela static MemTxResult gicv3_its_read(void *opaque, hwaddr offset, uint64_t *data,
129718f6290aSShashi Mallela                                   unsigned size, MemTxAttrs attrs)
129818f6290aSShashi Mallela {
129918f6290aSShashi Mallela     GICv3ITSState *s = (GICv3ITSState *)opaque;
130018f6290aSShashi Mallela     bool result;
130118f6290aSShashi Mallela 
130218f6290aSShashi Mallela     switch (size) {
130318f6290aSShashi Mallela     case 4:
130418f6290aSShashi Mallela         result = its_readl(s, offset, data, attrs);
130518f6290aSShashi Mallela         break;
130618f6290aSShashi Mallela     case 8:
130718f6290aSShashi Mallela         result = its_readll(s, offset, data, attrs);
130818f6290aSShashi Mallela         break;
130918f6290aSShashi Mallela     default:
131018f6290aSShashi Mallela         result = false;
131118f6290aSShashi Mallela         break;
131218f6290aSShashi Mallela     }
131318f6290aSShashi Mallela 
131418f6290aSShashi Mallela     if (!result) {
131518f6290aSShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
131618f6290aSShashi Mallela                       "%s: invalid guest read at offset " TARGET_FMT_plx
131718f6290aSShashi Mallela                       " size %u\n", __func__, offset, size);
1318195209d3SPeter Maydell         trace_gicv3_its_badread(offset, size);
131918f6290aSShashi Mallela         /*
132018f6290aSShashi Mallela          * The spec requires that reserved registers are RAZ/WI;
132118f6290aSShashi Mallela          * so use false returns from leaf functions as a way to
132218f6290aSShashi Mallela          * trigger the guest-error logging but don't return it to
132318f6290aSShashi Mallela          * the caller, or we'll cause a spurious guest data abort.
132418f6290aSShashi Mallela          */
132518f6290aSShashi Mallela         *data = 0;
1326195209d3SPeter Maydell     } else {
1327195209d3SPeter Maydell         trace_gicv3_its_read(offset, *data, size);
132818f6290aSShashi Mallela     }
132918f6290aSShashi Mallela     return MEMTX_OK;
133018f6290aSShashi Mallela }
133118f6290aSShashi Mallela 
133218f6290aSShashi Mallela static MemTxResult gicv3_its_write(void *opaque, hwaddr offset, uint64_t data,
133318f6290aSShashi Mallela                                    unsigned size, MemTxAttrs attrs)
133418f6290aSShashi Mallela {
133518f6290aSShashi Mallela     GICv3ITSState *s = (GICv3ITSState *)opaque;
133618f6290aSShashi Mallela     bool result;
133718f6290aSShashi Mallela 
133818f6290aSShashi Mallela     switch (size) {
133918f6290aSShashi Mallela     case 4:
134018f6290aSShashi Mallela         result = its_writel(s, offset, data, attrs);
134118f6290aSShashi Mallela         break;
134218f6290aSShashi Mallela     case 8:
134318f6290aSShashi Mallela         result = its_writell(s, offset, data, attrs);
134418f6290aSShashi Mallela         break;
134518f6290aSShashi Mallela     default:
134618f6290aSShashi Mallela         result = false;
134718f6290aSShashi Mallela         break;
134818f6290aSShashi Mallela     }
134918f6290aSShashi Mallela 
135018f6290aSShashi Mallela     if (!result) {
135118f6290aSShashi Mallela         qemu_log_mask(LOG_GUEST_ERROR,
135218f6290aSShashi Mallela                       "%s: invalid guest write at offset " TARGET_FMT_plx
135318f6290aSShashi Mallela                       " size %u\n", __func__, offset, size);
1354195209d3SPeter Maydell         trace_gicv3_its_badwrite(offset, data, size);
135518f6290aSShashi Mallela         /*
135618f6290aSShashi Mallela          * The spec requires that reserved registers are RAZ/WI;
135718f6290aSShashi Mallela          * so use false returns from leaf functions as a way to
135818f6290aSShashi Mallela          * trigger the guest-error logging but don't return it to
135918f6290aSShashi Mallela          * the caller, or we'll cause a spurious guest data abort.
136018f6290aSShashi Mallela          */
1361195209d3SPeter Maydell     } else {
1362195209d3SPeter Maydell         trace_gicv3_its_write(offset, data, size);
136318f6290aSShashi Mallela     }
136418f6290aSShashi Mallela     return MEMTX_OK;
136518f6290aSShashi Mallela }
136618f6290aSShashi Mallela 
136718f6290aSShashi Mallela static const MemoryRegionOps gicv3_its_control_ops = {
136818f6290aSShashi Mallela     .read_with_attrs = gicv3_its_read,
136918f6290aSShashi Mallela     .write_with_attrs = gicv3_its_write,
137018f6290aSShashi Mallela     .valid.min_access_size = 4,
137118f6290aSShashi Mallela     .valid.max_access_size = 8,
137218f6290aSShashi Mallela     .impl.min_access_size = 4,
137318f6290aSShashi Mallela     .impl.max_access_size = 8,
137418f6290aSShashi Mallela     .endianness = DEVICE_NATIVE_ENDIAN,
137518f6290aSShashi Mallela };
137618f6290aSShashi Mallela 
137718f6290aSShashi Mallela static const MemoryRegionOps gicv3_its_translation_ops = {
13787e062b98SPeter Maydell     .read_with_attrs = gicv3_its_translation_read,
137918f6290aSShashi Mallela     .write_with_attrs = gicv3_its_translation_write,
138018f6290aSShashi Mallela     .valid.min_access_size = 2,
138118f6290aSShashi Mallela     .valid.max_access_size = 4,
138218f6290aSShashi Mallela     .impl.min_access_size = 2,
138318f6290aSShashi Mallela     .impl.max_access_size = 4,
138418f6290aSShashi Mallela     .endianness = DEVICE_NATIVE_ENDIAN,
138518f6290aSShashi Mallela };
138618f6290aSShashi Mallela 
138718f6290aSShashi Mallela static void gicv3_arm_its_realize(DeviceState *dev, Error **errp)
138818f6290aSShashi Mallela {
138918f6290aSShashi Mallela     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
139018f6290aSShashi Mallela     int i;
139118f6290aSShashi Mallela 
139218f6290aSShashi Mallela     for (i = 0; i < s->gicv3->num_cpu; i++) {
139318f6290aSShashi Mallela         if (!(s->gicv3->cpu[i].gicr_typer & GICR_TYPER_PLPIS)) {
139418f6290aSShashi Mallela             error_setg(errp, "Physical LPI not supported by CPU %d", i);
139518f6290aSShashi Mallela             return;
139618f6290aSShashi Mallela         }
139718f6290aSShashi Mallela     }
139818f6290aSShashi Mallela 
139918f6290aSShashi Mallela     gicv3_its_init_mmio(s, &gicv3_its_control_ops, &gicv3_its_translation_ops);
140018f6290aSShashi Mallela 
140118f6290aSShashi Mallela     /* set the ITS default features supported */
1402764d6ba1SPeter Maydell     s->typer = FIELD_DP64(s->typer, GITS_TYPER, PHYSICAL, 1);
140318f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, ITT_ENTRY_SIZE,
140418f6290aSShashi Mallela                           ITS_ITT_ENTRY_SIZE - 1);
140518f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, IDBITS, ITS_IDBITS);
140618f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, DEVBITS, ITS_DEVBITS);
140718f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, CIL, 1);
140818f6290aSShashi Mallela     s->typer = FIELD_DP64(s->typer, GITS_TYPER, CIDBITS, ITS_CIDBITS);
140918f6290aSShashi Mallela }
141018f6290aSShashi Mallela 
141118f6290aSShashi Mallela static void gicv3_its_reset(DeviceState *dev)
141218f6290aSShashi Mallela {
141318f6290aSShashi Mallela     GICv3ITSState *s = ARM_GICV3_ITS_COMMON(dev);
141418f6290aSShashi Mallela     GICv3ITSClass *c = ARM_GICV3_ITS_GET_CLASS(s);
141518f6290aSShashi Mallela 
141618f6290aSShashi Mallela     c->parent_reset(dev);
141718f6290aSShashi Mallela 
141818f6290aSShashi Mallela     /* Quiescent bit reset to 1 */
141918f6290aSShashi Mallela     s->ctlr = FIELD_DP32(s->ctlr, GITS_CTLR, QUIESCENT, 1);
142018f6290aSShashi Mallela 
142118f6290aSShashi Mallela     /*
142218f6290aSShashi Mallela      * setting GITS_BASER0.Type = 0b001 (Device)
142318f6290aSShashi Mallela      *         GITS_BASER1.Type = 0b100 (Collection Table)
142418f6290aSShashi Mallela      *         GITS_BASER<n>.Type,where n = 3 to 7 are 0b00 (Unimplemented)
142518f6290aSShashi Mallela      *         GITS_BASER<0,1>.Page_Size = 64KB
142618f6290aSShashi Mallela      * and default translation table entry size to 16 bytes
142718f6290aSShashi Mallela      */
142818f6290aSShashi Mallela     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, TYPE,
142918f6290aSShashi Mallela                              GITS_BASER_TYPE_DEVICE);
143018f6290aSShashi Mallela     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, PAGESIZE,
143118f6290aSShashi Mallela                              GITS_BASER_PAGESIZE_64K);
143218f6290aSShashi Mallela     s->baser[0] = FIELD_DP64(s->baser[0], GITS_BASER, ENTRYSIZE,
143318f6290aSShashi Mallela                              GITS_DTE_SIZE - 1);
143418f6290aSShashi Mallela 
143518f6290aSShashi Mallela     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, TYPE,
143618f6290aSShashi Mallela                              GITS_BASER_TYPE_COLLECTION);
143718f6290aSShashi Mallela     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, PAGESIZE,
143818f6290aSShashi Mallela                              GITS_BASER_PAGESIZE_64K);
143918f6290aSShashi Mallela     s->baser[1] = FIELD_DP64(s->baser[1], GITS_BASER, ENTRYSIZE,
144018f6290aSShashi Mallela                              GITS_CTE_SIZE - 1);
144118f6290aSShashi Mallela }
144218f6290aSShashi Mallela 
14431b08e436SShashi Mallela static void gicv3_its_post_load(GICv3ITSState *s)
14441b08e436SShashi Mallela {
14458d2d6dd9SPeter Maydell     if (s->ctlr & R_GITS_CTLR_ENABLED_MASK) {
14461b08e436SShashi Mallela         extract_table_params(s);
14471b08e436SShashi Mallela         extract_cmdq_params(s);
14481b08e436SShashi Mallela     }
14491b08e436SShashi Mallela }
14501b08e436SShashi Mallela 
145118f6290aSShashi Mallela static Property gicv3_its_props[] = {
145218f6290aSShashi Mallela     DEFINE_PROP_LINK("parent-gicv3", GICv3ITSState, gicv3, "arm-gicv3",
145318f6290aSShashi Mallela                      GICv3State *),
145418f6290aSShashi Mallela     DEFINE_PROP_END_OF_LIST(),
145518f6290aSShashi Mallela };
145618f6290aSShashi Mallela 
145718f6290aSShashi Mallela static void gicv3_its_class_init(ObjectClass *klass, void *data)
145818f6290aSShashi Mallela {
145918f6290aSShashi Mallela     DeviceClass *dc = DEVICE_CLASS(klass);
146018f6290aSShashi Mallela     GICv3ITSClass *ic = ARM_GICV3_ITS_CLASS(klass);
14611b08e436SShashi Mallela     GICv3ITSCommonClass *icc = ARM_GICV3_ITS_COMMON_CLASS(klass);
146218f6290aSShashi Mallela 
146318f6290aSShashi Mallela     dc->realize = gicv3_arm_its_realize;
146418f6290aSShashi Mallela     device_class_set_props(dc, gicv3_its_props);
146518f6290aSShashi Mallela     device_class_set_parent_reset(dc, gicv3_its_reset, &ic->parent_reset);
14661b08e436SShashi Mallela     icc->post_load = gicv3_its_post_load;
146718f6290aSShashi Mallela }
146818f6290aSShashi Mallela 
146918f6290aSShashi Mallela static const TypeInfo gicv3_its_info = {
147018f6290aSShashi Mallela     .name = TYPE_ARM_GICV3_ITS,
147118f6290aSShashi Mallela     .parent = TYPE_ARM_GICV3_ITS_COMMON,
147218f6290aSShashi Mallela     .instance_size = sizeof(GICv3ITSState),
147318f6290aSShashi Mallela     .class_init = gicv3_its_class_init,
147418f6290aSShashi Mallela     .class_size = sizeof(GICv3ITSClass),
147518f6290aSShashi Mallela };
147618f6290aSShashi Mallela 
147718f6290aSShashi Mallela static void gicv3_its_register_types(void)
147818f6290aSShashi Mallela {
147918f6290aSShashi Mallela     type_register_static(&gicv3_its_info);
148018f6290aSShashi Mallela }
148118f6290aSShashi Mallela 
148218f6290aSShashi Mallela type_init(gicv3_its_register_types)
1483