xref: /qemu/hw/ppc/pnv_psi.c (revision f6d4dca807d853516fc307519f3260a432818bdc)
154f59d78SCédric Le Goater /*
254f59d78SCédric Le Goater  * QEMU PowerPC PowerNV Processor Service Interface (PSI) model
354f59d78SCédric Le Goater  *
454f59d78SCédric Le Goater  * Copyright (c) 2015-2017, IBM Corporation.
554f59d78SCédric Le Goater  *
654f59d78SCédric Le Goater  * This library is free software; you can redistribute it and/or
754f59d78SCédric Le Goater  * modify it under the terms of the GNU Lesser General Public
854f59d78SCédric Le Goater  * License as published by the Free Software Foundation; either
954f59d78SCédric Le Goater  * version 2 of the License, or (at your option) any later version.
1054f59d78SCédric Le Goater  *
1154f59d78SCédric Le Goater  * This library is distributed in the hope that it will be useful,
1254f59d78SCédric Le Goater  * but WITHOUT ANY WARRANTY; without even the implied warranty of
1354f59d78SCédric Le Goater  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
1454f59d78SCédric Le Goater  * Lesser General Public License for more details.
1554f59d78SCédric Le Goater  *
1654f59d78SCédric Le Goater  * You should have received a copy of the GNU Lesser General Public
1754f59d78SCédric Le Goater  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
1854f59d78SCédric Le Goater  */
1954f59d78SCédric Le Goater 
2054f59d78SCédric Le Goater #include "qemu/osdep.h"
2154f59d78SCédric Le Goater #include "hw/hw.h"
2254f59d78SCédric Le Goater #include "target/ppc/cpu.h"
2354f59d78SCédric Le Goater #include "qemu/log.h"
2454f59d78SCédric Le Goater #include "qapi/error.h"
2554f59d78SCédric Le Goater 
2654f59d78SCédric Le Goater #include "exec/address-spaces.h"
2754f59d78SCédric Le Goater 
2854f59d78SCédric Le Goater #include "hw/ppc/fdt.h"
2954f59d78SCédric Le Goater #include "hw/ppc/pnv.h"
3054f59d78SCédric Le Goater #include "hw/ppc/pnv_xscom.h"
3154f59d78SCédric Le Goater #include "hw/ppc/pnv_psi.h"
3254f59d78SCédric Le Goater 
3354f59d78SCédric Le Goater #include <libfdt.h>
3454f59d78SCédric Le Goater 
3554f59d78SCédric Le Goater #define PSIHB_XSCOM_FIR_RW      0x00
3654f59d78SCédric Le Goater #define PSIHB_XSCOM_FIR_AND     0x01
3754f59d78SCédric Le Goater #define PSIHB_XSCOM_FIR_OR      0x02
3854f59d78SCédric Le Goater #define PSIHB_XSCOM_FIRMASK_RW  0x03
3954f59d78SCédric Le Goater #define PSIHB_XSCOM_FIRMASK_AND 0x04
4054f59d78SCédric Le Goater #define PSIHB_XSCOM_FIRMASK_OR  0x05
4154f59d78SCédric Le Goater #define PSIHB_XSCOM_FIRACT0     0x06
4254f59d78SCédric Le Goater #define PSIHB_XSCOM_FIRACT1     0x07
4354f59d78SCédric Le Goater 
4454f59d78SCédric Le Goater /* Host Bridge Base Address Register */
4554f59d78SCédric Le Goater #define PSIHB_XSCOM_BAR         0x0a
4654f59d78SCédric Le Goater #define   PSIHB_BAR_EN                  0x0000000000000001ull
4754f59d78SCédric Le Goater 
4854f59d78SCédric Le Goater /* FSP Base Address Register */
4954f59d78SCédric Le Goater #define PSIHB_XSCOM_FSPBAR      0x0b
5054f59d78SCédric Le Goater 
5154f59d78SCédric Le Goater /* PSI Host Bridge Control/Status Register */
5254f59d78SCédric Le Goater #define PSIHB_XSCOM_CR          0x0e
5354f59d78SCédric Le Goater #define   PSIHB_CR_FSP_CMD_ENABLE       0x8000000000000000ull
5454f59d78SCédric Le Goater #define   PSIHB_CR_FSP_MMIO_ENABLE      0x4000000000000000ull
5554f59d78SCédric Le Goater #define   PSIHB_CR_FSP_IRQ_ENABLE       0x1000000000000000ull
5654f59d78SCédric Le Goater #define   PSIHB_CR_FSP_ERR_RSP_ENABLE   0x0800000000000000ull
5754f59d78SCédric Le Goater #define   PSIHB_CR_PSI_LINK_ENABLE      0x0400000000000000ull
5854f59d78SCédric Le Goater #define   PSIHB_CR_FSP_RESET            0x0200000000000000ull
5954f59d78SCédric Le Goater #define   PSIHB_CR_PSIHB_RESET          0x0100000000000000ull
6054f59d78SCédric Le Goater #define   PSIHB_CR_PSI_IRQ              0x0000800000000000ull
6154f59d78SCédric Le Goater #define   PSIHB_CR_FSP_IRQ              0x0000400000000000ull
6254f59d78SCédric Le Goater #define   PSIHB_CR_FSP_LINK_ACTIVE      0x0000200000000000ull
6354f59d78SCédric Le Goater #define   PSIHB_CR_IRQ_CMD_EXPECT       0x0000010000000000ull
6454f59d78SCédric Le Goater           /* and more ... */
6554f59d78SCédric Le Goater 
6654f59d78SCédric Le Goater /* PSIHB Status / Error Mask Register */
6754f59d78SCédric Le Goater #define PSIHB_XSCOM_SEMR        0x0f
6854f59d78SCédric Le Goater 
6954f59d78SCédric Le Goater /* XIVR, to signal interrupts to the CEC firmware. more XIVR below. */
7054f59d78SCédric Le Goater #define PSIHB_XSCOM_XIVR_FSP    0x10
7154f59d78SCédric Le Goater #define   PSIHB_XIVR_SERVER_SH          40
7254f59d78SCédric Le Goater #define   PSIHB_XIVR_SERVER_MSK         (0xffffull << PSIHB_XIVR_SERVER_SH)
7354f59d78SCédric Le Goater #define   PSIHB_XIVR_PRIO_SH            32
7454f59d78SCédric Le Goater #define   PSIHB_XIVR_PRIO_MSK           (0xffull << PSIHB_XIVR_PRIO_SH)
7554f59d78SCédric Le Goater #define   PSIHB_XIVR_SRC_SH             29
7654f59d78SCédric Le Goater #define   PSIHB_XIVR_SRC_MSK            (0x7ull << PSIHB_XIVR_SRC_SH)
7754f59d78SCédric Le Goater #define   PSIHB_XIVR_PENDING            0x01000000ull
7854f59d78SCédric Le Goater 
7954f59d78SCédric Le Goater /* PSI Host Bridge Set Control/ Status Register */
8054f59d78SCédric Le Goater #define PSIHB_XSCOM_SCR         0x12
8154f59d78SCédric Le Goater 
8254f59d78SCédric Le Goater /* PSI Host Bridge Clear Control/ Status Register */
8354f59d78SCédric Le Goater #define PSIHB_XSCOM_CCR         0x13
8454f59d78SCédric Le Goater 
8554f59d78SCédric Le Goater /* DMA Upper Address Register */
8654f59d78SCédric Le Goater #define PSIHB_XSCOM_DMA_UPADD   0x14
8754f59d78SCédric Le Goater 
8854f59d78SCédric Le Goater /* Interrupt Status */
8954f59d78SCédric Le Goater #define PSIHB_XSCOM_IRQ_STAT    0x15
9054f59d78SCédric Le Goater #define   PSIHB_IRQ_STAT_OCC            0x0000001000000000ull
9154f59d78SCédric Le Goater #define   PSIHB_IRQ_STAT_FSI            0x0000000800000000ull
9254f59d78SCédric Le Goater #define   PSIHB_IRQ_STAT_LPCI2C         0x0000000400000000ull
9354f59d78SCédric Le Goater #define   PSIHB_IRQ_STAT_LOCERR         0x0000000200000000ull
9454f59d78SCédric Le Goater #define   PSIHB_IRQ_STAT_EXT            0x0000000100000000ull
9554f59d78SCédric Le Goater 
9654f59d78SCédric Le Goater /* remaining XIVR */
9754f59d78SCédric Le Goater #define PSIHB_XSCOM_XIVR_OCC    0x16
9854f59d78SCédric Le Goater #define PSIHB_XSCOM_XIVR_FSI    0x17
9954f59d78SCédric Le Goater #define PSIHB_XSCOM_XIVR_LPCI2C 0x18
10054f59d78SCédric Le Goater #define PSIHB_XSCOM_XIVR_LOCERR 0x19
10154f59d78SCédric Le Goater #define PSIHB_XSCOM_XIVR_EXT    0x1a
10254f59d78SCédric Le Goater 
10354f59d78SCédric Le Goater /* Interrupt Requester Source Compare Register */
10454f59d78SCédric Le Goater #define PSIHB_XSCOM_IRSN        0x1b
10554f59d78SCédric Le Goater #define   PSIHB_IRSN_COMP_SH            45
10654f59d78SCédric Le Goater #define   PSIHB_IRSN_COMP_MSK           (0x7ffffull << PSIHB_IRSN_COMP_SH)
10754f59d78SCédric Le Goater #define   PSIHB_IRSN_IRQ_MUX            0x0000000800000000ull
10854f59d78SCédric Le Goater #define   PSIHB_IRSN_IRQ_RESET          0x0000000400000000ull
10954f59d78SCédric Le Goater #define   PSIHB_IRSN_DOWNSTREAM_EN      0x0000000200000000ull
11054f59d78SCédric Le Goater #define   PSIHB_IRSN_UPSTREAM_EN        0x0000000100000000ull
11154f59d78SCédric Le Goater #define   PSIHB_IRSN_COMPMASK_SH        13
11254f59d78SCédric Le Goater #define   PSIHB_IRSN_COMPMASK_MSK       (0x7ffffull << PSIHB_IRSN_COMPMASK_SH)
11354f59d78SCédric Le Goater 
11454f59d78SCédric Le Goater #define PSIHB_BAR_MASK                  0x0003fffffff00000ull
11554f59d78SCédric Le Goater #define PSIHB_FSPBAR_MASK               0x0003ffff00000000ull
11654f59d78SCédric Le Goater 
11754f59d78SCédric Le Goater static void pnv_psi_set_bar(PnvPsi *psi, uint64_t bar)
11854f59d78SCédric Le Goater {
11954f59d78SCédric Le Goater     MemoryRegion *sysmem = get_system_memory();
12054f59d78SCédric Le Goater     uint64_t old = psi->regs[PSIHB_XSCOM_BAR];
12154f59d78SCédric Le Goater 
12254f59d78SCédric Le Goater     psi->regs[PSIHB_XSCOM_BAR] = bar & (PSIHB_BAR_MASK | PSIHB_BAR_EN);
12354f59d78SCédric Le Goater 
12454f59d78SCédric Le Goater     /* Update MR, always remove it first */
12554f59d78SCédric Le Goater     if (old & PSIHB_BAR_EN) {
12654f59d78SCédric Le Goater         memory_region_del_subregion(sysmem, &psi->regs_mr);
12754f59d78SCédric Le Goater     }
12854f59d78SCédric Le Goater 
12954f59d78SCédric Le Goater     /* Then add it back if needed */
13054f59d78SCédric Le Goater     if (bar & PSIHB_BAR_EN) {
13154f59d78SCédric Le Goater         uint64_t addr = bar & PSIHB_BAR_MASK;
13254f59d78SCédric Le Goater         memory_region_add_subregion(sysmem, addr, &psi->regs_mr);
13354f59d78SCédric Le Goater     }
13454f59d78SCédric Le Goater }
13554f59d78SCédric Le Goater 
13654f59d78SCédric Le Goater static void pnv_psi_update_fsp_mr(PnvPsi *psi)
13754f59d78SCédric Le Goater {
13854f59d78SCédric Le Goater     /* TODO: Update FSP MR if/when we support FSP BAR */
13954f59d78SCédric Le Goater }
14054f59d78SCédric Le Goater 
14154f59d78SCédric Le Goater static void pnv_psi_set_cr(PnvPsi *psi, uint64_t cr)
14254f59d78SCédric Le Goater {
14354f59d78SCédric Le Goater     uint64_t old = psi->regs[PSIHB_XSCOM_CR];
14454f59d78SCédric Le Goater 
14554f59d78SCédric Le Goater     psi->regs[PSIHB_XSCOM_CR] = cr;
14654f59d78SCédric Le Goater 
14754f59d78SCédric Le Goater     /* Check some bit changes */
14854f59d78SCédric Le Goater     if ((old ^ psi->regs[PSIHB_XSCOM_CR]) & PSIHB_CR_FSP_MMIO_ENABLE) {
14954f59d78SCédric Le Goater         pnv_psi_update_fsp_mr(psi);
15054f59d78SCédric Le Goater     }
15154f59d78SCédric Le Goater }
15254f59d78SCédric Le Goater 
15354f59d78SCédric Le Goater static void pnv_psi_set_irsn(PnvPsi *psi, uint64_t val)
15454f59d78SCédric Le Goater {
15554f59d78SCédric Le Goater     ICSState *ics = &psi->ics;
15654f59d78SCédric Le Goater 
15754f59d78SCédric Le Goater     /* In this model we ignore the up/down enable bits for now
15854f59d78SCédric Le Goater      * as SW doesn't use them (other than setting them at boot).
15954f59d78SCédric Le Goater      * We ignore IRQ_MUX, its meaning isn't clear and we don't use
16054f59d78SCédric Le Goater      * it and finally we ignore reset (XXX fix that ?)
16154f59d78SCédric Le Goater      */
16254f59d78SCédric Le Goater     psi->regs[PSIHB_XSCOM_IRSN] = val & (PSIHB_IRSN_COMP_MSK |
16354f59d78SCédric Le Goater                                          PSIHB_IRSN_IRQ_MUX |
16454f59d78SCédric Le Goater                                          PSIHB_IRSN_IRQ_RESET |
16554f59d78SCédric Le Goater                                          PSIHB_IRSN_DOWNSTREAM_EN |
16654f59d78SCédric Le Goater                                          PSIHB_IRSN_UPSTREAM_EN);
16754f59d78SCédric Le Goater 
16854f59d78SCédric Le Goater     /* We ignore the compare mask as well, our ICS emulation is too
16954f59d78SCédric Le Goater      * simplistic to make any use if it, and we extract the offset
17054f59d78SCédric Le Goater      * from the compare value
17154f59d78SCédric Le Goater      */
17254f59d78SCédric Le Goater     ics->offset = (val & PSIHB_IRSN_COMP_MSK) >> PSIHB_IRSN_COMP_SH;
17354f59d78SCédric Le Goater }
17454f59d78SCédric Le Goater 
17554f59d78SCédric Le Goater /*
17654f59d78SCédric Le Goater  * FSP and PSI interrupts are muxed under the same number.
17754f59d78SCédric Le Goater  */
17854f59d78SCédric Le Goater static const uint32_t xivr_regs[] = {
17954f59d78SCédric Le Goater     [PSIHB_IRQ_PSI]       = PSIHB_XSCOM_XIVR_FSP,
18054f59d78SCédric Le Goater     [PSIHB_IRQ_FSP]       = PSIHB_XSCOM_XIVR_FSP,
18154f59d78SCédric Le Goater     [PSIHB_IRQ_OCC]       = PSIHB_XSCOM_XIVR_OCC,
18254f59d78SCédric Le Goater     [PSIHB_IRQ_FSI]       = PSIHB_XSCOM_XIVR_FSI,
18354f59d78SCédric Le Goater     [PSIHB_IRQ_LPC_I2C]   = PSIHB_XSCOM_XIVR_LPCI2C,
18454f59d78SCédric Le Goater     [PSIHB_IRQ_LOCAL_ERR] = PSIHB_XSCOM_XIVR_LOCERR,
18554f59d78SCédric Le Goater     [PSIHB_IRQ_EXTERNAL]  = PSIHB_XSCOM_XIVR_EXT,
18654f59d78SCédric Le Goater };
18754f59d78SCédric Le Goater 
18854f59d78SCédric Le Goater static const uint32_t stat_regs[] = {
18954f59d78SCédric Le Goater     [PSIHB_IRQ_PSI]       = PSIHB_XSCOM_CR,
19054f59d78SCédric Le Goater     [PSIHB_IRQ_FSP]       = PSIHB_XSCOM_CR,
19154f59d78SCédric Le Goater     [PSIHB_IRQ_OCC]       = PSIHB_XSCOM_IRQ_STAT,
19254f59d78SCédric Le Goater     [PSIHB_IRQ_FSI]       = PSIHB_XSCOM_IRQ_STAT,
19354f59d78SCédric Le Goater     [PSIHB_IRQ_LPC_I2C]   = PSIHB_XSCOM_IRQ_STAT,
19454f59d78SCédric Le Goater     [PSIHB_IRQ_LOCAL_ERR] = PSIHB_XSCOM_IRQ_STAT,
19554f59d78SCédric Le Goater     [PSIHB_IRQ_EXTERNAL]  = PSIHB_XSCOM_IRQ_STAT,
19654f59d78SCédric Le Goater };
19754f59d78SCédric Le Goater 
19854f59d78SCédric Le Goater static const uint64_t stat_bits[] = {
19954f59d78SCédric Le Goater     [PSIHB_IRQ_PSI]       = PSIHB_CR_PSI_IRQ,
20054f59d78SCédric Le Goater     [PSIHB_IRQ_FSP]       = PSIHB_CR_FSP_IRQ,
20154f59d78SCédric Le Goater     [PSIHB_IRQ_OCC]       = PSIHB_IRQ_STAT_OCC,
20254f59d78SCédric Le Goater     [PSIHB_IRQ_FSI]       = PSIHB_IRQ_STAT_FSI,
20354f59d78SCédric Le Goater     [PSIHB_IRQ_LPC_I2C]   = PSIHB_IRQ_STAT_LPCI2C,
20454f59d78SCédric Le Goater     [PSIHB_IRQ_LOCAL_ERR] = PSIHB_IRQ_STAT_LOCERR,
20554f59d78SCédric Le Goater     [PSIHB_IRQ_EXTERNAL]  = PSIHB_IRQ_STAT_EXT,
20654f59d78SCédric Le Goater };
20754f59d78SCédric Le Goater 
20854f59d78SCédric Le Goater void pnv_psi_irq_set(PnvPsi *psi, PnvPsiIrq irq, bool state)
20954f59d78SCédric Le Goater {
21054f59d78SCédric Le Goater     uint32_t xivr_reg;
21154f59d78SCédric Le Goater     uint32_t stat_reg;
21254f59d78SCédric Le Goater     uint32_t src;
21354f59d78SCédric Le Goater     bool masked;
21454f59d78SCédric Le Goater 
21554f59d78SCédric Le Goater     if (irq > PSIHB_IRQ_EXTERNAL) {
21654f59d78SCédric Le Goater         qemu_log_mask(LOG_GUEST_ERROR, "PSI: Unsupported irq %d\n", irq);
21754f59d78SCédric Le Goater         return;
21854f59d78SCédric Le Goater     }
21954f59d78SCédric Le Goater 
22054f59d78SCédric Le Goater     xivr_reg = xivr_regs[irq];
22154f59d78SCédric Le Goater     stat_reg = stat_regs[irq];
22254f59d78SCédric Le Goater 
22354f59d78SCédric Le Goater     src = (psi->regs[xivr_reg] & PSIHB_XIVR_SRC_MSK) >> PSIHB_XIVR_SRC_SH;
22454f59d78SCédric Le Goater     if (state) {
22554f59d78SCédric Le Goater         psi->regs[stat_reg] |= stat_bits[irq];
22654f59d78SCédric Le Goater         /* TODO: optimization, check mask here. That means
22754f59d78SCédric Le Goater          * re-evaluating when unmasking
22854f59d78SCédric Le Goater          */
229f8df9003SCédric Le Goater         qemu_irq_raise(psi->qirqs[src]);
23054f59d78SCédric Le Goater     } else {
23154f59d78SCédric Le Goater         psi->regs[stat_reg] &= ~stat_bits[irq];
23254f59d78SCédric Le Goater 
23354f59d78SCédric Le Goater         /* FSP and PSI are muxed so don't lower if either is still set */
23454f59d78SCédric Le Goater         if (stat_reg != PSIHB_XSCOM_CR ||
23554f59d78SCédric Le Goater             !(psi->regs[stat_reg] & (PSIHB_CR_PSI_IRQ | PSIHB_CR_FSP_IRQ))) {
236f8df9003SCédric Le Goater             qemu_irq_lower(psi->qirqs[src]);
23754f59d78SCédric Le Goater         } else {
23854f59d78SCédric Le Goater             state = true;
23954f59d78SCédric Le Goater         }
24054f59d78SCédric Le Goater     }
24154f59d78SCédric Le Goater 
24254f59d78SCédric Le Goater     /* Note about the emulation of the pending bit: This isn't
24354f59d78SCédric Le Goater      * entirely correct. The pending bit should be cleared when the
24454f59d78SCédric Le Goater      * EOI has been received. However, we don't have callbacks on EOI
24554f59d78SCédric Le Goater      * (especially not under KVM) so no way to emulate that properly,
24654f59d78SCédric Le Goater      * so instead we just set that bit as the logical "output" of the
24754f59d78SCédric Le Goater      * XIVR (ie pending & !masked)
24854f59d78SCédric Le Goater      *
24954f59d78SCédric Le Goater      * CLG: We could define a new ICS object with a custom eoi()
25054f59d78SCédric Le Goater      * handler to clear the pending bit. But I am not sure this would
25154f59d78SCédric Le Goater      * be useful for the software anyhow.
25254f59d78SCédric Le Goater      */
25354f59d78SCédric Le Goater     masked = (psi->regs[xivr_reg] & PSIHB_XIVR_PRIO_MSK) == PSIHB_XIVR_PRIO_MSK;
25454f59d78SCédric Le Goater     if (state && !masked) {
25554f59d78SCédric Le Goater         psi->regs[xivr_reg] |= PSIHB_XIVR_PENDING;
25654f59d78SCédric Le Goater     } else {
25754f59d78SCédric Le Goater         psi->regs[xivr_reg] &= ~PSIHB_XIVR_PENDING;
25854f59d78SCédric Le Goater     }
25954f59d78SCédric Le Goater }
26054f59d78SCédric Le Goater 
26154f59d78SCédric Le Goater static void pnv_psi_set_xivr(PnvPsi *psi, uint32_t reg, uint64_t val)
26254f59d78SCédric Le Goater {
26354f59d78SCédric Le Goater     ICSState *ics = &psi->ics;
26454f59d78SCédric Le Goater     uint16_t server;
26554f59d78SCédric Le Goater     uint8_t prio;
26654f59d78SCédric Le Goater     uint8_t src;
26754f59d78SCédric Le Goater 
26854f59d78SCédric Le Goater     psi->regs[reg] = (psi->regs[reg] & PSIHB_XIVR_PENDING) |
26954f59d78SCédric Le Goater             (val & (PSIHB_XIVR_SERVER_MSK |
27054f59d78SCédric Le Goater                     PSIHB_XIVR_PRIO_MSK |
27154f59d78SCédric Le Goater                     PSIHB_XIVR_SRC_MSK));
27254f59d78SCédric Le Goater     val = psi->regs[reg];
27354f59d78SCédric Le Goater     server = (val & PSIHB_XIVR_SERVER_MSK) >> PSIHB_XIVR_SERVER_SH;
27454f59d78SCédric Le Goater     prio = (val & PSIHB_XIVR_PRIO_MSK) >> PSIHB_XIVR_PRIO_SH;
27554f59d78SCédric Le Goater     src = (val & PSIHB_XIVR_SRC_MSK) >> PSIHB_XIVR_SRC_SH;
27654f59d78SCédric Le Goater 
27754f59d78SCédric Le Goater     if (src >= PSI_NUM_INTERRUPTS) {
27854f59d78SCédric Le Goater         qemu_log_mask(LOG_GUEST_ERROR, "PSI: Unsupported irq %d\n", src);
27954f59d78SCédric Le Goater         return;
28054f59d78SCédric Le Goater     }
28154f59d78SCédric Le Goater 
28254f59d78SCédric Le Goater     /* Remove pending bit if the IRQ is masked */
28354f59d78SCédric Le Goater     if ((psi->regs[reg] & PSIHB_XIVR_PRIO_MSK) == PSIHB_XIVR_PRIO_MSK) {
28454f59d78SCédric Le Goater         psi->regs[reg] &= ~PSIHB_XIVR_PENDING;
28554f59d78SCédric Le Goater     }
28654f59d78SCédric Le Goater 
28754f59d78SCédric Le Goater     /* The low order 2 bits are the link pointer (Type II interrupts).
28854f59d78SCédric Le Goater      * Shift back to get a valid IRQ server.
28954f59d78SCédric Le Goater      */
29054f59d78SCédric Le Goater     server >>= 2;
29154f59d78SCédric Le Goater 
29254f59d78SCédric Le Goater     /* Now because of source remapping, weird things can happen
29354f59d78SCédric Le Goater      * if you change the source number dynamically, our simple ICS
29454f59d78SCédric Le Goater      * doesn't deal with remapping. So we just poke a different
29554f59d78SCédric Le Goater      * ICS entry based on what source number was written. This will
29654f59d78SCédric Le Goater      * do for now but a more accurate implementation would instead
29754f59d78SCédric Le Goater      * use a fixed server/prio and a remapper of the generated irq.
29854f59d78SCédric Le Goater      */
29954f59d78SCédric Le Goater     ics_simple_write_xive(ics, src, server, prio, prio);
30054f59d78SCédric Le Goater }
30154f59d78SCédric Le Goater 
30254f59d78SCédric Le Goater static uint64_t pnv_psi_reg_read(PnvPsi *psi, uint32_t offset, bool mmio)
30354f59d78SCédric Le Goater {
30454f59d78SCédric Le Goater     uint64_t val = 0xffffffffffffffffull;
30554f59d78SCédric Le Goater 
30654f59d78SCédric Le Goater     switch (offset) {
30754f59d78SCédric Le Goater     case PSIHB_XSCOM_FIR_RW:
30854f59d78SCédric Le Goater     case PSIHB_XSCOM_FIRACT0:
30954f59d78SCédric Le Goater     case PSIHB_XSCOM_FIRACT1:
31054f59d78SCédric Le Goater     case PSIHB_XSCOM_BAR:
31154f59d78SCédric Le Goater     case PSIHB_XSCOM_FSPBAR:
31254f59d78SCédric Le Goater     case PSIHB_XSCOM_CR:
31354f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_FSP:
31454f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_OCC:
31554f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_FSI:
31654f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_LPCI2C:
31754f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_LOCERR:
31854f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_EXT:
31954f59d78SCédric Le Goater     case PSIHB_XSCOM_IRQ_STAT:
32054f59d78SCédric Le Goater     case PSIHB_XSCOM_SEMR:
32154f59d78SCédric Le Goater     case PSIHB_XSCOM_DMA_UPADD:
32254f59d78SCédric Le Goater     case PSIHB_XSCOM_IRSN:
32354f59d78SCédric Le Goater         val = psi->regs[offset];
32454f59d78SCédric Le Goater         break;
32554f59d78SCédric Le Goater     default:
32654f59d78SCédric Le Goater         qemu_log_mask(LOG_UNIMP, "PSI: read at Ox%" PRIx32 "\n", offset);
32754f59d78SCédric Le Goater     }
32854f59d78SCédric Le Goater     return val;
32954f59d78SCédric Le Goater }
33054f59d78SCédric Le Goater 
33154f59d78SCédric Le Goater static void pnv_psi_reg_write(PnvPsi *psi, uint32_t offset, uint64_t val,
33254f59d78SCédric Le Goater                               bool mmio)
33354f59d78SCédric Le Goater {
33454f59d78SCédric Le Goater     switch (offset) {
33554f59d78SCédric Le Goater     case PSIHB_XSCOM_FIR_RW:
33654f59d78SCédric Le Goater     case PSIHB_XSCOM_FIRACT0:
33754f59d78SCédric Le Goater     case PSIHB_XSCOM_FIRACT1:
33854f59d78SCédric Le Goater     case PSIHB_XSCOM_SEMR:
33954f59d78SCédric Le Goater     case PSIHB_XSCOM_DMA_UPADD:
34054f59d78SCédric Le Goater         psi->regs[offset] = val;
34154f59d78SCédric Le Goater         break;
34254f59d78SCédric Le Goater     case PSIHB_XSCOM_FIR_OR:
34354f59d78SCédric Le Goater         psi->regs[PSIHB_XSCOM_FIR_RW] |= val;
34454f59d78SCédric Le Goater         break;
34554f59d78SCédric Le Goater     case PSIHB_XSCOM_FIR_AND:
34654f59d78SCédric Le Goater         psi->regs[PSIHB_XSCOM_FIR_RW] &= val;
34754f59d78SCédric Le Goater         break;
34854f59d78SCédric Le Goater     case PSIHB_XSCOM_BAR:
34954f59d78SCédric Le Goater         /* Only XSCOM can write this one */
35054f59d78SCédric Le Goater         if (!mmio) {
35154f59d78SCédric Le Goater             pnv_psi_set_bar(psi, val);
35254f59d78SCédric Le Goater         } else {
35354f59d78SCédric Le Goater             qemu_log_mask(LOG_GUEST_ERROR, "PSI: invalid write of BAR\n");
35454f59d78SCédric Le Goater         }
35554f59d78SCédric Le Goater         break;
35654f59d78SCédric Le Goater     case PSIHB_XSCOM_FSPBAR:
35754f59d78SCédric Le Goater         psi->regs[PSIHB_XSCOM_FSPBAR] = val & PSIHB_FSPBAR_MASK;
35854f59d78SCédric Le Goater         pnv_psi_update_fsp_mr(psi);
35954f59d78SCédric Le Goater         break;
36054f59d78SCédric Le Goater     case PSIHB_XSCOM_CR:
36154f59d78SCédric Le Goater         pnv_psi_set_cr(psi, val);
36254f59d78SCédric Le Goater         break;
36354f59d78SCédric Le Goater     case PSIHB_XSCOM_SCR:
36454f59d78SCédric Le Goater         pnv_psi_set_cr(psi, psi->regs[PSIHB_XSCOM_CR] | val);
36554f59d78SCédric Le Goater         break;
36654f59d78SCédric Le Goater     case PSIHB_XSCOM_CCR:
36754f59d78SCédric Le Goater         pnv_psi_set_cr(psi, psi->regs[PSIHB_XSCOM_CR] & ~val);
36854f59d78SCédric Le Goater         break;
36954f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_FSP:
37054f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_OCC:
37154f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_FSI:
37254f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_LPCI2C:
37354f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_LOCERR:
37454f59d78SCédric Le Goater     case PSIHB_XSCOM_XIVR_EXT:
37554f59d78SCédric Le Goater         pnv_psi_set_xivr(psi, offset, val);
37654f59d78SCédric Le Goater         break;
37754f59d78SCédric Le Goater     case PSIHB_XSCOM_IRQ_STAT:
37854f59d78SCédric Le Goater         /* Read only */
37954f59d78SCédric Le Goater         qemu_log_mask(LOG_GUEST_ERROR, "PSI: invalid write of IRQ_STAT\n");
38054f59d78SCédric Le Goater         break;
38154f59d78SCédric Le Goater     case PSIHB_XSCOM_IRSN:
38254f59d78SCédric Le Goater         pnv_psi_set_irsn(psi, val);
38354f59d78SCédric Le Goater         break;
38454f59d78SCédric Le Goater     default:
38554f59d78SCédric Le Goater         qemu_log_mask(LOG_UNIMP, "PSI: write at Ox%" PRIx32 "\n", offset);
38654f59d78SCédric Le Goater     }
38754f59d78SCédric Le Goater }
38854f59d78SCédric Le Goater 
38954f59d78SCédric Le Goater /*
39054f59d78SCédric Le Goater  * The values of the registers when accessed through the MMIO region
39154f59d78SCédric Le Goater  * follow the relation : xscom = (mmio + 0x50) >> 3
39254f59d78SCédric Le Goater  */
39354f59d78SCédric Le Goater static uint64_t pnv_psi_mmio_read(void *opaque, hwaddr addr, unsigned size)
39454f59d78SCédric Le Goater {
39554f59d78SCédric Le Goater     return pnv_psi_reg_read(opaque, (addr >> 3) + PSIHB_XSCOM_BAR, true);
39654f59d78SCédric Le Goater }
39754f59d78SCédric Le Goater 
39854f59d78SCédric Le Goater static void pnv_psi_mmio_write(void *opaque, hwaddr addr,
39954f59d78SCédric Le Goater                               uint64_t val, unsigned size)
40054f59d78SCédric Le Goater {
40154f59d78SCédric Le Goater     pnv_psi_reg_write(opaque, (addr >> 3) + PSIHB_XSCOM_BAR, val, true);
40254f59d78SCédric Le Goater }
40354f59d78SCédric Le Goater 
40454f59d78SCédric Le Goater static const MemoryRegionOps psi_mmio_ops = {
40554f59d78SCédric Le Goater     .read = pnv_psi_mmio_read,
40654f59d78SCédric Le Goater     .write = pnv_psi_mmio_write,
40754f59d78SCédric Le Goater     .endianness = DEVICE_BIG_ENDIAN,
40854f59d78SCédric Le Goater     .valid = {
40954f59d78SCédric Le Goater         .min_access_size = 8,
41054f59d78SCédric Le Goater         .max_access_size = 8,
41154f59d78SCédric Le Goater     },
41254f59d78SCédric Le Goater     .impl = {
41354f59d78SCédric Le Goater         .min_access_size = 8,
41454f59d78SCédric Le Goater         .max_access_size = 8,
41554f59d78SCédric Le Goater     },
41654f59d78SCédric Le Goater };
41754f59d78SCédric Le Goater 
41854f59d78SCédric Le Goater static uint64_t pnv_psi_xscom_read(void *opaque, hwaddr addr, unsigned size)
41954f59d78SCédric Le Goater {
42054f59d78SCédric Le Goater     return pnv_psi_reg_read(opaque, addr >> 3, false);
42154f59d78SCédric Le Goater }
42254f59d78SCédric Le Goater 
42354f59d78SCédric Le Goater static void pnv_psi_xscom_write(void *opaque, hwaddr addr,
42454f59d78SCédric Le Goater                                 uint64_t val, unsigned size)
42554f59d78SCédric Le Goater {
42654f59d78SCédric Le Goater     pnv_psi_reg_write(opaque, addr >> 3, val, false);
42754f59d78SCédric Le Goater }
42854f59d78SCédric Le Goater 
42954f59d78SCédric Le Goater static const MemoryRegionOps pnv_psi_xscom_ops = {
43054f59d78SCédric Le Goater     .read = pnv_psi_xscom_read,
43154f59d78SCédric Le Goater     .write = pnv_psi_xscom_write,
43254f59d78SCédric Le Goater     .endianness = DEVICE_BIG_ENDIAN,
43354f59d78SCédric Le Goater     .valid = {
43454f59d78SCédric Le Goater         .min_access_size = 8,
43554f59d78SCédric Le Goater         .max_access_size = 8,
43654f59d78SCédric Le Goater     },
43754f59d78SCédric Le Goater     .impl = {
43854f59d78SCédric Le Goater         .min_access_size = 8,
43954f59d78SCédric Le Goater         .max_access_size = 8,
44054f59d78SCédric Le Goater     }
44154f59d78SCédric Le Goater };
44254f59d78SCédric Le Goater 
44354f59d78SCédric Le Goater static void pnv_psi_init(Object *obj)
44454f59d78SCédric Le Goater {
44554f59d78SCédric Le Goater     PnvPsi *psi = PNV_PSI(obj);
44654f59d78SCédric Le Goater 
447*f6d4dca8SThomas Huth     object_initialize_child(obj, "ics-psi",  &psi->ics, sizeof(psi->ics),
448*f6d4dca8SThomas Huth                             TYPE_ICS_SIMPLE, &error_abort, NULL);
44954f59d78SCédric Le Goater }
45054f59d78SCédric Le Goater 
45154f59d78SCédric Le Goater static const uint8_t irq_to_xivr[] = {
45254f59d78SCédric Le Goater     PSIHB_XSCOM_XIVR_FSP,
45354f59d78SCédric Le Goater     PSIHB_XSCOM_XIVR_OCC,
45454f59d78SCédric Le Goater     PSIHB_XSCOM_XIVR_FSI,
45554f59d78SCédric Le Goater     PSIHB_XSCOM_XIVR_LPCI2C,
45654f59d78SCédric Le Goater     PSIHB_XSCOM_XIVR_LOCERR,
45754f59d78SCédric Le Goater     PSIHB_XSCOM_XIVR_EXT,
45854f59d78SCédric Le Goater };
45954f59d78SCédric Le Goater 
46054f59d78SCédric Le Goater static void pnv_psi_realize(DeviceState *dev, Error **errp)
46154f59d78SCédric Le Goater {
46254f59d78SCédric Le Goater     PnvPsi *psi = PNV_PSI(dev);
46354f59d78SCédric Le Goater     ICSState *ics = &psi->ics;
46454f59d78SCédric Le Goater     Object *obj;
46554f59d78SCédric Le Goater     Error *err = NULL;
46654f59d78SCédric Le Goater     unsigned int i;
46754f59d78SCédric Le Goater 
46854f59d78SCédric Le Goater     obj = object_property_get_link(OBJECT(dev), "xics", &err);
46954f59d78SCédric Le Goater     if (!obj) {
47054f59d78SCédric Le Goater         error_setg(errp, "%s: required link 'xics' not found: %s",
47154f59d78SCédric Le Goater                    __func__, error_get_pretty(err));
47254f59d78SCédric Le Goater         return;
47354f59d78SCédric Le Goater     }
47454f59d78SCédric Le Goater 
47554f59d78SCédric Le Goater     /* Create PSI interrupt control source */
476ad265631SGreg Kurz     object_property_add_const_link(OBJECT(ics), ICS_PROP_XICS, obj,
477ad265631SGreg Kurz                                    &error_abort);
47854f59d78SCédric Le Goater     object_property_set_int(OBJECT(ics), PSI_NUM_INTERRUPTS, "nr-irqs", &err);
47954f59d78SCédric Le Goater     if (err) {
48054f59d78SCédric Le Goater         error_propagate(errp, err);
48154f59d78SCédric Le Goater         return;
48254f59d78SCédric Le Goater     }
48354f59d78SCédric Le Goater     object_property_set_bool(OBJECT(ics), true, "realized",  &err);
48454f59d78SCédric Le Goater     if (err) {
48554f59d78SCédric Le Goater         error_propagate(errp, err);
48654f59d78SCédric Le Goater         return;
48754f59d78SCédric Le Goater     }
48854f59d78SCédric Le Goater 
48954f59d78SCédric Le Goater     for (i = 0; i < ics->nr_irqs; i++) {
49054f59d78SCédric Le Goater         ics_set_irq_type(ics, i, true);
49154f59d78SCédric Le Goater     }
49254f59d78SCédric Le Goater 
493f8df9003SCédric Le Goater     psi->qirqs = qemu_allocate_irqs(ics_simple_set_irq, ics, ics->nr_irqs);
494f8df9003SCédric Le Goater 
49554f59d78SCédric Le Goater     /* XSCOM region for PSI registers */
49654f59d78SCédric Le Goater     pnv_xscom_region_init(&psi->xscom_regs, OBJECT(dev), &pnv_psi_xscom_ops,
49754f59d78SCédric Le Goater                 psi, "xscom-psi", PNV_XSCOM_PSIHB_SIZE);
49854f59d78SCédric Le Goater 
49954f59d78SCédric Le Goater     /* Initialize MMIO region */
50054f59d78SCédric Le Goater     memory_region_init_io(&psi->regs_mr, OBJECT(dev), &psi_mmio_ops, psi,
50154f59d78SCédric Le Goater                           "psihb", PNV_PSIHB_SIZE);
50254f59d78SCédric Le Goater 
50354f59d78SCédric Le Goater     /* Default BAR for MMIO region */
50454f59d78SCédric Le Goater     pnv_psi_set_bar(psi, psi->bar | PSIHB_BAR_EN);
50554f59d78SCédric Le Goater 
50654f59d78SCédric Le Goater     /* Default sources in XIVR */
50754f59d78SCédric Le Goater     for (i = 0; i < PSI_NUM_INTERRUPTS; i++) {
50854f59d78SCédric Le Goater         uint8_t xivr = irq_to_xivr[i];
50954f59d78SCédric Le Goater         psi->regs[xivr] = PSIHB_XIVR_PRIO_MSK |
51054f59d78SCédric Le Goater             ((uint64_t) i << PSIHB_XIVR_SRC_SH);
51154f59d78SCédric Le Goater     }
51254f59d78SCédric Le Goater }
51354f59d78SCédric Le Goater 
514b168a138SCédric Le Goater static int pnv_psi_dt_xscom(PnvXScomInterface *dev, void *fdt, int xscom_offset)
51554f59d78SCédric Le Goater {
51654f59d78SCédric Le Goater     const char compat[] = "ibm,power8-psihb-x\0ibm,psihb-x";
51754f59d78SCédric Le Goater     char *name;
51854f59d78SCédric Le Goater     int offset;
51954f59d78SCédric Le Goater     uint32_t lpc_pcba = PNV_XSCOM_PSIHB_BASE;
52054f59d78SCédric Le Goater     uint32_t reg[] = {
52154f59d78SCédric Le Goater         cpu_to_be32(lpc_pcba),
52254f59d78SCédric Le Goater         cpu_to_be32(PNV_XSCOM_PSIHB_SIZE)
52354f59d78SCédric Le Goater     };
52454f59d78SCédric Le Goater 
52554f59d78SCédric Le Goater     name = g_strdup_printf("psihb@%x", lpc_pcba);
52654f59d78SCédric Le Goater     offset = fdt_add_subnode(fdt, xscom_offset, name);
52754f59d78SCédric Le Goater     _FDT(offset);
52854f59d78SCédric Le Goater     g_free(name);
52954f59d78SCédric Le Goater 
53054f59d78SCédric Le Goater     _FDT((fdt_setprop(fdt, offset, "reg", reg, sizeof(reg))));
53154f59d78SCédric Le Goater 
53254f59d78SCédric Le Goater     _FDT((fdt_setprop_cell(fdt, offset, "#address-cells", 2)));
53354f59d78SCédric Le Goater     _FDT((fdt_setprop_cell(fdt, offset, "#size-cells", 1)));
53454f59d78SCédric Le Goater     _FDT((fdt_setprop(fdt, offset, "compatible", compat,
53554f59d78SCédric Le Goater                       sizeof(compat))));
53654f59d78SCédric Le Goater     return 0;
53754f59d78SCédric Le Goater }
53854f59d78SCédric Le Goater 
53954f59d78SCédric Le Goater static Property pnv_psi_properties[] = {
54054f59d78SCédric Le Goater     DEFINE_PROP_UINT64("bar", PnvPsi, bar, 0),
54154f59d78SCédric Le Goater     DEFINE_PROP_UINT64("fsp-bar", PnvPsi, fsp_bar, 0),
54254f59d78SCédric Le Goater     DEFINE_PROP_END_OF_LIST(),
54354f59d78SCédric Le Goater };
54454f59d78SCédric Le Goater 
54554f59d78SCédric Le Goater static void pnv_psi_class_init(ObjectClass *klass, void *data)
54654f59d78SCédric Le Goater {
54754f59d78SCédric Le Goater     DeviceClass *dc = DEVICE_CLASS(klass);
54854f59d78SCédric Le Goater     PnvXScomInterfaceClass *xdc = PNV_XSCOM_INTERFACE_CLASS(klass);
54954f59d78SCédric Le Goater 
550b168a138SCédric Le Goater     xdc->dt_xscom = pnv_psi_dt_xscom;
55154f59d78SCédric Le Goater 
55254f59d78SCédric Le Goater     dc->realize = pnv_psi_realize;
55354f59d78SCédric Le Goater     dc->props = pnv_psi_properties;
55454f59d78SCédric Le Goater }
55554f59d78SCédric Le Goater 
55654f59d78SCédric Le Goater static const TypeInfo pnv_psi_info = {
55754f59d78SCédric Le Goater     .name          = TYPE_PNV_PSI,
55854f59d78SCédric Le Goater     .parent        = TYPE_SYS_BUS_DEVICE,
55954f59d78SCédric Le Goater     .instance_size = sizeof(PnvPsi),
56054f59d78SCédric Le Goater     .instance_init = pnv_psi_init,
56154f59d78SCédric Le Goater     .class_init    = pnv_psi_class_init,
56254f59d78SCédric Le Goater     .interfaces    = (InterfaceInfo[]) {
56354f59d78SCédric Le Goater         { TYPE_PNV_XSCOM_INTERFACE },
56454f59d78SCédric Le Goater         { }
56554f59d78SCédric Le Goater     }
56654f59d78SCédric Le Goater };
56754f59d78SCédric Le Goater 
56854f59d78SCédric Le Goater static void pnv_psi_register_types(void)
56954f59d78SCédric Le Goater {
57054f59d78SCédric Le Goater     type_register_static(&pnv_psi_info);
57154f59d78SCédric Le Goater }
57254f59d78SCédric Le Goater 
57354f59d78SCédric Le Goater type_init(pnv_psi_register_types)
574