 b168a138a8
			
		
	
	
		b168a138a8
		
	
	
	
	
		
			
			The 'pnv' prefix is now used for all and the routines populating the device tree start with 'pnv_dt'. The handler of the PnvXScomInterface is also renamed to 'dt_xscom' which should reflect that it is populating the device tree under the 'xscom@' node of the chip. Signed-off-by: Cédric Le Goater <clg@kaod.org> Signed-off-by: David Gibson <david@gibson.dropbear.id.au>
		
			
				
	
	
		
			573 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			573 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * QEMU PowerPC PowerNV Processor Service Interface (PSI) model
 | |
|  *
 | |
|  * Copyright (c) 2015-2017, IBM Corporation.
 | |
|  *
 | |
|  * This library is free software; you can redistribute it and/or
 | |
|  * modify it under the terms of the GNU Lesser General Public
 | |
|  * License as published by the Free Software Foundation; either
 | |
|  * version 2 of the License, or (at your option) any later version.
 | |
|  *
 | |
|  * This library is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | |
|  * Lesser General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU Lesser General Public
 | |
|  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
 | |
|  */
 | |
| 
 | |
| #include "qemu/osdep.h"
 | |
| #include "hw/hw.h"
 | |
| #include "target/ppc/cpu.h"
 | |
| #include "qemu/log.h"
 | |
| #include "qapi/error.h"
 | |
| 
 | |
| #include "exec/address-spaces.h"
 | |
| 
 | |
| #include "hw/ppc/fdt.h"
 | |
| #include "hw/ppc/pnv.h"
 | |
| #include "hw/ppc/pnv_xscom.h"
 | |
| #include "hw/ppc/pnv_psi.h"
 | |
| 
 | |
| #include <libfdt.h>
 | |
| 
 | |
| #define PSIHB_XSCOM_FIR_RW      0x00
 | |
| #define PSIHB_XSCOM_FIR_AND     0x01
 | |
| #define PSIHB_XSCOM_FIR_OR      0x02
 | |
| #define PSIHB_XSCOM_FIRMASK_RW  0x03
 | |
| #define PSIHB_XSCOM_FIRMASK_AND 0x04
 | |
| #define PSIHB_XSCOM_FIRMASK_OR  0x05
 | |
| #define PSIHB_XSCOM_FIRACT0     0x06
 | |
| #define PSIHB_XSCOM_FIRACT1     0x07
 | |
| 
 | |
| /* Host Bridge Base Address Register */
 | |
| #define PSIHB_XSCOM_BAR         0x0a
 | |
| #define   PSIHB_BAR_EN                  0x0000000000000001ull
 | |
| 
 | |
| /* FSP Base Address Register */
 | |
| #define PSIHB_XSCOM_FSPBAR      0x0b
 | |
| 
 | |
| /* PSI Host Bridge Control/Status Register */
 | |
| #define PSIHB_XSCOM_CR          0x0e
 | |
| #define   PSIHB_CR_FSP_CMD_ENABLE       0x8000000000000000ull
 | |
| #define   PSIHB_CR_FSP_MMIO_ENABLE      0x4000000000000000ull
 | |
| #define   PSIHB_CR_FSP_IRQ_ENABLE       0x1000000000000000ull
 | |
| #define   PSIHB_CR_FSP_ERR_RSP_ENABLE   0x0800000000000000ull
 | |
| #define   PSIHB_CR_PSI_LINK_ENABLE      0x0400000000000000ull
 | |
| #define   PSIHB_CR_FSP_RESET            0x0200000000000000ull
 | |
| #define   PSIHB_CR_PSIHB_RESET          0x0100000000000000ull
 | |
| #define   PSIHB_CR_PSI_IRQ              0x0000800000000000ull
 | |
| #define   PSIHB_CR_FSP_IRQ              0x0000400000000000ull
 | |
| #define   PSIHB_CR_FSP_LINK_ACTIVE      0x0000200000000000ull
 | |
| #define   PSIHB_CR_IRQ_CMD_EXPECT       0x0000010000000000ull
 | |
|           /* and more ... */
 | |
| 
 | |
| /* PSIHB Status / Error Mask Register */
 | |
| #define PSIHB_XSCOM_SEMR        0x0f
 | |
| 
 | |
| /* XIVR, to signal interrupts to the CEC firmware. more XIVR below. */
 | |
| #define PSIHB_XSCOM_XIVR_FSP    0x10
 | |
| #define   PSIHB_XIVR_SERVER_SH          40
 | |
| #define   PSIHB_XIVR_SERVER_MSK         (0xffffull << PSIHB_XIVR_SERVER_SH)
 | |
| #define   PSIHB_XIVR_PRIO_SH            32
 | |
| #define   PSIHB_XIVR_PRIO_MSK           (0xffull << PSIHB_XIVR_PRIO_SH)
 | |
| #define   PSIHB_XIVR_SRC_SH             29
 | |
| #define   PSIHB_XIVR_SRC_MSK            (0x7ull << PSIHB_XIVR_SRC_SH)
 | |
| #define   PSIHB_XIVR_PENDING            0x01000000ull
 | |
| 
 | |
| /* PSI Host Bridge Set Control/ Status Register */
 | |
| #define PSIHB_XSCOM_SCR         0x12
 | |
| 
 | |
| /* PSI Host Bridge Clear Control/ Status Register */
 | |
| #define PSIHB_XSCOM_CCR         0x13
 | |
| 
 | |
| /* DMA Upper Address Register */
 | |
| #define PSIHB_XSCOM_DMA_UPADD   0x14
 | |
| 
 | |
| /* Interrupt Status */
 | |
| #define PSIHB_XSCOM_IRQ_STAT    0x15
 | |
| #define   PSIHB_IRQ_STAT_OCC            0x0000001000000000ull
 | |
| #define   PSIHB_IRQ_STAT_FSI            0x0000000800000000ull
 | |
| #define   PSIHB_IRQ_STAT_LPCI2C         0x0000000400000000ull
 | |
| #define   PSIHB_IRQ_STAT_LOCERR         0x0000000200000000ull
 | |
| #define   PSIHB_IRQ_STAT_EXT            0x0000000100000000ull
 | |
| 
 | |
| /* remaining XIVR */
 | |
| #define PSIHB_XSCOM_XIVR_OCC    0x16
 | |
| #define PSIHB_XSCOM_XIVR_FSI    0x17
 | |
| #define PSIHB_XSCOM_XIVR_LPCI2C 0x18
 | |
| #define PSIHB_XSCOM_XIVR_LOCERR 0x19
 | |
| #define PSIHB_XSCOM_XIVR_EXT    0x1a
 | |
| 
 | |
| /* Interrupt Requester Source Compare Register */
 | |
| #define PSIHB_XSCOM_IRSN        0x1b
 | |
| #define   PSIHB_IRSN_COMP_SH            45
 | |
| #define   PSIHB_IRSN_COMP_MSK           (0x7ffffull << PSIHB_IRSN_COMP_SH)
 | |
| #define   PSIHB_IRSN_IRQ_MUX            0x0000000800000000ull
 | |
| #define   PSIHB_IRSN_IRQ_RESET          0x0000000400000000ull
 | |
| #define   PSIHB_IRSN_DOWNSTREAM_EN      0x0000000200000000ull
 | |
| #define   PSIHB_IRSN_UPSTREAM_EN        0x0000000100000000ull
 | |
| #define   PSIHB_IRSN_COMPMASK_SH        13
 | |
| #define   PSIHB_IRSN_COMPMASK_MSK       (0x7ffffull << PSIHB_IRSN_COMPMASK_SH)
 | |
| 
 | |
| #define PSIHB_BAR_MASK                  0x0003fffffff00000ull
 | |
| #define PSIHB_FSPBAR_MASK               0x0003ffff00000000ull
 | |
| 
 | |
| static void pnv_psi_set_bar(PnvPsi *psi, uint64_t bar)
 | |
| {
 | |
|     MemoryRegion *sysmem = get_system_memory();
 | |
|     uint64_t old = psi->regs[PSIHB_XSCOM_BAR];
 | |
| 
 | |
|     psi->regs[PSIHB_XSCOM_BAR] = bar & (PSIHB_BAR_MASK | PSIHB_BAR_EN);
 | |
| 
 | |
|     /* Update MR, always remove it first */
 | |
|     if (old & PSIHB_BAR_EN) {
 | |
|         memory_region_del_subregion(sysmem, &psi->regs_mr);
 | |
|     }
 | |
| 
 | |
|     /* Then add it back if needed */
 | |
|     if (bar & PSIHB_BAR_EN) {
 | |
|         uint64_t addr = bar & PSIHB_BAR_MASK;
 | |
|         memory_region_add_subregion(sysmem, addr, &psi->regs_mr);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void pnv_psi_update_fsp_mr(PnvPsi *psi)
 | |
| {
 | |
|     /* TODO: Update FSP MR if/when we support FSP BAR */
 | |
| }
 | |
| 
 | |
| static void pnv_psi_set_cr(PnvPsi *psi, uint64_t cr)
 | |
| {
 | |
|     uint64_t old = psi->regs[PSIHB_XSCOM_CR];
 | |
| 
 | |
|     psi->regs[PSIHB_XSCOM_CR] = cr;
 | |
| 
 | |
|     /* Check some bit changes */
 | |
|     if ((old ^ psi->regs[PSIHB_XSCOM_CR]) & PSIHB_CR_FSP_MMIO_ENABLE) {
 | |
|         pnv_psi_update_fsp_mr(psi);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void pnv_psi_set_irsn(PnvPsi *psi, uint64_t val)
 | |
| {
 | |
|     ICSState *ics = &psi->ics;
 | |
| 
 | |
|     /* In this model we ignore the up/down enable bits for now
 | |
|      * as SW doesn't use them (other than setting them at boot).
 | |
|      * We ignore IRQ_MUX, its meaning isn't clear and we don't use
 | |
|      * it and finally we ignore reset (XXX fix that ?)
 | |
|      */
 | |
|     psi->regs[PSIHB_XSCOM_IRSN] = val & (PSIHB_IRSN_COMP_MSK |
 | |
|                                          PSIHB_IRSN_IRQ_MUX |
 | |
|                                          PSIHB_IRSN_IRQ_RESET |
 | |
|                                          PSIHB_IRSN_DOWNSTREAM_EN |
 | |
|                                          PSIHB_IRSN_UPSTREAM_EN);
 | |
| 
 | |
|     /* We ignore the compare mask as well, our ICS emulation is too
 | |
|      * simplistic to make any use if it, and we extract the offset
 | |
|      * from the compare value
 | |
|      */
 | |
|     ics->offset = (val & PSIHB_IRSN_COMP_MSK) >> PSIHB_IRSN_COMP_SH;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * FSP and PSI interrupts are muxed under the same number.
 | |
|  */
 | |
| static const uint32_t xivr_regs[] = {
 | |
|     [PSIHB_IRQ_PSI]       = PSIHB_XSCOM_XIVR_FSP,
 | |
|     [PSIHB_IRQ_FSP]       = PSIHB_XSCOM_XIVR_FSP,
 | |
|     [PSIHB_IRQ_OCC]       = PSIHB_XSCOM_XIVR_OCC,
 | |
|     [PSIHB_IRQ_FSI]       = PSIHB_XSCOM_XIVR_FSI,
 | |
|     [PSIHB_IRQ_LPC_I2C]   = PSIHB_XSCOM_XIVR_LPCI2C,
 | |
|     [PSIHB_IRQ_LOCAL_ERR] = PSIHB_XSCOM_XIVR_LOCERR,
 | |
|     [PSIHB_IRQ_EXTERNAL]  = PSIHB_XSCOM_XIVR_EXT,
 | |
| };
 | |
| 
 | |
| static const uint32_t stat_regs[] = {
 | |
|     [PSIHB_IRQ_PSI]       = PSIHB_XSCOM_CR,
 | |
|     [PSIHB_IRQ_FSP]       = PSIHB_XSCOM_CR,
 | |
|     [PSIHB_IRQ_OCC]       = PSIHB_XSCOM_IRQ_STAT,
 | |
|     [PSIHB_IRQ_FSI]       = PSIHB_XSCOM_IRQ_STAT,
 | |
|     [PSIHB_IRQ_LPC_I2C]   = PSIHB_XSCOM_IRQ_STAT,
 | |
|     [PSIHB_IRQ_LOCAL_ERR] = PSIHB_XSCOM_IRQ_STAT,
 | |
|     [PSIHB_IRQ_EXTERNAL]  = PSIHB_XSCOM_IRQ_STAT,
 | |
| };
 | |
| 
 | |
| static const uint64_t stat_bits[] = {
 | |
|     [PSIHB_IRQ_PSI]       = PSIHB_CR_PSI_IRQ,
 | |
|     [PSIHB_IRQ_FSP]       = PSIHB_CR_FSP_IRQ,
 | |
|     [PSIHB_IRQ_OCC]       = PSIHB_IRQ_STAT_OCC,
 | |
|     [PSIHB_IRQ_FSI]       = PSIHB_IRQ_STAT_FSI,
 | |
|     [PSIHB_IRQ_LPC_I2C]   = PSIHB_IRQ_STAT_LPCI2C,
 | |
|     [PSIHB_IRQ_LOCAL_ERR] = PSIHB_IRQ_STAT_LOCERR,
 | |
|     [PSIHB_IRQ_EXTERNAL]  = PSIHB_IRQ_STAT_EXT,
 | |
| };
 | |
| 
 | |
| void pnv_psi_irq_set(PnvPsi *psi, PnvPsiIrq irq, bool state)
 | |
| {
 | |
|     ICSState *ics = &psi->ics;
 | |
|     uint32_t xivr_reg;
 | |
|     uint32_t stat_reg;
 | |
|     uint32_t src;
 | |
|     bool masked;
 | |
| 
 | |
|     if (irq > PSIHB_IRQ_EXTERNAL) {
 | |
|         qemu_log_mask(LOG_GUEST_ERROR, "PSI: Unsupported irq %d\n", irq);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     xivr_reg = xivr_regs[irq];
 | |
|     stat_reg = stat_regs[irq];
 | |
| 
 | |
|     src = (psi->regs[xivr_reg] & PSIHB_XIVR_SRC_MSK) >> PSIHB_XIVR_SRC_SH;
 | |
|     if (state) {
 | |
|         psi->regs[stat_reg] |= stat_bits[irq];
 | |
|         /* TODO: optimization, check mask here. That means
 | |
|          * re-evaluating when unmasking
 | |
|          */
 | |
|         qemu_irq_raise(ics->qirqs[src]);
 | |
|     } else {
 | |
|         psi->regs[stat_reg] &= ~stat_bits[irq];
 | |
| 
 | |
|         /* FSP and PSI are muxed so don't lower if either is still set */
 | |
|         if (stat_reg != PSIHB_XSCOM_CR ||
 | |
|             !(psi->regs[stat_reg] & (PSIHB_CR_PSI_IRQ | PSIHB_CR_FSP_IRQ))) {
 | |
|             qemu_irq_lower(ics->qirqs[src]);
 | |
|         } else {
 | |
|             state = true;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* Note about the emulation of the pending bit: This isn't
 | |
|      * entirely correct. The pending bit should be cleared when the
 | |
|      * EOI has been received. However, we don't have callbacks on EOI
 | |
|      * (especially not under KVM) so no way to emulate that properly,
 | |
|      * so instead we just set that bit as the logical "output" of the
 | |
|      * XIVR (ie pending & !masked)
 | |
|      *
 | |
|      * CLG: We could define a new ICS object with a custom eoi()
 | |
|      * handler to clear the pending bit. But I am not sure this would
 | |
|      * be useful for the software anyhow.
 | |
|      */
 | |
|     masked = (psi->regs[xivr_reg] & PSIHB_XIVR_PRIO_MSK) == PSIHB_XIVR_PRIO_MSK;
 | |
|     if (state && !masked) {
 | |
|         psi->regs[xivr_reg] |= PSIHB_XIVR_PENDING;
 | |
|     } else {
 | |
|         psi->regs[xivr_reg] &= ~PSIHB_XIVR_PENDING;
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void pnv_psi_set_xivr(PnvPsi *psi, uint32_t reg, uint64_t val)
 | |
| {
 | |
|     ICSState *ics = &psi->ics;
 | |
|     uint16_t server;
 | |
|     uint8_t prio;
 | |
|     uint8_t src;
 | |
| 
 | |
|     psi->regs[reg] = (psi->regs[reg] & PSIHB_XIVR_PENDING) |
 | |
|             (val & (PSIHB_XIVR_SERVER_MSK |
 | |
|                     PSIHB_XIVR_PRIO_MSK |
 | |
|                     PSIHB_XIVR_SRC_MSK));
 | |
|     val = psi->regs[reg];
 | |
|     server = (val & PSIHB_XIVR_SERVER_MSK) >> PSIHB_XIVR_SERVER_SH;
 | |
|     prio = (val & PSIHB_XIVR_PRIO_MSK) >> PSIHB_XIVR_PRIO_SH;
 | |
|     src = (val & PSIHB_XIVR_SRC_MSK) >> PSIHB_XIVR_SRC_SH;
 | |
| 
 | |
|     if (src >= PSI_NUM_INTERRUPTS) {
 | |
|         qemu_log_mask(LOG_GUEST_ERROR, "PSI: Unsupported irq %d\n", src);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     /* Remove pending bit if the IRQ is masked */
 | |
|     if ((psi->regs[reg] & PSIHB_XIVR_PRIO_MSK) == PSIHB_XIVR_PRIO_MSK) {
 | |
|         psi->regs[reg] &= ~PSIHB_XIVR_PENDING;
 | |
|     }
 | |
| 
 | |
|     /* The low order 2 bits are the link pointer (Type II interrupts).
 | |
|      * Shift back to get a valid IRQ server.
 | |
|      */
 | |
|     server >>= 2;
 | |
| 
 | |
|     /* Now because of source remapping, weird things can happen
 | |
|      * if you change the source number dynamically, our simple ICS
 | |
|      * doesn't deal with remapping. So we just poke a different
 | |
|      * ICS entry based on what source number was written. This will
 | |
|      * do for now but a more accurate implementation would instead
 | |
|      * use a fixed server/prio and a remapper of the generated irq.
 | |
|      */
 | |
|     ics_simple_write_xive(ics, src, server, prio, prio);
 | |
| }
 | |
| 
 | |
| static uint64_t pnv_psi_reg_read(PnvPsi *psi, uint32_t offset, bool mmio)
 | |
| {
 | |
|     uint64_t val = 0xffffffffffffffffull;
 | |
| 
 | |
|     switch (offset) {
 | |
|     case PSIHB_XSCOM_FIR_RW:
 | |
|     case PSIHB_XSCOM_FIRACT0:
 | |
|     case PSIHB_XSCOM_FIRACT1:
 | |
|     case PSIHB_XSCOM_BAR:
 | |
|     case PSIHB_XSCOM_FSPBAR:
 | |
|     case PSIHB_XSCOM_CR:
 | |
|     case PSIHB_XSCOM_XIVR_FSP:
 | |
|     case PSIHB_XSCOM_XIVR_OCC:
 | |
|     case PSIHB_XSCOM_XIVR_FSI:
 | |
|     case PSIHB_XSCOM_XIVR_LPCI2C:
 | |
|     case PSIHB_XSCOM_XIVR_LOCERR:
 | |
|     case PSIHB_XSCOM_XIVR_EXT:
 | |
|     case PSIHB_XSCOM_IRQ_STAT:
 | |
|     case PSIHB_XSCOM_SEMR:
 | |
|     case PSIHB_XSCOM_DMA_UPADD:
 | |
|     case PSIHB_XSCOM_IRSN:
 | |
|         val = psi->regs[offset];
 | |
|         break;
 | |
|     default:
 | |
|         qemu_log_mask(LOG_UNIMP, "PSI: read at Ox%" PRIx32 "\n", offset);
 | |
|     }
 | |
|     return val;
 | |
| }
 | |
| 
 | |
| static void pnv_psi_reg_write(PnvPsi *psi, uint32_t offset, uint64_t val,
 | |
|                               bool mmio)
 | |
| {
 | |
|     switch (offset) {
 | |
|     case PSIHB_XSCOM_FIR_RW:
 | |
|     case PSIHB_XSCOM_FIRACT0:
 | |
|     case PSIHB_XSCOM_FIRACT1:
 | |
|     case PSIHB_XSCOM_SEMR:
 | |
|     case PSIHB_XSCOM_DMA_UPADD:
 | |
|         psi->regs[offset] = val;
 | |
|         break;
 | |
|     case PSIHB_XSCOM_FIR_OR:
 | |
|         psi->regs[PSIHB_XSCOM_FIR_RW] |= val;
 | |
|         break;
 | |
|     case PSIHB_XSCOM_FIR_AND:
 | |
|         psi->regs[PSIHB_XSCOM_FIR_RW] &= val;
 | |
|         break;
 | |
|     case PSIHB_XSCOM_BAR:
 | |
|         /* Only XSCOM can write this one */
 | |
|         if (!mmio) {
 | |
|             pnv_psi_set_bar(psi, val);
 | |
|         } else {
 | |
|             qemu_log_mask(LOG_GUEST_ERROR, "PSI: invalid write of BAR\n");
 | |
|         }
 | |
|         break;
 | |
|     case PSIHB_XSCOM_FSPBAR:
 | |
|         psi->regs[PSIHB_XSCOM_FSPBAR] = val & PSIHB_FSPBAR_MASK;
 | |
|         pnv_psi_update_fsp_mr(psi);
 | |
|         break;
 | |
|     case PSIHB_XSCOM_CR:
 | |
|         pnv_psi_set_cr(psi, val);
 | |
|         break;
 | |
|     case PSIHB_XSCOM_SCR:
 | |
|         pnv_psi_set_cr(psi, psi->regs[PSIHB_XSCOM_CR] | val);
 | |
|         break;
 | |
|     case PSIHB_XSCOM_CCR:
 | |
|         pnv_psi_set_cr(psi, psi->regs[PSIHB_XSCOM_CR] & ~val);
 | |
|         break;
 | |
|     case PSIHB_XSCOM_XIVR_FSP:
 | |
|     case PSIHB_XSCOM_XIVR_OCC:
 | |
|     case PSIHB_XSCOM_XIVR_FSI:
 | |
|     case PSIHB_XSCOM_XIVR_LPCI2C:
 | |
|     case PSIHB_XSCOM_XIVR_LOCERR:
 | |
|     case PSIHB_XSCOM_XIVR_EXT:
 | |
|         pnv_psi_set_xivr(psi, offset, val);
 | |
|         break;
 | |
|     case PSIHB_XSCOM_IRQ_STAT:
 | |
|         /* Read only */
 | |
|         qemu_log_mask(LOG_GUEST_ERROR, "PSI: invalid write of IRQ_STAT\n");
 | |
|         break;
 | |
|     case PSIHB_XSCOM_IRSN:
 | |
|         pnv_psi_set_irsn(psi, val);
 | |
|         break;
 | |
|     default:
 | |
|         qemu_log_mask(LOG_UNIMP, "PSI: write at Ox%" PRIx32 "\n", offset);
 | |
|     }
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * The values of the registers when accessed through the MMIO region
 | |
|  * follow the relation : xscom = (mmio + 0x50) >> 3
 | |
|  */
 | |
| static uint64_t pnv_psi_mmio_read(void *opaque, hwaddr addr, unsigned size)
 | |
| {
 | |
|     return pnv_psi_reg_read(opaque, (addr >> 3) + PSIHB_XSCOM_BAR, true);
 | |
| }
 | |
| 
 | |
| static void pnv_psi_mmio_write(void *opaque, hwaddr addr,
 | |
|                               uint64_t val, unsigned size)
 | |
| {
 | |
|     pnv_psi_reg_write(opaque, (addr >> 3) + PSIHB_XSCOM_BAR, val, true);
 | |
| }
 | |
| 
 | |
| static const MemoryRegionOps psi_mmio_ops = {
 | |
|     .read = pnv_psi_mmio_read,
 | |
|     .write = pnv_psi_mmio_write,
 | |
|     .endianness = DEVICE_BIG_ENDIAN,
 | |
|     .valid = {
 | |
|         .min_access_size = 8,
 | |
|         .max_access_size = 8,
 | |
|     },
 | |
|     .impl = {
 | |
|         .min_access_size = 8,
 | |
|         .max_access_size = 8,
 | |
|     },
 | |
| };
 | |
| 
 | |
| static uint64_t pnv_psi_xscom_read(void *opaque, hwaddr addr, unsigned size)
 | |
| {
 | |
|     return pnv_psi_reg_read(opaque, addr >> 3, false);
 | |
| }
 | |
| 
 | |
| static void pnv_psi_xscom_write(void *opaque, hwaddr addr,
 | |
|                                 uint64_t val, unsigned size)
 | |
| {
 | |
|     pnv_psi_reg_write(opaque, addr >> 3, val, false);
 | |
| }
 | |
| 
 | |
| static const MemoryRegionOps pnv_psi_xscom_ops = {
 | |
|     .read = pnv_psi_xscom_read,
 | |
|     .write = pnv_psi_xscom_write,
 | |
|     .endianness = DEVICE_BIG_ENDIAN,
 | |
|     .valid = {
 | |
|         .min_access_size = 8,
 | |
|         .max_access_size = 8,
 | |
|     },
 | |
|     .impl = {
 | |
|         .min_access_size = 8,
 | |
|         .max_access_size = 8,
 | |
|     }
 | |
| };
 | |
| 
 | |
| static void pnv_psi_init(Object *obj)
 | |
| {
 | |
|     PnvPsi *psi = PNV_PSI(obj);
 | |
| 
 | |
|     object_initialize(&psi->ics, sizeof(psi->ics), TYPE_ICS_SIMPLE);
 | |
|     object_property_add_child(obj, "ics-psi", OBJECT(&psi->ics), NULL);
 | |
| }
 | |
| 
 | |
| static const uint8_t irq_to_xivr[] = {
 | |
|     PSIHB_XSCOM_XIVR_FSP,
 | |
|     PSIHB_XSCOM_XIVR_OCC,
 | |
|     PSIHB_XSCOM_XIVR_FSI,
 | |
|     PSIHB_XSCOM_XIVR_LPCI2C,
 | |
|     PSIHB_XSCOM_XIVR_LOCERR,
 | |
|     PSIHB_XSCOM_XIVR_EXT,
 | |
| };
 | |
| 
 | |
| static void pnv_psi_realize(DeviceState *dev, Error **errp)
 | |
| {
 | |
|     PnvPsi *psi = PNV_PSI(dev);
 | |
|     ICSState *ics = &psi->ics;
 | |
|     Object *obj;
 | |
|     Error *err = NULL;
 | |
|     unsigned int i;
 | |
| 
 | |
|     obj = object_property_get_link(OBJECT(dev), "xics", &err);
 | |
|     if (!obj) {
 | |
|         error_setg(errp, "%s: required link 'xics' not found: %s",
 | |
|                    __func__, error_get_pretty(err));
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     /* Create PSI interrupt control source */
 | |
|     object_property_add_const_link(OBJECT(ics), ICS_PROP_XICS, obj,
 | |
|                                    &error_abort);
 | |
|     object_property_set_int(OBJECT(ics), PSI_NUM_INTERRUPTS, "nr-irqs", &err);
 | |
|     if (err) {
 | |
|         error_propagate(errp, err);
 | |
|         return;
 | |
|     }
 | |
|     object_property_set_bool(OBJECT(ics), true, "realized",  &err);
 | |
|     if (err) {
 | |
|         error_propagate(errp, err);
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     for (i = 0; i < ics->nr_irqs; i++) {
 | |
|         ics_set_irq_type(ics, i, true);
 | |
|     }
 | |
| 
 | |
|     /* XSCOM region for PSI registers */
 | |
|     pnv_xscom_region_init(&psi->xscom_regs, OBJECT(dev), &pnv_psi_xscom_ops,
 | |
|                 psi, "xscom-psi", PNV_XSCOM_PSIHB_SIZE);
 | |
| 
 | |
|     /* Initialize MMIO region */
 | |
|     memory_region_init_io(&psi->regs_mr, OBJECT(dev), &psi_mmio_ops, psi,
 | |
|                           "psihb", PNV_PSIHB_SIZE);
 | |
| 
 | |
|     /* Default BAR for MMIO region */
 | |
|     pnv_psi_set_bar(psi, psi->bar | PSIHB_BAR_EN);
 | |
| 
 | |
|     /* Default sources in XIVR */
 | |
|     for (i = 0; i < PSI_NUM_INTERRUPTS; i++) {
 | |
|         uint8_t xivr = irq_to_xivr[i];
 | |
|         psi->regs[xivr] = PSIHB_XIVR_PRIO_MSK |
 | |
|             ((uint64_t) i << PSIHB_XIVR_SRC_SH);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static int pnv_psi_dt_xscom(PnvXScomInterface *dev, void *fdt, int xscom_offset)
 | |
| {
 | |
|     const char compat[] = "ibm,power8-psihb-x\0ibm,psihb-x";
 | |
|     char *name;
 | |
|     int offset;
 | |
|     uint32_t lpc_pcba = PNV_XSCOM_PSIHB_BASE;
 | |
|     uint32_t reg[] = {
 | |
|         cpu_to_be32(lpc_pcba),
 | |
|         cpu_to_be32(PNV_XSCOM_PSIHB_SIZE)
 | |
|     };
 | |
| 
 | |
|     name = g_strdup_printf("psihb@%x", lpc_pcba);
 | |
|     offset = fdt_add_subnode(fdt, xscom_offset, name);
 | |
|     _FDT(offset);
 | |
|     g_free(name);
 | |
| 
 | |
|     _FDT((fdt_setprop(fdt, offset, "reg", reg, sizeof(reg))));
 | |
| 
 | |
|     _FDT((fdt_setprop_cell(fdt, offset, "#address-cells", 2)));
 | |
|     _FDT((fdt_setprop_cell(fdt, offset, "#size-cells", 1)));
 | |
|     _FDT((fdt_setprop(fdt, offset, "compatible", compat,
 | |
|                       sizeof(compat))));
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static Property pnv_psi_properties[] = {
 | |
|     DEFINE_PROP_UINT64("bar", PnvPsi, bar, 0),
 | |
|     DEFINE_PROP_UINT64("fsp-bar", PnvPsi, fsp_bar, 0),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void pnv_psi_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     PnvXScomInterfaceClass *xdc = PNV_XSCOM_INTERFACE_CLASS(klass);
 | |
| 
 | |
|     xdc->dt_xscom = pnv_psi_dt_xscom;
 | |
| 
 | |
|     dc->realize = pnv_psi_realize;
 | |
|     dc->props = pnv_psi_properties;
 | |
| }
 | |
| 
 | |
| static const TypeInfo pnv_psi_info = {
 | |
|     .name          = TYPE_PNV_PSI,
 | |
|     .parent        = TYPE_SYS_BUS_DEVICE,
 | |
|     .instance_size = sizeof(PnvPsi),
 | |
|     .instance_init = pnv_psi_init,
 | |
|     .class_init    = pnv_psi_class_init,
 | |
|     .interfaces    = (InterfaceInfo[]) {
 | |
|         { TYPE_PNV_XSCOM_INTERFACE },
 | |
|         { }
 | |
|     }
 | |
| };
 | |
| 
 | |
| static void pnv_psi_register_types(void)
 | |
| {
 | |
|     type_register_static(&pnv_psi_info);
 | |
| }
 | |
| 
 | |
| type_init(pnv_psi_register_types)
 |