494 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			494 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator
 | |
|  *
 | |
|  * PAPR Virtualized Interrupt System, aka ICS/ICP aka xics
 | |
|  *
 | |
|  * Copyright (c) 2010,2011 David Gibson, IBM Corporation.
 | |
|  *
 | |
|  * Permission is hereby granted, free of charge, to any person obtaining a copy
 | |
|  * of this software and associated documentation files (the "Software"), to deal
 | |
|  * in the Software without restriction, including without limitation the rights
 | |
|  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 | |
|  * copies of the Software, and to permit persons to whom the Software is
 | |
|  * furnished to do so, subject to the following conditions:
 | |
|  *
 | |
|  * The above copyright notice and this permission notice shall be included in
 | |
|  * all copies or substantial portions of the Software.
 | |
|  *
 | |
|  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 | |
|  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 | |
|  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 | |
|  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 | |
|  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 | |
|  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 | |
|  * THE SOFTWARE.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include "hw.h"
 | |
| #include "hw/spapr.h"
 | |
| #include "hw/xics.h"
 | |
| 
 | |
| /*
 | |
|  * ICP: Presentation layer
 | |
|  */
 | |
| 
 | |
| struct icp_server_state {
 | |
|     uint32_t xirr;
 | |
|     uint8_t pending_priority;
 | |
|     uint8_t mfrr;
 | |
|     qemu_irq output;
 | |
| };
 | |
| 
 | |
| #define XISR_MASK  0x00ffffff
 | |
| #define CPPR_MASK  0xff000000
 | |
| 
 | |
| #define XISR(ss)   (((ss)->xirr) & XISR_MASK)
 | |
| #define CPPR(ss)   (((ss)->xirr) >> 24)
 | |
| 
 | |
| struct ics_state;
 | |
| 
 | |
| struct icp_state {
 | |
|     long nr_servers;
 | |
|     struct icp_server_state *ss;
 | |
|     struct ics_state *ics;
 | |
| };
 | |
| 
 | |
| static void ics_reject(struct ics_state *ics, int nr);
 | |
| static void ics_resend(struct ics_state *ics);
 | |
| static void ics_eoi(struct ics_state *ics, int nr);
 | |
| 
 | |
| static void icp_check_ipi(struct icp_state *icp, int server)
 | |
| {
 | |
|     struct icp_server_state *ss = icp->ss + server;
 | |
| 
 | |
|     if (XISR(ss) && (ss->pending_priority <= ss->mfrr)) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     if (XISR(ss)) {
 | |
|         ics_reject(icp->ics, XISR(ss));
 | |
|     }
 | |
| 
 | |
|     ss->xirr = (ss->xirr & ~XISR_MASK) | XICS_IPI;
 | |
|     ss->pending_priority = ss->mfrr;
 | |
|     qemu_irq_raise(ss->output);
 | |
| }
 | |
| 
 | |
| static void icp_resend(struct icp_state *icp, int server)
 | |
| {
 | |
|     struct icp_server_state *ss = icp->ss + server;
 | |
| 
 | |
|     if (ss->mfrr < CPPR(ss)) {
 | |
|         icp_check_ipi(icp, server);
 | |
|     }
 | |
|     ics_resend(icp->ics);
 | |
| }
 | |
| 
 | |
| static void icp_set_cppr(struct icp_state *icp, int server, uint8_t cppr)
 | |
| {
 | |
|     struct icp_server_state *ss = icp->ss + server;
 | |
|     uint8_t old_cppr;
 | |
|     uint32_t old_xisr;
 | |
| 
 | |
|     old_cppr = CPPR(ss);
 | |
|     ss->xirr = (ss->xirr & ~CPPR_MASK) | (cppr << 24);
 | |
| 
 | |
|     if (cppr < old_cppr) {
 | |
|         if (XISR(ss) && (cppr <= ss->pending_priority)) {
 | |
|             old_xisr = XISR(ss);
 | |
|             ss->xirr &= ~XISR_MASK; /* Clear XISR */
 | |
|             qemu_irq_lower(ss->output);
 | |
|             ics_reject(icp->ics, old_xisr);
 | |
|         }
 | |
|     } else {
 | |
|         if (!XISR(ss)) {
 | |
|             icp_resend(icp, server);
 | |
|         }
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void icp_set_mfrr(struct icp_state *icp, int nr, uint8_t mfrr)
 | |
| {
 | |
|     struct icp_server_state *ss = icp->ss + nr;
 | |
| 
 | |
|     ss->mfrr = mfrr;
 | |
|     if (mfrr < CPPR(ss)) {
 | |
|         icp_check_ipi(icp, nr);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static uint32_t icp_accept(struct icp_server_state *ss)
 | |
| {
 | |
|     uint32_t xirr;
 | |
| 
 | |
|     qemu_irq_lower(ss->output);
 | |
|     xirr = ss->xirr;
 | |
|     ss->xirr = ss->pending_priority << 24;
 | |
|     return xirr;
 | |
| }
 | |
| 
 | |
| static void icp_eoi(struct icp_state *icp, int server, uint32_t xirr)
 | |
| {
 | |
|     struct icp_server_state *ss = icp->ss + server;
 | |
| 
 | |
|     ics_eoi(icp->ics, xirr & XISR_MASK);
 | |
|     /* Send EOI -> ICS */
 | |
|     ss->xirr = (ss->xirr & ~CPPR_MASK) | (xirr & CPPR_MASK);
 | |
|     if (!XISR(ss)) {
 | |
|         icp_resend(icp, server);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void icp_irq(struct icp_state *icp, int server, int nr, uint8_t priority)
 | |
| {
 | |
|     struct icp_server_state *ss = icp->ss + server;
 | |
| 
 | |
|     if ((priority >= CPPR(ss))
 | |
|         || (XISR(ss) && (ss->pending_priority <= priority))) {
 | |
|         ics_reject(icp->ics, nr);
 | |
|     } else {
 | |
|         if (XISR(ss)) {
 | |
|             ics_reject(icp->ics, XISR(ss));
 | |
|         }
 | |
|         ss->xirr = (ss->xirr & ~XISR_MASK) | (nr & XISR_MASK);
 | |
|         ss->pending_priority = priority;
 | |
|         qemu_irq_raise(ss->output);
 | |
|     }
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * ICS: Source layer
 | |
|  */
 | |
| 
 | |
| struct ics_irq_state {
 | |
|     int server;
 | |
|     uint8_t priority;
 | |
|     uint8_t saved_priority;
 | |
|     /* int pending:1; */
 | |
|     /* int presented:1; */
 | |
|     int rejected:1;
 | |
|     int masked_pending:1;
 | |
| };
 | |
| 
 | |
| struct ics_state {
 | |
|     int nr_irqs;
 | |
|     int offset;
 | |
|     qemu_irq *qirqs;
 | |
|     struct ics_irq_state *irqs;
 | |
|     struct icp_state *icp;
 | |
| };
 | |
| 
 | |
| static int ics_valid_irq(struct ics_state *ics, uint32_t nr)
 | |
| {
 | |
|     return (nr >= ics->offset)
 | |
|         && (nr < (ics->offset + ics->nr_irqs));
 | |
| }
 | |
| 
 | |
| static void ics_set_irq_msi(void *opaque, int srcno, int val)
 | |
| {
 | |
|     struct ics_state *ics = (struct ics_state *)opaque;
 | |
|     struct ics_irq_state *irq = ics->irqs + srcno;
 | |
| 
 | |
|     if (val) {
 | |
|         if (irq->priority == 0xff) {
 | |
|             irq->masked_pending = 1;
 | |
|             /* masked pending */ ;
 | |
|         } else  {
 | |
|             icp_irq(ics->icp, irq->server, srcno + ics->offset, irq->priority);
 | |
|         }
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void ics_reject_msi(struct ics_state *ics, int nr)
 | |
| {
 | |
|     struct ics_irq_state *irq = ics->irqs + nr - ics->offset;
 | |
| 
 | |
|     irq->rejected = 1;
 | |
| }
 | |
| 
 | |
| static void ics_resend_msi(struct ics_state *ics)
 | |
| {
 | |
|     int i;
 | |
| 
 | |
|     for (i = 0; i < ics->nr_irqs; i++) {
 | |
|         struct ics_irq_state *irq = ics->irqs + i;
 | |
| 
 | |
|         /* FIXME: filter by server#? */
 | |
|         if (irq->rejected) {
 | |
|             irq->rejected = 0;
 | |
|             if (irq->priority != 0xff) {
 | |
|                 icp_irq(ics->icp, irq->server, i + ics->offset, irq->priority);
 | |
|             }
 | |
|         }
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void ics_write_xive_msi(struct ics_state *ics, int nr, int server,
 | |
|                                uint8_t priority)
 | |
| {
 | |
|     struct ics_irq_state *irq = ics->irqs + nr - ics->offset;
 | |
| 
 | |
|     irq->server = server;
 | |
|     irq->priority = priority;
 | |
| 
 | |
|     if (!irq->masked_pending || (priority == 0xff)) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     irq->masked_pending = 0;
 | |
|     icp_irq(ics->icp, server, nr, priority);
 | |
| }
 | |
| 
 | |
| static void ics_reject(struct ics_state *ics, int nr)
 | |
| {
 | |
|     ics_reject_msi(ics, nr);
 | |
| }
 | |
| 
 | |
| static void ics_resend(struct ics_state *ics)
 | |
| {
 | |
|     ics_resend_msi(ics);
 | |
| }
 | |
| 
 | |
| static void ics_eoi(struct ics_state *ics, int nr)
 | |
| {
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Exported functions
 | |
|  */
 | |
| 
 | |
| qemu_irq xics_find_qirq(struct icp_state *icp, int irq)
 | |
| {
 | |
|     if ((irq < icp->ics->offset)
 | |
|         || (irq >= (icp->ics->offset + icp->ics->nr_irqs))) {
 | |
|         return NULL;
 | |
|     }
 | |
| 
 | |
|     return icp->ics->qirqs[irq - icp->ics->offset];
 | |
| }
 | |
| 
 | |
| static target_ulong h_cppr(CPUState *env, sPAPREnvironment *spapr,
 | |
|                            target_ulong opcode, target_ulong *args)
 | |
| {
 | |
|     target_ulong cppr = args[0];
 | |
| 
 | |
|     icp_set_cppr(spapr->icp, env->cpu_index, cppr);
 | |
|     return H_SUCCESS;
 | |
| }
 | |
| 
 | |
| static target_ulong h_ipi(CPUState *env, sPAPREnvironment *spapr,
 | |
|                           target_ulong opcode, target_ulong *args)
 | |
| {
 | |
|     target_ulong server = args[0];
 | |
|     target_ulong mfrr = args[1];
 | |
| 
 | |
|     if (server >= spapr->icp->nr_servers) {
 | |
|         return H_PARAMETER;
 | |
|     }
 | |
| 
 | |
|     icp_set_mfrr(spapr->icp, server, mfrr);
 | |
|     return H_SUCCESS;
 | |
| 
 | |
| }
 | |
| 
 | |
| static target_ulong h_xirr(CPUState *env, sPAPREnvironment *spapr,
 | |
|                            target_ulong opcode, target_ulong *args)
 | |
| {
 | |
|     uint32_t xirr = icp_accept(spapr->icp->ss + env->cpu_index);
 | |
| 
 | |
|     args[0] = xirr;
 | |
|     return H_SUCCESS;
 | |
| }
 | |
| 
 | |
| static target_ulong h_eoi(CPUState *env, sPAPREnvironment *spapr,
 | |
|                           target_ulong opcode, target_ulong *args)
 | |
| {
 | |
|     target_ulong xirr = args[0];
 | |
| 
 | |
|     icp_eoi(spapr->icp, env->cpu_index, xirr);
 | |
|     return H_SUCCESS;
 | |
| }
 | |
| 
 | |
| static void rtas_set_xive(sPAPREnvironment *spapr, uint32_t token,
 | |
|                           uint32_t nargs, target_ulong args,
 | |
|                           uint32_t nret, target_ulong rets)
 | |
| {
 | |
|     struct ics_state *ics = spapr->icp->ics;
 | |
|     uint32_t nr, server, priority;
 | |
| 
 | |
|     if ((nargs != 3) || (nret != 1)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     nr = rtas_ld(args, 0);
 | |
|     server = rtas_ld(args, 1);
 | |
|     priority = rtas_ld(args, 2);
 | |
| 
 | |
|     if (!ics_valid_irq(ics, nr) || (server >= ics->icp->nr_servers)
 | |
|         || (priority > 0xff)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     ics_write_xive_msi(ics, nr, server, priority);
 | |
| 
 | |
|     rtas_st(rets, 0, 0); /* Success */
 | |
| }
 | |
| 
 | |
| static void rtas_get_xive(sPAPREnvironment *spapr, uint32_t token,
 | |
|                           uint32_t nargs, target_ulong args,
 | |
|                           uint32_t nret, target_ulong rets)
 | |
| {
 | |
|     struct ics_state *ics = spapr->icp->ics;
 | |
|     uint32_t nr;
 | |
| 
 | |
|     if ((nargs != 1) || (nret != 3)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     nr = rtas_ld(args, 0);
 | |
| 
 | |
|     if (!ics_valid_irq(ics, nr)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     rtas_st(rets, 0, 0); /* Success */
 | |
|     rtas_st(rets, 1, ics->irqs[nr - ics->offset].server);
 | |
|     rtas_st(rets, 2, ics->irqs[nr - ics->offset].priority);
 | |
| }
 | |
| 
 | |
| static void rtas_int_off(sPAPREnvironment *spapr, uint32_t token,
 | |
|                          uint32_t nargs, target_ulong args,
 | |
|                          uint32_t nret, target_ulong rets)
 | |
| {
 | |
|     struct ics_state *ics = spapr->icp->ics;
 | |
|     uint32_t nr;
 | |
| 
 | |
|     if ((nargs != 1) || (nret != 1)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     nr = rtas_ld(args, 0);
 | |
| 
 | |
|     if (!ics_valid_irq(ics, nr)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     /* This is a NOP for now, since the described PAPR semantics don't
 | |
|      * seem to gel with what Linux does */
 | |
| #if 0
 | |
|     struct ics_irq_state *irq = xics->irqs + (nr - xics->offset);
 | |
| 
 | |
|     irq->saved_priority = irq->priority;
 | |
|     ics_write_xive_msi(xics, nr, irq->server, 0xff);
 | |
| #endif
 | |
| 
 | |
|     rtas_st(rets, 0, 0); /* Success */
 | |
| }
 | |
| 
 | |
| static void rtas_int_on(sPAPREnvironment *spapr, uint32_t token,
 | |
|                         uint32_t nargs, target_ulong args,
 | |
|                         uint32_t nret, target_ulong rets)
 | |
| {
 | |
|     struct ics_state *ics = spapr->icp->ics;
 | |
|     uint32_t nr;
 | |
| 
 | |
|     if ((nargs != 1) || (nret != 1)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     nr = rtas_ld(args, 0);
 | |
| 
 | |
|     if (!ics_valid_irq(ics, nr)) {
 | |
|         rtas_st(rets, 0, -3);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     /* This is a NOP for now, since the described PAPR semantics don't
 | |
|      * seem to gel with what Linux does */
 | |
| #if 0
 | |
|     struct ics_irq_state *irq = xics->irqs + (nr - xics->offset);
 | |
| 
 | |
|     ics_write_xive_msi(xics, nr, irq->server, irq->saved_priority);
 | |
| #endif
 | |
| 
 | |
|     rtas_st(rets, 0, 0); /* Success */
 | |
| }
 | |
| 
 | |
| struct icp_state *xics_system_init(int nr_irqs)
 | |
| {
 | |
|     CPUState *env;
 | |
|     int max_server_num;
 | |
|     int i;
 | |
|     struct icp_state *icp;
 | |
|     struct ics_state *ics;
 | |
| 
 | |
|     max_server_num = -1;
 | |
|     for (env = first_cpu; env != NULL; env = env->next_cpu) {
 | |
|         if (env->cpu_index > max_server_num) {
 | |
|             max_server_num = env->cpu_index;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     icp = g_malloc0(sizeof(*icp));
 | |
|     icp->nr_servers = max_server_num + 1;
 | |
|     icp->ss = g_malloc0(icp->nr_servers*sizeof(struct icp_server_state));
 | |
| 
 | |
|     for (i = 0; i < icp->nr_servers; i++) {
 | |
|         icp->ss[i].mfrr = 0xff;
 | |
|     }
 | |
| 
 | |
|     for (env = first_cpu; env != NULL; env = env->next_cpu) {
 | |
|         struct icp_server_state *ss = &icp->ss[env->cpu_index];
 | |
| 
 | |
|         switch (PPC_INPUT(env)) {
 | |
|         case PPC_FLAGS_INPUT_POWER7:
 | |
|             ss->output = env->irq_inputs[POWER7_INPUT_INT];
 | |
|             break;
 | |
| 
 | |
|         case PPC_FLAGS_INPUT_970:
 | |
|             ss->output = env->irq_inputs[PPC970_INPUT_INT];
 | |
|             break;
 | |
| 
 | |
|         default:
 | |
|             hw_error("XICS interrupt model does not support this CPU bus "
 | |
|                      "model\n");
 | |
|             exit(1);
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     ics = g_malloc0(sizeof(*ics));
 | |
|     ics->nr_irqs = nr_irqs;
 | |
|     ics->offset = 16;
 | |
|     ics->irqs = g_malloc0(nr_irqs * sizeof(struct ics_irq_state));
 | |
| 
 | |
|     icp->ics = ics;
 | |
|     ics->icp = icp;
 | |
| 
 | |
|     for (i = 0; i < nr_irqs; i++) {
 | |
|         ics->irqs[i].priority = 0xff;
 | |
|         ics->irqs[i].saved_priority = 0xff;
 | |
|     }
 | |
| 
 | |
|     ics->qirqs = qemu_allocate_irqs(ics_set_irq_msi, ics, nr_irqs);
 | |
| 
 | |
|     spapr_register_hypercall(H_CPPR, h_cppr);
 | |
|     spapr_register_hypercall(H_IPI, h_ipi);
 | |
|     spapr_register_hypercall(H_XIRR, h_xirr);
 | |
|     spapr_register_hypercall(H_EOI, h_eoi);
 | |
| 
 | |
|     spapr_rtas_register("ibm,set-xive", rtas_set_xive);
 | |
|     spapr_rtas_register("ibm,get-xive", rtas_get_xive);
 | |
|     spapr_rtas_register("ibm,int-off", rtas_int_off);
 | |
|     spapr_rtas_register("ibm,int-on", rtas_int_on);
 | |
| 
 | |
|     return icp;
 | |
| }
 |