pseries: Cleanup duplications of ics_valid_irq() code
[qemu/ar7.git] / hw / xics.c
blobff4b5e210f90c3e817972c2ca1fcb26bdb6552af
1 /*
2 * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator
4 * PAPR Virtualized Interrupt System, aka ICS/ICP aka xics
6 * Copyright (c) 2010,2011 David Gibson, IBM Corporation.
8 * Permission is hereby granted, free of charge, to any person obtaining a copy
9 * of this software and associated documentation files (the "Software"), to deal
10 * in the Software without restriction, including without limitation the rights
11 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
12 * copies of the Software, and to permit persons to whom the Software is
13 * furnished to do so, subject to the following conditions:
15 * The above copyright notice and this permission notice shall be included in
16 * all copies or substantial portions of the Software.
18 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
19 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
20 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
21 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
22 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
23 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
24 * THE SOFTWARE.
28 #include "hw.h"
29 #include "hw/spapr.h"
30 #include "hw/xics.h"
33 * ICP: Presentation layer
36 struct icp_server_state {
37 uint32_t xirr;
38 uint8_t pending_priority;
39 uint8_t mfrr;
40 qemu_irq output;
43 #define XISR_MASK 0x00ffffff
44 #define CPPR_MASK 0xff000000
46 #define XISR(ss) (((ss)->xirr) & XISR_MASK)
47 #define CPPR(ss) (((ss)->xirr) >> 24)
49 struct ics_state;
51 struct icp_state {
52 long nr_servers;
53 struct icp_server_state *ss;
54 struct ics_state *ics;
57 static void ics_reject(struct ics_state *ics, int nr);
58 static void ics_resend(struct ics_state *ics);
59 static void ics_eoi(struct ics_state *ics, int nr);
61 static void icp_check_ipi(struct icp_state *icp, int server)
63 struct icp_server_state *ss = icp->ss + server;
65 if (XISR(ss) && (ss->pending_priority <= ss->mfrr)) {
66 return;
69 if (XISR(ss)) {
70 ics_reject(icp->ics, XISR(ss));
73 ss->xirr = (ss->xirr & ~XISR_MASK) | XICS_IPI;
74 ss->pending_priority = ss->mfrr;
75 qemu_irq_raise(ss->output);
78 static void icp_resend(struct icp_state *icp, int server)
80 struct icp_server_state *ss = icp->ss + server;
82 if (ss->mfrr < CPPR(ss)) {
83 icp_check_ipi(icp, server);
85 ics_resend(icp->ics);
88 static void icp_set_cppr(struct icp_state *icp, int server, uint8_t cppr)
90 struct icp_server_state *ss = icp->ss + server;
91 uint8_t old_cppr;
92 uint32_t old_xisr;
94 old_cppr = CPPR(ss);
95 ss->xirr = (ss->xirr & ~CPPR_MASK) | (cppr << 24);
97 if (cppr < old_cppr) {
98 if (XISR(ss) && (cppr <= ss->pending_priority)) {
99 old_xisr = XISR(ss);
100 ss->xirr &= ~XISR_MASK; /* Clear XISR */
101 qemu_irq_lower(ss->output);
102 ics_reject(icp->ics, old_xisr);
104 } else {
105 if (!XISR(ss)) {
106 icp_resend(icp, server);
111 static void icp_set_mfrr(struct icp_state *icp, int server, uint8_t mfrr)
113 struct icp_server_state *ss = icp->ss + server;
115 ss->mfrr = mfrr;
116 if (mfrr < CPPR(ss)) {
117 icp_check_ipi(icp, server);
121 static uint32_t icp_accept(struct icp_server_state *ss)
123 uint32_t xirr;
125 qemu_irq_lower(ss->output);
126 xirr = ss->xirr;
127 ss->xirr = ss->pending_priority << 24;
128 return xirr;
131 static void icp_eoi(struct icp_state *icp, int server, uint32_t xirr)
133 struct icp_server_state *ss = icp->ss + server;
135 /* Send EOI -> ICS */
136 ss->xirr = (ss->xirr & ~CPPR_MASK) | (xirr & CPPR_MASK);
137 ics_eoi(icp->ics, xirr & XISR_MASK);
138 if (!XISR(ss)) {
139 icp_resend(icp, server);
143 static void icp_irq(struct icp_state *icp, int server, int nr, uint8_t priority)
145 struct icp_server_state *ss = icp->ss + server;
147 if ((priority >= CPPR(ss))
148 || (XISR(ss) && (ss->pending_priority <= priority))) {
149 ics_reject(icp->ics, nr);
150 } else {
151 if (XISR(ss)) {
152 ics_reject(icp->ics, XISR(ss));
154 ss->xirr = (ss->xirr & ~XISR_MASK) | (nr & XISR_MASK);
155 ss->pending_priority = priority;
156 qemu_irq_raise(ss->output);
161 * ICS: Source layer
164 struct ics_irq_state {
165 int server;
166 uint8_t priority;
167 uint8_t saved_priority;
168 #define XICS_STATUS_ASSERTED 0x1
169 #define XICS_STATUS_SENT 0x2
170 #define XICS_STATUS_REJECTED 0x4
171 #define XICS_STATUS_MASKED_PENDING 0x8
172 uint8_t status;
173 bool lsi;
176 struct ics_state {
177 int nr_irqs;
178 int offset;
179 qemu_irq *qirqs;
180 struct ics_irq_state *irqs;
181 struct icp_state *icp;
184 static int ics_valid_irq(struct ics_state *ics, uint32_t nr)
186 return (nr >= ics->offset)
187 && (nr < (ics->offset + ics->nr_irqs));
190 static void resend_msi(struct ics_state *ics, int srcno)
192 struct ics_irq_state *irq = ics->irqs + srcno;
194 /* FIXME: filter by server#? */
195 if (irq->status & XICS_STATUS_REJECTED) {
196 irq->status &= ~XICS_STATUS_REJECTED;
197 if (irq->priority != 0xff) {
198 icp_irq(ics->icp, irq->server, srcno + ics->offset,
199 irq->priority);
204 static void resend_lsi(struct ics_state *ics, int srcno)
206 struct ics_irq_state *irq = ics->irqs + srcno;
208 if ((irq->priority != 0xff)
209 && (irq->status & XICS_STATUS_ASSERTED)
210 && !(irq->status & XICS_STATUS_SENT)) {
211 irq->status |= XICS_STATUS_SENT;
212 icp_irq(ics->icp, irq->server, srcno + ics->offset, irq->priority);
216 static void set_irq_msi(struct ics_state *ics, int srcno, int val)
218 struct ics_irq_state *irq = ics->irqs + srcno;
220 if (val) {
221 if (irq->priority == 0xff) {
222 irq->status |= XICS_STATUS_MASKED_PENDING;
223 /* masked pending */ ;
224 } else {
225 icp_irq(ics->icp, irq->server, srcno + ics->offset, irq->priority);
230 static void set_irq_lsi(struct ics_state *ics, int srcno, int val)
232 struct ics_irq_state *irq = ics->irqs + srcno;
234 if (val) {
235 irq->status |= XICS_STATUS_ASSERTED;
236 } else {
237 irq->status &= ~XICS_STATUS_ASSERTED;
239 resend_lsi(ics, srcno);
242 static void ics_set_irq(void *opaque, int srcno, int val)
244 struct ics_state *ics = (struct ics_state *)opaque;
245 struct ics_irq_state *irq = ics->irqs + srcno;
247 if (irq->lsi) {
248 set_irq_lsi(ics, srcno, val);
249 } else {
250 set_irq_msi(ics, srcno, val);
254 static void write_xive_msi(struct ics_state *ics, int srcno)
256 struct ics_irq_state *irq = ics->irqs + srcno;
258 if (!(irq->status & XICS_STATUS_MASKED_PENDING)
259 || (irq->priority == 0xff)) {
260 return;
263 irq->status &= ~XICS_STATUS_MASKED_PENDING;
264 icp_irq(ics->icp, irq->server, srcno + ics->offset, irq->priority);
267 static void write_xive_lsi(struct ics_state *ics, int srcno)
269 resend_lsi(ics, srcno);
272 static void ics_write_xive(struct ics_state *ics, int nr, int server,
273 uint8_t priority, uint8_t saved_priority)
275 int srcno = nr - ics->offset;
276 struct ics_irq_state *irq = ics->irqs + srcno;
278 irq->server = server;
279 irq->priority = priority;
280 irq->saved_priority = saved_priority;
282 if (irq->lsi) {
283 write_xive_lsi(ics, srcno);
284 } else {
285 write_xive_msi(ics, srcno);
289 static void ics_reject(struct ics_state *ics, int nr)
291 struct ics_irq_state *irq = ics->irqs + nr - ics->offset;
293 irq->status |= XICS_STATUS_REJECTED; /* Irrelevant but harmless for LSI */
294 irq->status &= ~XICS_STATUS_SENT; /* Irrelevant but harmless for MSI */
297 static void ics_resend(struct ics_state *ics)
299 int i;
301 for (i = 0; i < ics->nr_irqs; i++) {
302 struct ics_irq_state *irq = ics->irqs + i;
304 /* FIXME: filter by server#? */
305 if (irq->lsi) {
306 resend_lsi(ics, i);
307 } else {
308 resend_msi(ics, i);
313 static void ics_eoi(struct ics_state *ics, int nr)
315 int srcno = nr - ics->offset;
316 struct ics_irq_state *irq = ics->irqs + srcno;
318 if (irq->lsi) {
319 irq->status &= ~XICS_STATUS_SENT;
324 * Exported functions
327 qemu_irq xics_get_qirq(struct icp_state *icp, int irq)
329 if (!ics_valid_irq(icp->ics, irq)) {
330 return NULL;
333 return icp->ics->qirqs[irq - icp->ics->offset];
336 void xics_set_irq_type(struct icp_state *icp, int irq, bool lsi)
338 assert(ics_valid_irq(icp->ics, irq));
340 icp->ics->irqs[irq - icp->ics->offset].lsi = lsi;
343 static target_ulong h_cppr(CPUPPCState *env, sPAPREnvironment *spapr,
344 target_ulong opcode, target_ulong *args)
346 target_ulong cppr = args[0];
348 icp_set_cppr(spapr->icp, env->cpu_index, cppr);
349 return H_SUCCESS;
352 static target_ulong h_ipi(CPUPPCState *env, sPAPREnvironment *spapr,
353 target_ulong opcode, target_ulong *args)
355 target_ulong server = args[0];
356 target_ulong mfrr = args[1];
358 if (server >= spapr->icp->nr_servers) {
359 return H_PARAMETER;
362 icp_set_mfrr(spapr->icp, server, mfrr);
363 return H_SUCCESS;
367 static target_ulong h_xirr(CPUPPCState *env, sPAPREnvironment *spapr,
368 target_ulong opcode, target_ulong *args)
370 uint32_t xirr = icp_accept(spapr->icp->ss + env->cpu_index);
372 args[0] = xirr;
373 return H_SUCCESS;
376 static target_ulong h_eoi(CPUPPCState *env, sPAPREnvironment *spapr,
377 target_ulong opcode, target_ulong *args)
379 target_ulong xirr = args[0];
381 icp_eoi(spapr->icp, env->cpu_index, xirr);
382 return H_SUCCESS;
385 static void rtas_set_xive(sPAPREnvironment *spapr, uint32_t token,
386 uint32_t nargs, target_ulong args,
387 uint32_t nret, target_ulong rets)
389 struct ics_state *ics = spapr->icp->ics;
390 uint32_t nr, server, priority;
392 if ((nargs != 3) || (nret != 1)) {
393 rtas_st(rets, 0, -3);
394 return;
397 nr = rtas_ld(args, 0);
398 server = rtas_ld(args, 1);
399 priority = rtas_ld(args, 2);
401 if (!ics_valid_irq(ics, nr) || (server >= ics->icp->nr_servers)
402 || (priority > 0xff)) {
403 rtas_st(rets, 0, -3);
404 return;
407 ics_write_xive(ics, nr, server, priority, priority);
409 rtas_st(rets, 0, 0); /* Success */
412 static void rtas_get_xive(sPAPREnvironment *spapr, uint32_t token,
413 uint32_t nargs, target_ulong args,
414 uint32_t nret, target_ulong rets)
416 struct ics_state *ics = spapr->icp->ics;
417 uint32_t nr;
419 if ((nargs != 1) || (nret != 3)) {
420 rtas_st(rets, 0, -3);
421 return;
424 nr = rtas_ld(args, 0);
426 if (!ics_valid_irq(ics, nr)) {
427 rtas_st(rets, 0, -3);
428 return;
431 rtas_st(rets, 0, 0); /* Success */
432 rtas_st(rets, 1, ics->irqs[nr - ics->offset].server);
433 rtas_st(rets, 2, ics->irqs[nr - ics->offset].priority);
436 static void rtas_int_off(sPAPREnvironment *spapr, uint32_t token,
437 uint32_t nargs, target_ulong args,
438 uint32_t nret, target_ulong rets)
440 struct ics_state *ics = spapr->icp->ics;
441 uint32_t nr;
443 if ((nargs != 1) || (nret != 1)) {
444 rtas_st(rets, 0, -3);
445 return;
448 nr = rtas_ld(args, 0);
450 if (!ics_valid_irq(ics, nr)) {
451 rtas_st(rets, 0, -3);
452 return;
455 ics_write_xive(ics, nr, ics->irqs[nr - ics->offset].server, 0xff,
456 ics->irqs[nr - ics->offset].priority);
458 rtas_st(rets, 0, 0); /* Success */
461 static void rtas_int_on(sPAPREnvironment *spapr, uint32_t token,
462 uint32_t nargs, target_ulong args,
463 uint32_t nret, target_ulong rets)
465 struct ics_state *ics = spapr->icp->ics;
466 uint32_t nr;
468 if ((nargs != 1) || (nret != 1)) {
469 rtas_st(rets, 0, -3);
470 return;
473 nr = rtas_ld(args, 0);
475 if (!ics_valid_irq(ics, nr)) {
476 rtas_st(rets, 0, -3);
477 return;
480 ics_write_xive(ics, nr, ics->irqs[nr - ics->offset].server,
481 ics->irqs[nr - ics->offset].saved_priority,
482 ics->irqs[nr - ics->offset].saved_priority);
484 rtas_st(rets, 0, 0); /* Success */
487 static void xics_reset(void *opaque)
489 struct icp_state *icp = (struct icp_state *)opaque;
490 struct ics_state *ics = icp->ics;
491 int i;
493 for (i = 0; i < icp->nr_servers; i++) {
494 icp->ss[i].xirr = 0;
495 icp->ss[i].pending_priority = 0;
496 icp->ss[i].mfrr = 0xff;
497 /* Make all outputs are deasserted */
498 qemu_set_irq(icp->ss[i].output, 0);
501 for (i = 0; i < ics->nr_irqs; i++) {
502 /* Reset everything *except* the type */
503 ics->irqs[i].server = 0;
504 ics->irqs[i].status = 0;
505 ics->irqs[i].priority = 0xff;
506 ics->irqs[i].saved_priority = 0xff;
510 struct icp_state *xics_system_init(int nr_irqs)
512 CPUPPCState *env;
513 int max_server_num;
514 struct icp_state *icp;
515 struct ics_state *ics;
517 max_server_num = -1;
518 for (env = first_cpu; env != NULL; env = env->next_cpu) {
519 if (env->cpu_index > max_server_num) {
520 max_server_num = env->cpu_index;
524 icp = g_malloc0(sizeof(*icp));
525 icp->nr_servers = max_server_num + 1;
526 icp->ss = g_malloc0(icp->nr_servers*sizeof(struct icp_server_state));
528 for (env = first_cpu; env != NULL; env = env->next_cpu) {
529 struct icp_server_state *ss = &icp->ss[env->cpu_index];
531 switch (PPC_INPUT(env)) {
532 case PPC_FLAGS_INPUT_POWER7:
533 ss->output = env->irq_inputs[POWER7_INPUT_INT];
534 break;
536 case PPC_FLAGS_INPUT_970:
537 ss->output = env->irq_inputs[PPC970_INPUT_INT];
538 break;
540 default:
541 hw_error("XICS interrupt model does not support this CPU bus "
542 "model\n");
543 exit(1);
547 ics = g_malloc0(sizeof(*ics));
548 ics->nr_irqs = nr_irqs;
549 ics->offset = 16;
550 ics->irqs = g_malloc0(nr_irqs * sizeof(struct ics_irq_state));
552 icp->ics = ics;
553 ics->icp = icp;
555 ics->qirqs = qemu_allocate_irqs(ics_set_irq, ics, nr_irqs);
557 spapr_register_hypercall(H_CPPR, h_cppr);
558 spapr_register_hypercall(H_IPI, h_ipi);
559 spapr_register_hypercall(H_XIRR, h_xirr);
560 spapr_register_hypercall(H_EOI, h_eoi);
562 spapr_rtas_register("ibm,set-xive", rtas_set_xive);
563 spapr_rtas_register("ibm,get-xive", rtas_get_xive);
564 spapr_rtas_register("ibm,int-off", rtas_int_off);
565 spapr_rtas_register("ibm,int-on", rtas_int_on);
567 qemu_register_reset(xics_reset, icp);
569 return icp;