xref: /qemu/hw/intc/xive2.c (revision c01196bd)
1 /*
2  * QEMU PowerPC XIVE2 interrupt controller model (POWER10)
3  *
4  * Copyright (c) 2019-2022, IBM Corporation..
5  *
6  * This code is licensed under the GPL version 2 or later. See the
7  * COPYING file in the top-level directory.
8  */
9 
10 #include "qemu/osdep.h"
11 #include "qemu/log.h"
12 #include "qemu/module.h"
13 #include "qapi/error.h"
14 #include "target/ppc/cpu.h"
15 #include "sysemu/cpus.h"
16 #include "sysemu/dma.h"
17 #include "hw/qdev-properties.h"
18 #include "monitor/monitor.h"
19 #include "hw/ppc/xive.h"
20 #include "hw/ppc/xive2.h"
21 #include "hw/ppc/xive2_regs.h"
22 
23 uint32_t xive2_router_get_config(Xive2Router *xrtr)
24 {
25     Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
26 
27     return xrc->get_config(xrtr);
28 }
29 
30 void xive2_eas_pic_print_info(Xive2Eas *eas, uint32_t lisn, Monitor *mon)
31 {
32     if (!xive2_eas_is_valid(eas)) {
33         return;
34     }
35 
36     monitor_printf(mon, "  %08x %s end:%02x/%04x data:%08x\n",
37                    lisn, xive2_eas_is_masked(eas) ? "M" : " ",
38                    (uint8_t)  xive_get_field64(EAS2_END_BLOCK, eas->w),
39                    (uint32_t) xive_get_field64(EAS2_END_INDEX, eas->w),
40                    (uint32_t) xive_get_field64(EAS2_END_DATA, eas->w));
41 }
42 
43 void xive2_end_queue_pic_print_info(Xive2End *end, uint32_t width,
44                                     Monitor *mon)
45 {
46     uint64_t qaddr_base = xive2_end_qaddr(end);
47     uint32_t qsize = xive_get_field32(END2_W3_QSIZE, end->w3);
48     uint32_t qindex = xive_get_field32(END2_W1_PAGE_OFF, end->w1);
49     uint32_t qentries = 1 << (qsize + 10);
50     int i;
51 
52     /*
53      * print out the [ (qindex - (width - 1)) .. (qindex + 1)] window
54      */
55     monitor_printf(mon, " [ ");
56     qindex = (qindex - (width - 1)) & (qentries - 1);
57     for (i = 0; i < width; i++) {
58         uint64_t qaddr = qaddr_base + (qindex << 2);
59         uint32_t qdata = -1;
60 
61         if (dma_memory_read(&address_space_memory, qaddr, &qdata,
62                             sizeof(qdata), MEMTXATTRS_UNSPECIFIED)) {
63             qemu_log_mask(LOG_GUEST_ERROR, "XIVE: failed to read EQ @0x%"
64                           HWADDR_PRIx "\n", qaddr);
65             return;
66         }
67         monitor_printf(mon, "%s%08x ", i == width - 1 ? "^" : "",
68                        be32_to_cpu(qdata));
69         qindex = (qindex + 1) & (qentries - 1);
70     }
71     monitor_printf(mon, "]");
72 }
73 
74 void xive2_end_pic_print_info(Xive2End *end, uint32_t end_idx, Monitor *mon)
75 {
76     uint64_t qaddr_base = xive2_end_qaddr(end);
77     uint32_t qindex = xive_get_field32(END2_W1_PAGE_OFF, end->w1);
78     uint32_t qgen = xive_get_field32(END2_W1_GENERATION, end->w1);
79     uint32_t qsize = xive_get_field32(END2_W3_QSIZE, end->w3);
80     uint32_t qentries = 1 << (qsize + 10);
81 
82     uint32_t nvp_blk = xive_get_field32(END2_W6_VP_BLOCK, end->w6);
83     uint32_t nvp_idx = xive_get_field32(END2_W6_VP_OFFSET, end->w6);
84     uint8_t priority = xive_get_field32(END2_W7_F0_PRIORITY, end->w7);
85     uint8_t pq;
86 
87     if (!xive2_end_is_valid(end)) {
88         return;
89     }
90 
91     pq = xive_get_field32(END2_W1_ESn, end->w1);
92 
93     monitor_printf(mon,
94                    "  %08x %c%c %c%c%c%c%c%c%c%c%c%c prio:%d nvp:%02x/%04x",
95                    end_idx,
96                    pq & XIVE_ESB_VAL_P ? 'P' : '-',
97                    pq & XIVE_ESB_VAL_Q ? 'Q' : '-',
98                    xive2_end_is_valid(end)    ? 'v' : '-',
99                    xive2_end_is_enqueue(end)  ? 'q' : '-',
100                    xive2_end_is_notify(end)   ? 'n' : '-',
101                    xive2_end_is_backlog(end)  ? 'b' : '-',
102                    xive2_end_is_escalate(end) ? 'e' : '-',
103                    xive2_end_is_escalate_end(end) ? 'N' : '-',
104                    xive2_end_is_uncond_escalation(end)   ? 'u' : '-',
105                    xive2_end_is_silent_escalation(end)   ? 's' : '-',
106                    xive2_end_is_firmware1(end)   ? 'f' : '-',
107                    xive2_end_is_firmware2(end)   ? 'F' : '-',
108                    priority, nvp_blk, nvp_idx);
109 
110     if (qaddr_base) {
111         monitor_printf(mon, " eq:@%08"PRIx64"% 6d/%5d ^%d",
112                        qaddr_base, qindex, qentries, qgen);
113         xive2_end_queue_pic_print_info(end, 6, mon);
114     }
115     monitor_printf(mon, "\n");
116 }
117 
118 void xive2_end_eas_pic_print_info(Xive2End *end, uint32_t end_idx,
119                                   Monitor *mon)
120 {
121     Xive2Eas *eas = (Xive2Eas *) &end->w4;
122     uint8_t pq;
123 
124     if (!xive2_end_is_escalate(end)) {
125         return;
126     }
127 
128     pq = xive_get_field32(END2_W1_ESe, end->w1);
129 
130     monitor_printf(mon, "  %08x %c%c %c%c end:%02x/%04x data:%08x\n",
131                    end_idx,
132                    pq & XIVE_ESB_VAL_P ? 'P' : '-',
133                    pq & XIVE_ESB_VAL_Q ? 'Q' : '-',
134                    xive2_eas_is_valid(eas) ? 'v' : ' ',
135                    xive2_eas_is_masked(eas) ? 'M' : ' ',
136                    (uint8_t)  xive_get_field64(EAS2_END_BLOCK, eas->w),
137                    (uint32_t) xive_get_field64(EAS2_END_INDEX, eas->w),
138                    (uint32_t) xive_get_field64(EAS2_END_DATA, eas->w));
139 }
140 
141 static void xive2_end_enqueue(Xive2End *end, uint32_t data)
142 {
143     uint64_t qaddr_base = xive2_end_qaddr(end);
144     uint32_t qsize = xive_get_field32(END2_W3_QSIZE, end->w3);
145     uint32_t qindex = xive_get_field32(END2_W1_PAGE_OFF, end->w1);
146     uint32_t qgen = xive_get_field32(END2_W1_GENERATION, end->w1);
147 
148     uint64_t qaddr = qaddr_base + (qindex << 2);
149     uint32_t qdata = cpu_to_be32((qgen << 31) | (data & 0x7fffffff));
150     uint32_t qentries = 1 << (qsize + 10);
151 
152     if (dma_memory_write(&address_space_memory, qaddr, &qdata, sizeof(qdata),
153                          MEMTXATTRS_UNSPECIFIED)) {
154         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: failed to write END data @0x%"
155                       HWADDR_PRIx "\n", qaddr);
156         return;
157     }
158 
159     qindex = (qindex + 1) & (qentries - 1);
160     if (qindex == 0) {
161         qgen ^= 1;
162         end->w1 = xive_set_field32(END2_W1_GENERATION, end->w1, qgen);
163 
164         /* TODO(PowerNV): reset GF bit on a cache watch operation */
165         end->w1 = xive_set_field32(END2_W1_GEN_FLIPPED, end->w1, qgen);
166     }
167     end->w1 = xive_set_field32(END2_W1_PAGE_OFF, end->w1, qindex);
168 }
169 
170 /*
171  * XIVE Thread Interrupt Management Area (TIMA) - Gen2 mode
172  *
173  * TIMA Gen2 VP “save & restore” (S&R) indicated by H bit next to V bit
174  *
175  *   - if a context is enabled with the H bit set, the VP context
176  *     information is retrieved from the NVP structure (“check out”)
177  *     and stored back on a context pull (“check in”), the SW receives
178  *     the same context pull information as on P9
179  *
180  *   - the H bit cannot be changed while the V bit is set, i.e. a
181  *     context cannot be set up in the TIMA and then be “pushed” into
182  *     the NVP by changing the H bit while the context is enabled
183  */
184 
185 static void xive2_tctx_save_os_ctx(Xive2Router *xrtr, XiveTCTX *tctx,
186                                    uint8_t nvp_blk, uint32_t nvp_idx)
187 {
188     CPUPPCState *env = &POWERPC_CPU(tctx->cs)->env;
189     uint32_t pir = env->spr_cb[SPR_PIR].default_value;
190     Xive2Nvp nvp;
191     uint8_t *regs = &tctx->regs[TM_QW1_OS];
192 
193     if (xive2_router_get_nvp(xrtr, nvp_blk, nvp_idx, &nvp)) {
194         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: No NVP %x/%x\n",
195                           nvp_blk, nvp_idx);
196         return;
197     }
198 
199     if (!xive2_nvp_is_valid(&nvp)) {
200         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: invalid NVP %x/%x\n",
201                       nvp_blk, nvp_idx);
202         return;
203     }
204 
205     if (!xive2_nvp_is_hw(&nvp)) {
206         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: NVP %x/%x is not HW owned\n",
207                       nvp_blk, nvp_idx);
208         return;
209     }
210 
211     if (!xive2_nvp_is_co(&nvp)) {
212         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: NVP %x/%x is not checkout\n",
213                       nvp_blk, nvp_idx);
214         return;
215     }
216 
217     if (xive_get_field32(NVP2_W1_CO_THRID_VALID, nvp.w1) &&
218         xive_get_field32(NVP2_W1_CO_THRID, nvp.w1) != pir) {
219         qemu_log_mask(LOG_GUEST_ERROR,
220                       "XIVE: NVP %x/%x invalid checkout Thread %x\n",
221                       nvp_blk, nvp_idx, pir);
222         return;
223     }
224 
225     nvp.w2 = xive_set_field32(NVP2_W2_IPB, nvp.w2, regs[TM_IPB]);
226     nvp.w2 = xive_set_field32(NVP2_W2_CPPR, nvp.w2, regs[TM_CPPR]);
227     nvp.w2 = xive_set_field32(NVP2_W2_LSMFB, nvp.w2, regs[TM_LSMFB]);
228     xive2_router_write_nvp(xrtr, nvp_blk, nvp_idx, &nvp, 2);
229 
230     nvp.w1 = xive_set_field32(NVP2_W1_CO, nvp.w1, 0);
231     /* NVP2_W1_CO_THRID_VALID only set once */
232     nvp.w1 = xive_set_field32(NVP2_W1_CO_THRID, nvp.w1, 0xFFFF);
233     xive2_router_write_nvp(xrtr, nvp_blk, nvp_idx, &nvp, 1);
234 }
235 
236 static void xive2_os_cam_decode(uint32_t cam, uint8_t *nvp_blk,
237                                 uint32_t *nvp_idx, bool *vo, bool *ho)
238 {
239     *nvp_blk = xive2_nvp_blk(cam);
240     *nvp_idx = xive2_nvp_idx(cam);
241     *vo = !!(cam & TM2_QW1W2_VO);
242     *ho = !!(cam & TM2_QW1W2_HO);
243 }
244 
245 uint64_t xive2_tm_pull_os_ctx(XivePresenter *xptr, XiveTCTX *tctx,
246                               hwaddr offset, unsigned size)
247 {
248     Xive2Router *xrtr = XIVE2_ROUTER(xptr);
249     uint32_t qw1w2 = xive_tctx_word2(&tctx->regs[TM_QW1_OS]);
250     uint32_t qw1w2_new;
251     uint32_t cam = be32_to_cpu(qw1w2);
252     uint8_t nvp_blk;
253     uint32_t nvp_idx;
254     bool vo;
255     bool do_save;
256 
257     xive2_os_cam_decode(cam, &nvp_blk, &nvp_idx, &vo, &do_save);
258 
259     if (!vo) {
260         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: pulling invalid NVP %x/%x !?\n",
261                       nvp_blk, nvp_idx);
262     }
263 
264     /* Invalidate CAM line */
265     qw1w2_new = xive_set_field32(TM2_QW1W2_VO, qw1w2, 0);
266     memcpy(&tctx->regs[TM_QW1_OS + TM_WORD2], &qw1w2_new, 4);
267 
268     if (xive2_router_get_config(xrtr) & XIVE2_VP_SAVE_RESTORE && do_save) {
269         xive2_tctx_save_os_ctx(xrtr, tctx, nvp_blk, nvp_idx);
270     }
271 
272     xive_tctx_reset_os_signal(tctx);
273     return qw1w2;
274 }
275 
276 static uint8_t xive2_tctx_restore_os_ctx(Xive2Router *xrtr, XiveTCTX *tctx,
277                                         uint8_t nvp_blk, uint32_t nvp_idx,
278                                         Xive2Nvp *nvp)
279 {
280     CPUPPCState *env = &POWERPC_CPU(tctx->cs)->env;
281     uint32_t pir = env->spr_cb[SPR_PIR].default_value;
282     uint8_t cppr;
283 
284     if (!xive2_nvp_is_hw(nvp)) {
285         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: NVP %x/%x is not HW owned\n",
286                       nvp_blk, nvp_idx);
287         return 0;
288     }
289 
290     cppr = xive_get_field32(NVP2_W2_CPPR, nvp->w2);
291     nvp->w2 = xive_set_field32(NVP2_W2_CPPR, nvp->w2, 0);
292     xive2_router_write_nvp(xrtr, nvp_blk, nvp_idx, nvp, 2);
293 
294     tctx->regs[TM_QW1_OS + TM_CPPR] = cppr;
295     /* we don't model LSMFB */
296 
297     nvp->w1 = xive_set_field32(NVP2_W1_CO, nvp->w1, 1);
298     nvp->w1 = xive_set_field32(NVP2_W1_CO_THRID_VALID, nvp->w1, 1);
299     nvp->w1 = xive_set_field32(NVP2_W1_CO_THRID, nvp->w1, pir);
300 
301     /*
302      * Checkout privilege: 0:OS, 1:Pool, 2:Hard
303      *
304      * TODO: we only support OS push/pull
305      */
306     nvp->w1 = xive_set_field32(NVP2_W1_CO_PRIV, nvp->w1, 0);
307 
308     xive2_router_write_nvp(xrtr, nvp_blk, nvp_idx, nvp, 1);
309 
310     /* return restored CPPR to generate a CPU exception if needed */
311     return cppr;
312 }
313 
314 static void xive2_tctx_need_resend(Xive2Router *xrtr, XiveTCTX *tctx,
315                                    uint8_t nvp_blk, uint32_t nvp_idx,
316                                    bool do_restore)
317 {
318     Xive2Nvp nvp;
319     uint8_t ipb;
320 
321     /*
322      * Grab the associated thread interrupt context registers in the
323      * associated NVP
324      */
325     if (xive2_router_get_nvp(xrtr, nvp_blk, nvp_idx, &nvp)) {
326         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: No NVP %x/%x\n",
327                       nvp_blk, nvp_idx);
328         return;
329     }
330 
331     if (!xive2_nvp_is_valid(&nvp)) {
332         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: invalid NVP %x/%x\n",
333                       nvp_blk, nvp_idx);
334         return;
335     }
336 
337     /* Automatically restore thread context registers */
338     if (xive2_router_get_config(xrtr) & XIVE2_VP_SAVE_RESTORE &&
339         do_restore) {
340         xive2_tctx_restore_os_ctx(xrtr, tctx, nvp_blk, nvp_idx, &nvp);
341     }
342 
343     ipb = xive_get_field32(NVP2_W2_IPB, nvp.w2);
344     if (ipb) {
345         nvp.w2 = xive_set_field32(NVP2_W2_IPB, nvp.w2, 0);
346         xive2_router_write_nvp(xrtr, nvp_blk, nvp_idx, &nvp, 2);
347     }
348     /*
349      * Always call xive_tctx_ipb_update(). Even if there were no
350      * escalation triggered, there could be a pending interrupt which
351      * was saved when the context was pulled and that we need to take
352      * into account by recalculating the PIPR (which is not
353      * saved/restored).
354      * It will also raise the External interrupt signal if needed.
355      */
356     xive_tctx_ipb_update(tctx, TM_QW1_OS, ipb);
357 }
358 
359 /*
360  * Updating the OS CAM line can trigger a resend of interrupt
361  */
362 void xive2_tm_push_os_ctx(XivePresenter *xptr, XiveTCTX *tctx,
363                           hwaddr offset, uint64_t value, unsigned size)
364 {
365     uint32_t cam = value;
366     uint32_t qw1w2 = cpu_to_be32(cam);
367     uint8_t nvp_blk;
368     uint32_t nvp_idx;
369     bool vo;
370     bool do_restore;
371 
372     xive2_os_cam_decode(cam, &nvp_blk, &nvp_idx, &vo, &do_restore);
373 
374     /* First update the thead context */
375     memcpy(&tctx->regs[TM_QW1_OS + TM_WORD2], &qw1w2, 4);
376 
377     /* Check the interrupt pending bits */
378     if (vo) {
379         xive2_tctx_need_resend(XIVE2_ROUTER(xptr), tctx, nvp_blk, nvp_idx,
380                                do_restore);
381     }
382 }
383 
384 /*
385  * XIVE Router (aka. Virtualization Controller or IVRE)
386  */
387 
388 int xive2_router_get_eas(Xive2Router *xrtr, uint8_t eas_blk, uint32_t eas_idx,
389                          Xive2Eas *eas)
390 {
391     Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
392 
393     return xrc->get_eas(xrtr, eas_blk, eas_idx, eas);
394 }
395 
396 static
397 int xive2_router_get_pq(Xive2Router *xrtr, uint8_t eas_blk, uint32_t eas_idx,
398                        uint8_t *pq)
399 {
400     Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
401 
402     return xrc->get_pq(xrtr, eas_blk, eas_idx, pq);
403 }
404 
405 static
406 int xive2_router_set_pq(Xive2Router *xrtr, uint8_t eas_blk, uint32_t eas_idx,
407                        uint8_t *pq)
408 {
409     Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
410 
411     return xrc->set_pq(xrtr, eas_blk, eas_idx, pq);
412 }
413 
414 int xive2_router_get_end(Xive2Router *xrtr, uint8_t end_blk, uint32_t end_idx,
415                          Xive2End *end)
416 {
417    Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
418 
419    return xrc->get_end(xrtr, end_blk, end_idx, end);
420 }
421 
422 int xive2_router_write_end(Xive2Router *xrtr, uint8_t end_blk, uint32_t end_idx,
423                            Xive2End *end, uint8_t word_number)
424 {
425    Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
426 
427    return xrc->write_end(xrtr, end_blk, end_idx, end, word_number);
428 }
429 
430 int xive2_router_get_nvp(Xive2Router *xrtr, uint8_t nvp_blk, uint32_t nvp_idx,
431                          Xive2Nvp *nvp)
432 {
433    Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
434 
435    return xrc->get_nvp(xrtr, nvp_blk, nvp_idx, nvp);
436 }
437 
438 int xive2_router_write_nvp(Xive2Router *xrtr, uint8_t nvp_blk, uint32_t nvp_idx,
439                            Xive2Nvp *nvp, uint8_t word_number)
440 {
441    Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
442 
443    return xrc->write_nvp(xrtr, nvp_blk, nvp_idx, nvp, word_number);
444 }
445 
446 static int xive2_router_get_block_id(Xive2Router *xrtr)
447 {
448    Xive2RouterClass *xrc = XIVE2_ROUTER_GET_CLASS(xrtr);
449 
450    return xrc->get_block_id(xrtr);
451 }
452 
453 /*
454  * Encode the HW CAM line with 7bit or 8bit thread id. The thread id
455  * width and block id width is configurable at the IC level.
456  *
457  *    chipid << 24 | 0000 0000 0000 0000 1 threadid (7Bit)
458  *    chipid << 24 | 0000 0000 0000 0001 threadid   (8Bit)
459  */
460 static uint32_t xive2_tctx_hw_cam_line(XivePresenter *xptr, XiveTCTX *tctx)
461 {
462     Xive2Router *xrtr = XIVE2_ROUTER(xptr);
463     CPUPPCState *env = &POWERPC_CPU(tctx->cs)->env;
464     uint32_t pir = env->spr_cb[SPR_PIR].default_value;
465     uint8_t blk = xive2_router_get_block_id(xrtr);
466     uint8_t tid_shift =
467         xive2_router_get_config(xrtr) & XIVE2_THREADID_8BITS ? 8 : 7;
468     uint8_t tid_mask = (1 << tid_shift) - 1;
469 
470     return xive2_nvp_cam_line(blk, 1 << tid_shift | (pir & tid_mask));
471 }
472 
473 /*
474  * The thread context register words are in big-endian format.
475  */
476 int xive2_presenter_tctx_match(XivePresenter *xptr, XiveTCTX *tctx,
477                                uint8_t format,
478                                uint8_t nvt_blk, uint32_t nvt_idx,
479                                bool cam_ignore, uint32_t logic_serv)
480 {
481     uint32_t cam =   xive2_nvp_cam_line(nvt_blk, nvt_idx);
482     uint32_t qw3w2 = xive_tctx_word2(&tctx->regs[TM_QW3_HV_PHYS]);
483     uint32_t qw2w2 = xive_tctx_word2(&tctx->regs[TM_QW2_HV_POOL]);
484     uint32_t qw1w2 = xive_tctx_word2(&tctx->regs[TM_QW1_OS]);
485     uint32_t qw0w2 = xive_tctx_word2(&tctx->regs[TM_QW0_USER]);
486 
487     /*
488      * TODO (PowerNV): ignore mode. The low order bits of the NVT
489      * identifier are ignored in the "CAM" match.
490      */
491 
492     if (format == 0) {
493         if (cam_ignore == true) {
494             /*
495              * F=0 & i=1: Logical server notification (bits ignored at
496              * the end of the NVT identifier)
497              */
498             qemu_log_mask(LOG_UNIMP, "XIVE: no support for LS NVT %x/%x\n",
499                           nvt_blk, nvt_idx);
500             return -1;
501         }
502 
503         /* F=0 & i=0: Specific NVT notification */
504 
505         /* PHYS ring */
506         if ((be32_to_cpu(qw3w2) & TM2_QW3W2_VT) &&
507             cam == xive2_tctx_hw_cam_line(xptr, tctx)) {
508             return TM_QW3_HV_PHYS;
509         }
510 
511         /* HV POOL ring */
512         if ((be32_to_cpu(qw2w2) & TM2_QW2W2_VP) &&
513             cam == xive_get_field32(TM2_QW2W2_POOL_CAM, qw2w2)) {
514             return TM_QW2_HV_POOL;
515         }
516 
517         /* OS ring */
518         if ((be32_to_cpu(qw1w2) & TM2_QW1W2_VO) &&
519             cam == xive_get_field32(TM2_QW1W2_OS_CAM, qw1w2)) {
520             return TM_QW1_OS;
521         }
522     } else {
523         /* F=1 : User level Event-Based Branch (EBB) notification */
524 
525         /* USER ring */
526         if  ((be32_to_cpu(qw1w2) & TM2_QW1W2_VO) &&
527              (cam == xive_get_field32(TM2_QW1W2_OS_CAM, qw1w2)) &&
528              (be32_to_cpu(qw0w2) & TM2_QW0W2_VU) &&
529              (logic_serv == xive_get_field32(TM2_QW0W2_LOGIC_SERV, qw0w2))) {
530             return TM_QW0_USER;
531         }
532     }
533     return -1;
534 }
535 
536 static void xive2_router_realize(DeviceState *dev, Error **errp)
537 {
538     Xive2Router *xrtr = XIVE2_ROUTER(dev);
539 
540     assert(xrtr->xfb);
541 }
542 
543 /*
544  * Notification using the END ESe/ESn bit (Event State Buffer for
545  * escalation and notification). Profide futher coalescing in the
546  * Router.
547  */
548 static bool xive2_router_end_es_notify(Xive2Router *xrtr, uint8_t end_blk,
549                                        uint32_t end_idx, Xive2End *end,
550                                        uint32_t end_esmask)
551 {
552     uint8_t pq = xive_get_field32(end_esmask, end->w1);
553     bool notify = xive_esb_trigger(&pq);
554 
555     if (pq != xive_get_field32(end_esmask, end->w1)) {
556         end->w1 = xive_set_field32(end_esmask, end->w1, pq);
557         xive2_router_write_end(xrtr, end_blk, end_idx, end, 1);
558     }
559 
560     /* ESe/n[Q]=1 : end of notification */
561     return notify;
562 }
563 
564 /*
565  * An END trigger can come from an event trigger (IPI or HW) or from
566  * another chip. We don't model the PowerBus but the END trigger
567  * message has the same parameters than in the function below.
568  */
569 static void xive2_router_end_notify(Xive2Router *xrtr, uint8_t end_blk,
570                                     uint32_t end_idx, uint32_t end_data)
571 {
572     Xive2End end;
573     uint8_t priority;
574     uint8_t format;
575     bool found;
576     Xive2Nvp nvp;
577     uint8_t nvp_blk;
578     uint32_t nvp_idx;
579 
580     /* END cache lookup */
581     if (xive2_router_get_end(xrtr, end_blk, end_idx, &end)) {
582         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: No END %x/%x\n", end_blk,
583                       end_idx);
584         return;
585     }
586 
587     if (!xive2_end_is_valid(&end)) {
588         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: END %x/%x is invalid\n",
589                       end_blk, end_idx);
590         return;
591     }
592 
593     if (xive2_end_is_enqueue(&end)) {
594         xive2_end_enqueue(&end, end_data);
595         /* Enqueuing event data modifies the EQ toggle and index */
596         xive2_router_write_end(xrtr, end_blk, end_idx, &end, 1);
597     }
598 
599     /*
600      * When the END is silent, we skip the notification part.
601      */
602     if (xive2_end_is_silent_escalation(&end)) {
603         goto do_escalation;
604     }
605 
606     /*
607      * The W7 format depends on the F bit in W6. It defines the type
608      * of the notification :
609      *
610      *   F=0 : single or multiple NVP notification
611      *   F=1 : User level Event-Based Branch (EBB) notification, no
612      *         priority
613      */
614     format = xive_get_field32(END2_W6_FORMAT_BIT, end.w6);
615     priority = xive_get_field32(END2_W7_F0_PRIORITY, end.w7);
616 
617     /* The END is masked */
618     if (format == 0 && priority == 0xff) {
619         return;
620     }
621 
622     /*
623      * Check the END ESn (Event State Buffer for notification) for
624      * even futher coalescing in the Router
625      */
626     if (!xive2_end_is_notify(&end)) {
627         /* ESn[Q]=1 : end of notification */
628         if (!xive2_router_end_es_notify(xrtr, end_blk, end_idx,
629                                        &end, END2_W1_ESn)) {
630             return;
631         }
632     }
633 
634     /*
635      * Follows IVPE notification
636      */
637     nvp_blk = xive_get_field32(END2_W6_VP_BLOCK, end.w6);
638     nvp_idx = xive_get_field32(END2_W6_VP_OFFSET, end.w6);
639 
640     /* NVP cache lookup */
641     if (xive2_router_get_nvp(xrtr, nvp_blk, nvp_idx, &nvp)) {
642         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: no NVP %x/%x\n",
643                       nvp_blk, nvp_idx);
644         return;
645     }
646 
647     if (!xive2_nvp_is_valid(&nvp)) {
648         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: NVP %x/%x is invalid\n",
649                       nvp_blk, nvp_idx);
650         return;
651     }
652 
653     found = xive_presenter_notify(xrtr->xfb, format, nvp_blk, nvp_idx,
654                           xive_get_field32(END2_W6_IGNORE, end.w7),
655                           priority,
656                           xive_get_field32(END2_W7_F1_LOG_SERVER_ID, end.w7));
657 
658     /* TODO: Auto EOI. */
659 
660     if (found) {
661         return;
662     }
663 
664     /*
665      * If no matching NVP is dispatched on a HW thread :
666      * - specific VP: update the NVP structure if backlog is activated
667      * - logical server : forward request to IVPE (not supported)
668      */
669     if (xive2_end_is_backlog(&end)) {
670         uint8_t ipb;
671 
672         if (format == 1) {
673             qemu_log_mask(LOG_GUEST_ERROR,
674                           "XIVE: END %x/%x invalid config: F1 & backlog\n",
675                           end_blk, end_idx);
676             return;
677         }
678 
679         /*
680          * Record the IPB in the associated NVP structure for later
681          * use. The presenter will resend the interrupt when the vCPU
682          * is dispatched again on a HW thread.
683          */
684         ipb = xive_get_field32(NVP2_W2_IPB, nvp.w2) |
685             xive_priority_to_ipb(priority);
686         nvp.w2 = xive_set_field32(NVP2_W2_IPB, nvp.w2, ipb);
687         xive2_router_write_nvp(xrtr, nvp_blk, nvp_idx, &nvp, 2);
688 
689         /*
690          * On HW, follows a "Broadcast Backlog" to IVPEs
691          */
692     }
693 
694 do_escalation:
695     /*
696      * If activated, escalate notification using the ESe PQ bits and
697      * the EAS in w4-5
698      */
699     if (!xive2_end_is_escalate(&end)) {
700         return;
701     }
702 
703     /*
704      * Check the END ESe (Event State Buffer for escalation) for even
705      * futher coalescing in the Router
706      */
707     if (!xive2_end_is_uncond_escalation(&end)) {
708         /* ESe[Q]=1 : end of escalation notification */
709         if (!xive2_router_end_es_notify(xrtr, end_blk, end_idx,
710                                        &end, END2_W1_ESe)) {
711             return;
712         }
713     }
714 
715     /*
716      * The END trigger becomes an Escalation trigger
717      */
718     xive2_router_end_notify(xrtr,
719                            xive_get_field32(END2_W4_END_BLOCK,     end.w4),
720                            xive_get_field32(END2_W4_ESC_END_INDEX, end.w4),
721                            xive_get_field32(END2_W5_ESC_END_DATA,  end.w5));
722 }
723 
724 void xive2_router_notify(XiveNotifier *xn, uint32_t lisn, bool pq_checked)
725 {
726     Xive2Router *xrtr = XIVE2_ROUTER(xn);
727     uint8_t eas_blk = XIVE_EAS_BLOCK(lisn);
728     uint32_t eas_idx = XIVE_EAS_INDEX(lisn);
729     Xive2Eas eas;
730 
731     /* EAS cache lookup */
732     if (xive2_router_get_eas(xrtr, eas_blk, eas_idx, &eas)) {
733         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: Unknown LISN %x\n", lisn);
734         return;
735     }
736 
737     if (!pq_checked) {
738         bool notify;
739         uint8_t pq;
740 
741         /* PQ cache lookup */
742         if (xive2_router_get_pq(xrtr, eas_blk, eas_idx, &pq)) {
743             /* Set FIR */
744             g_assert_not_reached();
745         }
746 
747         notify = xive_esb_trigger(&pq);
748 
749         if (xive2_router_set_pq(xrtr, eas_blk, eas_idx, &pq)) {
750             /* Set FIR */
751             g_assert_not_reached();
752         }
753 
754         if (!notify) {
755             return;
756         }
757     }
758 
759     if (!xive2_eas_is_valid(&eas)) {
760         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: Invalid LISN %x\n", lisn);
761         return;
762     }
763 
764     if (xive2_eas_is_masked(&eas)) {
765         /* Notification completed */
766         return;
767     }
768 
769     /*
770      * The event trigger becomes an END trigger
771      */
772     xive2_router_end_notify(xrtr,
773                              xive_get_field64(EAS2_END_BLOCK, eas.w),
774                              xive_get_field64(EAS2_END_INDEX, eas.w),
775                              xive_get_field64(EAS2_END_DATA,  eas.w));
776 }
777 
778 static Property xive2_router_properties[] = {
779     DEFINE_PROP_LINK("xive-fabric", Xive2Router, xfb,
780                      TYPE_XIVE_FABRIC, XiveFabric *),
781     DEFINE_PROP_END_OF_LIST(),
782 };
783 
784 static void xive2_router_class_init(ObjectClass *klass, void *data)
785 {
786     DeviceClass *dc = DEVICE_CLASS(klass);
787     XiveNotifierClass *xnc = XIVE_NOTIFIER_CLASS(klass);
788 
789     dc->desc    = "XIVE2 Router Engine";
790     device_class_set_props(dc, xive2_router_properties);
791     /* Parent is SysBusDeviceClass. No need to call its realize hook */
792     dc->realize = xive2_router_realize;
793     xnc->notify = xive2_router_notify;
794 }
795 
796 static const TypeInfo xive2_router_info = {
797     .name          = TYPE_XIVE2_ROUTER,
798     .parent        = TYPE_SYS_BUS_DEVICE,
799     .abstract      = true,
800     .instance_size = sizeof(Xive2Router),
801     .class_size    = sizeof(Xive2RouterClass),
802     .class_init    = xive2_router_class_init,
803     .interfaces    = (InterfaceInfo[]) {
804         { TYPE_XIVE_NOTIFIER },
805         { TYPE_XIVE_PRESENTER },
806         { }
807     }
808 };
809 
810 static inline bool addr_is_even(hwaddr addr, uint32_t shift)
811 {
812     return !((addr >> shift) & 1);
813 }
814 
815 static uint64_t xive2_end_source_read(void *opaque, hwaddr addr, unsigned size)
816 {
817     Xive2EndSource *xsrc = XIVE2_END_SOURCE(opaque);
818     uint32_t offset = addr & 0xFFF;
819     uint8_t end_blk;
820     uint32_t end_idx;
821     Xive2End end;
822     uint32_t end_esmask;
823     uint8_t pq;
824     uint64_t ret;
825 
826     /*
827      * The block id should be deduced from the load address on the END
828      * ESB MMIO but our model only supports a single block per XIVE chip.
829      */
830     end_blk = xive2_router_get_block_id(xsrc->xrtr);
831     end_idx = addr >> (xsrc->esb_shift + 1);
832 
833     if (xive2_router_get_end(xsrc->xrtr, end_blk, end_idx, &end)) {
834         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: No END %x/%x\n", end_blk,
835                       end_idx);
836         return -1;
837     }
838 
839     if (!xive2_end_is_valid(&end)) {
840         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: END %x/%x is invalid\n",
841                       end_blk, end_idx);
842         return -1;
843     }
844 
845     end_esmask = addr_is_even(addr, xsrc->esb_shift) ? END2_W1_ESn :
846         END2_W1_ESe;
847     pq = xive_get_field32(end_esmask, end.w1);
848 
849     switch (offset) {
850     case XIVE_ESB_LOAD_EOI ... XIVE_ESB_LOAD_EOI + 0x7FF:
851         ret = xive_esb_eoi(&pq);
852 
853         /* Forward the source event notification for routing ?? */
854         break;
855 
856     case XIVE_ESB_GET ... XIVE_ESB_GET + 0x3FF:
857         ret = pq;
858         break;
859 
860     case XIVE_ESB_SET_PQ_00 ... XIVE_ESB_SET_PQ_00 + 0x0FF:
861     case XIVE_ESB_SET_PQ_01 ... XIVE_ESB_SET_PQ_01 + 0x0FF:
862     case XIVE_ESB_SET_PQ_10 ... XIVE_ESB_SET_PQ_10 + 0x0FF:
863     case XIVE_ESB_SET_PQ_11 ... XIVE_ESB_SET_PQ_11 + 0x0FF:
864         ret = xive_esb_set(&pq, (offset >> 8) & 0x3);
865         break;
866     default:
867         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: invalid END ESB load addr %d\n",
868                       offset);
869         return -1;
870     }
871 
872     if (pq != xive_get_field32(end_esmask, end.w1)) {
873         end.w1 = xive_set_field32(end_esmask, end.w1, pq);
874         xive2_router_write_end(xsrc->xrtr, end_blk, end_idx, &end, 1);
875     }
876 
877     return ret;
878 }
879 
880 static void xive2_end_source_write(void *opaque, hwaddr addr,
881                                    uint64_t value, unsigned size)
882 {
883     Xive2EndSource *xsrc = XIVE2_END_SOURCE(opaque);
884     uint32_t offset = addr & 0xFFF;
885     uint8_t end_blk;
886     uint32_t end_idx;
887     Xive2End end;
888     uint32_t end_esmask;
889     uint8_t pq;
890     bool notify = false;
891 
892     /*
893      * The block id should be deduced from the load address on the END
894      * ESB MMIO but our model only supports a single block per XIVE chip.
895      */
896     end_blk = xive2_router_get_block_id(xsrc->xrtr);
897     end_idx = addr >> (xsrc->esb_shift + 1);
898 
899     if (xive2_router_get_end(xsrc->xrtr, end_blk, end_idx, &end)) {
900         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: No END %x/%x\n", end_blk,
901                       end_idx);
902         return;
903     }
904 
905     if (!xive2_end_is_valid(&end)) {
906         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: END %x/%x is invalid\n",
907                       end_blk, end_idx);
908         return;
909     }
910 
911     end_esmask = addr_is_even(addr, xsrc->esb_shift) ? END2_W1_ESn :
912         END2_W1_ESe;
913     pq = xive_get_field32(end_esmask, end.w1);
914 
915     switch (offset) {
916     case 0 ... 0x3FF:
917         notify = xive_esb_trigger(&pq);
918         break;
919 
920     case XIVE_ESB_STORE_EOI ... XIVE_ESB_STORE_EOI + 0x3FF:
921         /* TODO: can we check StoreEOI availability from the router ? */
922         notify = xive_esb_eoi(&pq);
923         break;
924 
925     case XIVE_ESB_INJECT ... XIVE_ESB_INJECT + 0x3FF:
926         if (end_esmask == END2_W1_ESe) {
927             qemu_log_mask(LOG_GUEST_ERROR,
928                           "XIVE: END %x/%x can not EQ inject on ESe\n",
929                            end_blk, end_idx);
930             return;
931         }
932         notify = true;
933         break;
934 
935     default:
936         qemu_log_mask(LOG_GUEST_ERROR, "XIVE: invalid END ESB write addr %d\n",
937                       offset);
938         return;
939     }
940 
941     if (pq != xive_get_field32(end_esmask, end.w1)) {
942         end.w1 = xive_set_field32(end_esmask, end.w1, pq);
943         xive2_router_write_end(xsrc->xrtr, end_blk, end_idx, &end, 1);
944     }
945 
946     /* TODO: Forward the source event notification for routing */
947     if (notify) {
948         ;
949     }
950 }
951 
952 static const MemoryRegionOps xive2_end_source_ops = {
953     .read = xive2_end_source_read,
954     .write = xive2_end_source_write,
955     .endianness = DEVICE_BIG_ENDIAN,
956     .valid = {
957         .min_access_size = 1,
958         .max_access_size = 8,
959     },
960     .impl = {
961         .min_access_size = 1,
962         .max_access_size = 8,
963     },
964 };
965 
966 static void xive2_end_source_realize(DeviceState *dev, Error **errp)
967 {
968     Xive2EndSource *xsrc = XIVE2_END_SOURCE(dev);
969 
970     assert(xsrc->xrtr);
971 
972     if (!xsrc->nr_ends) {
973         error_setg(errp, "Number of interrupt needs to be greater than 0");
974         return;
975     }
976 
977     if (xsrc->esb_shift != XIVE_ESB_4K &&
978         xsrc->esb_shift != XIVE_ESB_64K) {
979         error_setg(errp, "Invalid ESB shift setting");
980         return;
981     }
982 
983     /*
984      * Each END is assigned an even/odd pair of MMIO pages, the even page
985      * manages the ESn field while the odd page manages the ESe field.
986      */
987     memory_region_init_io(&xsrc->esb_mmio, OBJECT(xsrc),
988                           &xive2_end_source_ops, xsrc, "xive.end",
989                           (1ull << (xsrc->esb_shift + 1)) * xsrc->nr_ends);
990 }
991 
992 static Property xive2_end_source_properties[] = {
993     DEFINE_PROP_UINT32("nr-ends", Xive2EndSource, nr_ends, 0),
994     DEFINE_PROP_UINT32("shift", Xive2EndSource, esb_shift, XIVE_ESB_64K),
995     DEFINE_PROP_LINK("xive", Xive2EndSource, xrtr, TYPE_XIVE2_ROUTER,
996                      Xive2Router *),
997     DEFINE_PROP_END_OF_LIST(),
998 };
999 
1000 static void xive2_end_source_class_init(ObjectClass *klass, void *data)
1001 {
1002     DeviceClass *dc = DEVICE_CLASS(klass);
1003 
1004     dc->desc    = "XIVE END Source";
1005     device_class_set_props(dc, xive2_end_source_properties);
1006     dc->realize = xive2_end_source_realize;
1007     dc->user_creatable = false;
1008 }
1009 
1010 static const TypeInfo xive2_end_source_info = {
1011     .name          = TYPE_XIVE2_END_SOURCE,
1012     .parent        = TYPE_DEVICE,
1013     .instance_size = sizeof(Xive2EndSource),
1014     .class_init    = xive2_end_source_class_init,
1015 };
1016 
1017 static void xive2_register_types(void)
1018 {
1019     type_register_static(&xive2_router_info);
1020     type_register_static(&xive2_end_source_info);
1021 }
1022 
1023 type_init(xive2_register_types)
1024