Home | History | Annotate | Line # | Download | only in booke
e500_intr.c revision 1.15
      1  1.15  dholland /*	$NetBSD: e500_intr.c,v 1.15 2011/06/29 21:53:11 dholland Exp $	*/
      2   1.2      matt /*-
      3   1.2      matt  * Copyright (c) 2010, 2011 The NetBSD Foundation, Inc.
      4   1.2      matt  * All rights reserved.
      5   1.2      matt  *
      6   1.2      matt  * This code is derived from software contributed to The NetBSD Foundation
      7   1.2      matt  * by Raytheon BBN Technologies Corp and Defense Advanced Research Projects
      8   1.2      matt  * Agency and which was developed by Matt Thomas of 3am Software Foundry.
      9   1.2      matt  *
     10   1.2      matt  * This material is based upon work supported by the Defense Advanced Research
     11   1.2      matt  * Projects Agency and Space and Naval Warfare Systems Center, Pacific, under
     12   1.2      matt  * Contract No. N66001-09-C-2073.
     13   1.2      matt  * Approved for Public Release, Distribution Unlimited
     14   1.2      matt  *
     15   1.2      matt  * Redistribution and use in source and binary forms, with or without
     16   1.2      matt  * modification, are permitted provided that the following conditions
     17   1.2      matt  * are met:
     18   1.2      matt  * 1. Redistributions of source code must retain the above copyright
     19   1.2      matt  *    notice, this list of conditions and the following disclaimer.
     20   1.2      matt  * 2. Redistributions in binary form must reproduce the above copyright
     21   1.2      matt  *    notice, this list of conditions and the following disclaimer in the
     22   1.2      matt  *    documentation and/or other materials provided with the distribution.
     23   1.2      matt  *
     24   1.2      matt  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     25   1.2      matt  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     26   1.2      matt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     27   1.2      matt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     28   1.2      matt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     29   1.2      matt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     30   1.2      matt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     31   1.2      matt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     32   1.2      matt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     33   1.2      matt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     34   1.2      matt  * POSSIBILITY OF SUCH DAMAGE.
     35   1.2      matt  */
     36   1.2      matt 
     37   1.3      matt #include "opt_mpc85xx.h"
     38   1.3      matt 
     39   1.2      matt #define __INTR_PRIVATE
     40   1.2      matt 
     41  1.15  dholland #include <sys/cdefs.h>
     42  1.15  dholland __KERNEL_RCSID(0, "$NetBSD: e500_intr.c,v 1.15 2011/06/29 21:53:11 dholland Exp $");
     43  1.15  dholland 
     44   1.2      matt #include <sys/param.h>
     45   1.2      matt #include <sys/proc.h>
     46   1.2      matt #include <sys/intr.h>
     47   1.2      matt #include <sys/cpu.h>
     48   1.2      matt #include <sys/kmem.h>
     49   1.2      matt #include <sys/atomic.h>
     50   1.2      matt #include <sys/bus.h>
     51   1.8      matt #include <sys/xcall.h>
     52   1.8      matt #include <sys/bitops.h>
     53   1.2      matt 
     54   1.2      matt #include <uvm/uvm_extern.h>
     55   1.2      matt 
     56  1.10      matt #ifdef __HAVE_FAST_SOFTINTS
     57  1.10      matt #include <powerpc/softint.h>
     58  1.10      matt #endif
     59  1.10      matt 
     60   1.2      matt #include <powerpc/spr.h>
     61   1.2      matt #include <powerpc/booke/spr.h>
     62   1.2      matt 
     63   1.2      matt #include <powerpc/booke/cpuvar.h>
     64   1.2      matt #include <powerpc/booke/e500reg.h>
     65   1.2      matt #include <powerpc/booke/e500var.h>
     66   1.2      matt #include <powerpc/booke/openpicreg.h>
     67   1.2      matt 
     68   1.2      matt #define	IPL2CTPR(ipl)		((ipl) + 15 - IPL_HIGH)
     69   1.2      matt #define CTPR2IPL(ctpr)		((ctpr) - (15 - IPL_HIGH))
     70   1.2      matt 
     71   1.2      matt #define	IST_PERCPU_P(ist)	((ist) >= IST_TIMER)
     72   1.2      matt 
     73   1.2      matt struct e500_intr_irq_info {
     74   1.2      matt 	bus_addr_t irq_vpr;
     75   1.2      matt 	bus_addr_t irq_dr;
     76   1.2      matt 	u_int irq_vector;
     77   1.2      matt };
     78   1.2      matt 
     79   1.2      matt struct intr_source {
     80   1.2      matt 	int (*is_func)(void *);
     81   1.2      matt 	void *is_arg;
     82   1.2      matt 	int8_t is_ipl;
     83   1.2      matt 	uint8_t is_ist;
     84   1.2      matt 	uint8_t is_irq;
     85   1.2      matt 	bus_size_t is_vpr;
     86   1.2      matt 	bus_size_t is_dr;
     87   1.2      matt };
     88   1.2      matt 
     89   1.2      matt #define	INTR_SOURCE_INITIALIZER \
     90   1.2      matt 	{ .is_func = e500_intr_spurious, .is_arg = NULL, \
     91   1.2      matt 	.is_irq = -1, .is_ipl = IPL_NONE, .is_ist = IST_NONE, }
     92   1.2      matt 
     93   1.2      matt struct e500_intr_name {
     94   1.2      matt 	uint8_t in_irq;
     95   1.2      matt 	const char in_name[15];
     96   1.2      matt };
     97   1.2      matt 
     98   1.2      matt static const struct e500_intr_name e500_onchip_intr_names[] = {
     99   1.2      matt 	{ ISOURCE_L2, "l2" },
    100   1.2      matt 	{ ISOURCE_ECM, "ecm" },
    101   1.2      matt 	{ ISOURCE_DDR, "ddr" },
    102   1.2      matt 	{ ISOURCE_LBC, "lbc" },
    103   1.2      matt 	{ ISOURCE_DMA_CHAN1, "dma-chan1" },
    104   1.2      matt 	{ ISOURCE_DMA_CHAN2, "dma-chan2" },
    105   1.2      matt 	{ ISOURCE_DMA_CHAN3, "dma-chan3" },
    106   1.2      matt 	{ ISOURCE_DMA_CHAN4, "dma-chan4" },
    107   1.2      matt 	{ ISOURCE_PCI1, "pci1" },
    108   1.2      matt 	{ ISOURCE_PCIEX2, "pcie2" },
    109   1.2      matt 	{ ISOURCE_PCIEX	, "pcie1" },
    110   1.2      matt 	{ ISOURCE_PCIEX3, "pcie3" },
    111   1.3      matt 	{ ISOURCE_USB1, "usb1" },
    112   1.2      matt 	{ ISOURCE_ETSEC1_TX, "etsec1-tx" },
    113   1.2      matt 	{ ISOURCE_ETSEC1_RX, "etsec1-rx" },
    114   1.2      matt 	{ ISOURCE_ETSEC3_TX, "etsec3-tx" },
    115   1.2      matt 	{ ISOURCE_ETSEC3_RX, "etsec3-rx" },
    116   1.2      matt 	{ ISOURCE_ETSEC3_ERR, "etsec3-err" },
    117   1.2      matt 	{ ISOURCE_ETSEC1_ERR, "etsec1-err" },
    118   1.2      matt 	{ ISOURCE_ETSEC2_TX, "etsec2-tx" },
    119   1.2      matt 	{ ISOURCE_ETSEC2_RX, "etsec2-rx" },
    120   1.2      matt 	{ ISOURCE_ETSEC4_TX, "etsec4-tx" },
    121   1.2      matt 	{ ISOURCE_ETSEC4_RX, "etsec4-rx" },
    122   1.2      matt 	{ ISOURCE_ETSEC4_ERR, "etsec4-err" },
    123   1.2      matt 	{ ISOURCE_ETSEC2_ERR, "etsec2-err" },
    124   1.2      matt 	{ ISOURCE_DUART, "duart" },
    125   1.2      matt 	{ ISOURCE_I2C, "i2c" },
    126   1.2      matt 	{ ISOURCE_PERFMON, "perfmon" },
    127   1.2      matt 	{ ISOURCE_SECURITY1, "sec1" },
    128   1.3      matt 	{ ISOURCE_GPIO, "gpio" },
    129   1.2      matt 	{ ISOURCE_SRIO_EWPU, "srio-ewpu" },
    130   1.2      matt 	{ ISOURCE_SRIO_ODBELL, "srio-odbell" },
    131   1.2      matt 	{ ISOURCE_SRIO_IDBELL, "srio-idbell" },
    132   1.2      matt 	{ ISOURCE_SRIO_OMU1, "srio-omu1" },
    133   1.2      matt 	{ ISOURCE_SRIO_IMU1, "srio-imu1" },
    134   1.2      matt 	{ ISOURCE_SRIO_OMU2, "srio-omu2" },
    135   1.7      matt 	{ ISOURCE_SRIO_IMU2, "srio-imu2" },
    136   1.2      matt 	{ ISOURCE_SECURITY2, "sec2" },
    137   1.2      matt 	{ ISOURCE_SPI, "spi" },
    138   1.2      matt 	{ ISOURCE_ETSEC1_PTP, "etsec1-ptp" },
    139   1.3      matt 	{ ISOURCE_ETSEC2_PTP, "etsec2-ptp" },
    140   1.2      matt 	{ ISOURCE_ETSEC3_PTP, "etsec3-ptp" },
    141   1.3      matt 	{ ISOURCE_ETSEC4_PTP, "etsec4-ptp" },
    142   1.2      matt 	{ ISOURCE_ESDHC, "esdhc" },
    143   1.2      matt 	{ 0, "" },
    144   1.2      matt };
    145   1.2      matt 
    146   1.3      matt const struct e500_intr_name default_external_intr_names[] = {
    147   1.2      matt 	{ 0, "" },
    148   1.2      matt };
    149   1.2      matt 
    150   1.2      matt static const struct e500_intr_name e500_msigroup_intr_names[] = {
    151   1.2      matt 	{ 0, "msigroup0" },
    152   1.2      matt 	{ 1, "msigroup1" },
    153   1.2      matt 	{ 2, "msigroup2" },
    154   1.2      matt 	{ 3, "msigroup3" },
    155   1.2      matt 	{ 4, "msigroup4" },
    156   1.2      matt 	{ 5, "msigroup5" },
    157   1.2      matt 	{ 6, "msigroup6" },
    158   1.2      matt 	{ 7, "msigroup7" },
    159   1.2      matt 	{ 0, "" },
    160   1.2      matt };
    161   1.2      matt 
    162   1.2      matt static const struct e500_intr_name e500_timer_intr_names[] = {
    163   1.2      matt 	{ 0, "timer0" },
    164   1.2      matt 	{ 1, "timer1" },
    165   1.2      matt 	{ 2, "timer2" },
    166   1.2      matt 	{ 3, "timer3" },
    167   1.2      matt 	{ 0, "" },
    168   1.2      matt };
    169   1.2      matt 
    170   1.2      matt static const struct e500_intr_name e500_ipi_intr_names[] = {
    171   1.2      matt 	{ 0, "ipi0" },
    172   1.2      matt 	{ 1, "ipi1" },
    173   1.2      matt 	{ 2, "ipi2" },
    174   1.2      matt 	{ 3, "ipi3" },
    175   1.2      matt 	{ 0, "" },
    176   1.2      matt };
    177   1.2      matt 
    178   1.2      matt static const struct e500_intr_name e500_mi_intr_names[] = {
    179   1.2      matt 	{ 0, "mi0" },
    180   1.2      matt 	{ 1, "mi1" },
    181   1.2      matt 	{ 2, "mi2" },
    182   1.2      matt 	{ 3, "mi3" },
    183   1.2      matt 	{ 0, "" },
    184   1.2      matt };
    185   1.2      matt 
    186   1.2      matt struct e500_intr_info {
    187   1.2      matt 	u_int ii_external_sources;
    188   1.2      matt 	uint32_t ii_onchip_bitmap[2];
    189   1.2      matt 	u_int ii_onchip_sources;
    190   1.2      matt 	u_int ii_msigroup_sources;
    191   1.2      matt 	u_int ii_ipi_sources;			/* per-cpu */
    192   1.2      matt 	u_int ii_timer_sources;			/* per-cpu */
    193   1.2      matt 	u_int ii_mi_sources;			/* per-cpu */
    194   1.2      matt 	u_int ii_percpu_sources;
    195   1.2      matt 	const struct e500_intr_name *ii_external_intr_names;
    196   1.2      matt 	const struct e500_intr_name *ii_onchip_intr_names;
    197   1.2      matt 	u_int8_t ii_ist_vectors[IST_MAX+1];
    198   1.2      matt };
    199   1.2      matt 
    200   1.3      matt static kmutex_t e500_intr_lock __cacheline_aligned;
    201   1.2      matt static struct e500_intr_info e500_intr_info;
    202   1.2      matt 
    203   1.3      matt #define	INTR_INFO_DECL(lc_chip, UC_CHIP)				\
    204   1.3      matt static const struct e500_intr_info lc_chip##_intr_info = {		\
    205   1.3      matt 	.ii_external_sources = UC_CHIP ## _EXTERNALSOURCES,		\
    206   1.3      matt 	.ii_onchip_bitmap = UC_CHIP ## _ONCHIPBITMAP,			\
    207   1.3      matt 	.ii_onchip_sources = UC_CHIP ## _ONCHIPSOURCES,			\
    208   1.3      matt 	.ii_msigroup_sources = UC_CHIP ## _MSIGROUPSOURCES,		\
    209   1.3      matt 	.ii_timer_sources = UC_CHIP ## _TIMERSOURCES,			\
    210   1.3      matt 	.ii_ipi_sources = UC_CHIP ## _IPISOURCES,			\
    211   1.3      matt 	.ii_mi_sources = UC_CHIP ## _MISOURCES,				\
    212   1.3      matt 	.ii_percpu_sources = UC_CHIP ## _TIMERSOURCES			\
    213   1.3      matt 	    + UC_CHIP ## _IPISOURCES + UC_CHIP ## _MISOURCES, 		\
    214   1.3      matt 	.ii_external_intr_names = lc_chip ## _external_intr_names,	\
    215   1.3      matt 	.ii_onchip_intr_names = lc_chip ## _onchip_intr_names,		\
    216   1.3      matt 	.ii_ist_vectors = {						\
    217   1.3      matt 		[IST_NONE]		= ~0,				\
    218   1.3      matt 		[IST_EDGE]		= 0,				\
    219   1.3      matt 		[IST_LEVEL_LOW]		= 0,				\
    220   1.3      matt 		[IST_LEVEL_HIGH]	= 0,				\
    221  1.11      matt 		[IST_PULSE]		= 0,				\
    222   1.3      matt 		[IST_ONCHIP]		= UC_CHIP ## _EXTERNALSOURCES,	\
    223   1.3      matt 		[IST_MSIGROUP]		= UC_CHIP ## _EXTERNALSOURCES	\
    224   1.3      matt 					    + UC_CHIP ## _ONCHIPSOURCES, \
    225   1.3      matt 		[IST_TIMER]		= UC_CHIP ## _EXTERNALSOURCES	\
    226   1.3      matt 					    + UC_CHIP ## _ONCHIPSOURCES	\
    227   1.3      matt 					    + UC_CHIP ## _MSIGROUPSOURCES, \
    228   1.3      matt 		[IST_IPI]		= UC_CHIP ## _EXTERNALSOURCES	\
    229   1.3      matt 					    + UC_CHIP ## _ONCHIPSOURCES	\
    230   1.3      matt 					    + UC_CHIP ## _MSIGROUPSOURCES \
    231   1.3      matt 					    + UC_CHIP ## _TIMERSOURCES,	\
    232   1.3      matt 		[IST_MI]		= UC_CHIP ## _EXTERNALSOURCES	\
    233   1.3      matt 					    + UC_CHIP ## _ONCHIPSOURCES	\
    234   1.3      matt 					    + UC_CHIP ## _MSIGROUPSOURCES \
    235   1.3      matt 					    + UC_CHIP ## _TIMERSOURCES	\
    236   1.3      matt 					    + UC_CHIP ## _IPISOURCES,	\
    237   1.3      matt 		[IST_MAX]		= UC_CHIP ## _EXTERNALSOURCES	\
    238   1.3      matt 					    + UC_CHIP ## _ONCHIPSOURCES	\
    239   1.3      matt 					    + UC_CHIP ## _MSIGROUPSOURCES \
    240   1.3      matt 					    + UC_CHIP ## _TIMERSOURCES	\
    241   1.3      matt 					    + UC_CHIP ## _IPISOURCES	\
    242   1.3      matt 					    + UC_CHIP ## _MISOURCES,	\
    243   1.3      matt 	},								\
    244   1.3      matt }
    245   1.3      matt 
    246   1.3      matt #ifdef MPC8536
    247   1.3      matt #define	mpc8536_external_intr_names	default_external_intr_names
    248   1.3      matt const struct e500_intr_name mpc8536_onchip_intr_names[] = {
    249   1.3      matt 	{ ISOURCE_SATA2, "sata2" },
    250   1.3      matt 	{ ISOURCE_USB2, "usb2" },
    251   1.3      matt 	{ ISOURCE_USB3, "usb3" },
    252   1.3      matt 	{ ISOURCE_SATA1, "sata1" },
    253   1.3      matt 	{ 0, "" },
    254   1.3      matt };
    255   1.3      matt 
    256   1.3      matt INTR_INFO_DECL(mpc8536, MPC8536);
    257   1.3      matt #endif
    258   1.3      matt 
    259   1.3      matt #ifdef MPC8544
    260   1.3      matt #define	mpc8544_external_intr_names	default_external_intr_names
    261   1.3      matt const struct e500_intr_name mpc8544_onchip_intr_names[] = {
    262   1.3      matt 	{ 0, "" },
    263   1.3      matt };
    264   1.3      matt 
    265   1.3      matt INTR_INFO_DECL(mpc8544, MPC8544);
    266   1.3      matt #endif
    267   1.3      matt #ifdef MPC8548
    268   1.3      matt #define	mpc8548_external_intr_names	default_external_intr_names
    269   1.3      matt const struct e500_intr_name mpc8548_onchip_intr_names[] = {
    270   1.3      matt 	{ ISOURCE_PCI1, "pci1" },
    271   1.3      matt 	{ ISOURCE_PCI2, "pci2" },
    272   1.3      matt 	{ 0, "" },
    273   1.2      matt };
    274   1.2      matt 
    275   1.3      matt INTR_INFO_DECL(mpc8548, MPC8548);
    276   1.3      matt #endif
    277   1.3      matt #ifdef MPC8555
    278   1.3      matt #define	mpc8555_external_intr_names	default_external_intr_names
    279   1.3      matt const struct e500_intr_name mpc8555_onchip_intr_names[] = {
    280   1.3      matt 	{ ISOURCE_PCI2, "pci2" },
    281   1.3      matt 	{ ISOURCE_CPM, "CPM" },
    282   1.3      matt 	{ 0, "" },
    283   1.3      matt };
    284   1.3      matt 
    285   1.3      matt INTR_INFO_DECL(mpc8555, MPC8555);
    286   1.3      matt #endif
    287   1.3      matt #ifdef MPC8568
    288   1.3      matt #define	mpc8568_external_intr_names	default_external_intr_names
    289   1.3      matt const struct e500_intr_name mpc8568_onchip_intr_names[] = {
    290   1.3      matt 	{ ISOURCE_QEB_LOW, "QEB low" },
    291   1.3      matt 	{ ISOURCE_QEB_PORT, "QEB port" },
    292   1.3      matt 	{ ISOURCE_QEB_IECC, "QEB iram ecc" },
    293   1.3      matt 	{ ISOURCE_QEB_MUECC, "QEB ram ecc" },
    294   1.3      matt 	{ ISOURCE_TLU1, "tlu1" },
    295   1.3      matt 	{ ISOURCE_QEB_HIGH, "QEB high" },
    296   1.3      matt 	{ 0, "" },
    297   1.3      matt };
    298   1.3      matt 
    299   1.3      matt INTR_INFO_DECL(mpc8568, MPC8568);
    300   1.3      matt #endif
    301   1.3      matt #ifdef MPC8572
    302   1.3      matt #define	mpc8572_external_intr_names	default_external_intr_names
    303   1.3      matt const struct e500_intr_name mpc8572_onchip_intr_names[] = {
    304   1.3      matt 	{ ISOURCE_PCIEX3_MPC8572, "pcie3" },
    305   1.3      matt 	{ ISOURCE_FEC, "fec" },
    306   1.3      matt 	{ ISOURCE_PME_GENERAL, "pme" },
    307   1.3      matt 	{ ISOURCE_TLU1, "tlu1" },
    308   1.3      matt 	{ ISOURCE_TLU2, "tlu2" },
    309   1.3      matt 	{ ISOURCE_PME_CHAN1, "pme-chan1" },
    310   1.3      matt 	{ ISOURCE_PME_CHAN2, "pme-chan2" },
    311   1.3      matt 	{ ISOURCE_PME_CHAN3, "pme-chan3" },
    312   1.3      matt 	{ ISOURCE_PME_CHAN4, "pme-chan4" },
    313   1.3      matt 	{ ISOURCE_DMA2_CHAN1, "dma2-chan1" },
    314   1.3      matt 	{ ISOURCE_DMA2_CHAN2, "dma2-chan2" },
    315   1.3      matt 	{ ISOURCE_DMA2_CHAN3, "dma2-chan3" },
    316   1.3      matt 	{ ISOURCE_DMA2_CHAN4, "dma2-chan4" },
    317   1.3      matt 	{ 0, "" },
    318   1.2      matt };
    319   1.2      matt 
    320   1.3      matt INTR_INFO_DECL(mpc8572, MPC8572);
    321   1.3      matt #endif
    322   1.3      matt #ifdef P2020
    323   1.3      matt #define	p20x0_external_intr_names	default_external_intr_names
    324   1.3      matt const struct e500_intr_name p20x0_onchip_intr_names[] = {
    325   1.3      matt 	{ ISOURCE_PCIEX3_MPC8572, "pcie3" },
    326   1.3      matt 	{ ISOURCE_DMA2_CHAN1, "dma2-chan1" },
    327   1.3      matt 	{ ISOURCE_DMA2_CHAN2, "dma2-chan2" },
    328   1.3      matt 	{ ISOURCE_DMA2_CHAN3, "dma2-chan3" },
    329   1.3      matt 	{ ISOURCE_DMA2_CHAN4, "dma2-chan4" },
    330   1.3      matt 	{ 0, "" },
    331   1.2      matt };
    332   1.2      matt 
    333   1.3      matt INTR_INFO_DECL(p20x0, P20x0);
    334   1.3      matt #endif
    335   1.3      matt 
    336   1.2      matt static const char ist_names[][12] = {
    337   1.2      matt 	[IST_NONE] = "none",
    338   1.2      matt 	[IST_EDGE] = "edge",
    339   1.2      matt 	[IST_LEVEL_LOW] = "level-",
    340   1.2      matt 	[IST_LEVEL_HIGH] = "level+",
    341  1.11      matt 	[IST_PULSE] = "pulse",
    342   1.2      matt 	[IST_MSI] = "msi",
    343   1.2      matt 	[IST_ONCHIP] = "onchip",
    344   1.2      matt 	[IST_MSIGROUP] = "msigroup",
    345   1.2      matt 	[IST_TIMER] = "timer",
    346   1.2      matt 	[IST_IPI] = "ipi",
    347   1.2      matt 	[IST_MI] = "msgint",
    348   1.2      matt };
    349   1.2      matt 
    350   1.2      matt static struct intr_source *e500_intr_sources;
    351   1.2      matt static const struct intr_source *e500_intr_last_source;
    352   1.2      matt 
    353   1.2      matt static void 	*e500_intr_establish(int, int, int, int (*)(void *), void *);
    354   1.2      matt static void 	e500_intr_disestablish(void *);
    355   1.8      matt static void 	e500_intr_cpu_attach(struct cpu_info *ci);
    356   1.8      matt static void 	e500_intr_cpu_hatch(struct cpu_info *ci);
    357   1.8      matt static void	e500_intr_cpu_send_ipi(cpuid_t, uintptr_t);
    358   1.2      matt static void 	e500_intr_init(void);
    359   1.2      matt static const char *e500_intr_string(int, int);
    360  1.11      matt static const char *e500_intr_typename(int);
    361   1.2      matt static void 	e500_critintr(struct trapframe *tf);
    362   1.2      matt static void 	e500_decrintr(struct trapframe *tf);
    363   1.2      matt static void 	e500_extintr(struct trapframe *tf);
    364   1.2      matt static void 	e500_fitintr(struct trapframe *tf);
    365   1.2      matt static void 	e500_wdogintr(struct trapframe *tf);
    366   1.2      matt static void	e500_spl0(void);
    367   1.2      matt static int 	e500_splraise(int);
    368   1.2      matt static void 	e500_splx(int);
    369   1.2      matt 
    370   1.2      matt const struct intrsw e500_intrsw = {
    371   1.2      matt 	.intrsw_establish = e500_intr_establish,
    372   1.2      matt 	.intrsw_disestablish = e500_intr_disestablish,
    373   1.2      matt 	.intrsw_init = e500_intr_init,
    374   1.8      matt 	.intrsw_cpu_attach = e500_intr_cpu_attach,
    375   1.8      matt 	.intrsw_cpu_hatch = e500_intr_cpu_hatch,
    376   1.8      matt 	.intrsw_cpu_send_ipi = e500_intr_cpu_send_ipi,
    377   1.2      matt 	.intrsw_string = e500_intr_string,
    378  1.11      matt 	.intrsw_typename = e500_intr_typename,
    379   1.2      matt 
    380   1.2      matt 	.intrsw_critintr = e500_critintr,
    381   1.2      matt 	.intrsw_decrintr = e500_decrintr,
    382   1.2      matt 	.intrsw_extintr = e500_extintr,
    383   1.2      matt 	.intrsw_fitintr = e500_fitintr,
    384   1.2      matt 	.intrsw_wdogintr = e500_wdogintr,
    385   1.2      matt 
    386   1.2      matt 	.intrsw_splraise = e500_splraise,
    387   1.2      matt 	.intrsw_splx = e500_splx,
    388   1.2      matt 	.intrsw_spl0 = e500_spl0,
    389   1.2      matt 
    390   1.2      matt #ifdef __HAVE_FAST_SOFTINTS
    391  1.10      matt 	.intrsw_softint_init_md = powerpc_softint_init_md,
    392  1.10      matt 	.intrsw_softint_trigger = powerpc_softint_trigger,
    393   1.2      matt #endif
    394   1.2      matt };
    395   1.2      matt 
    396   1.2      matt static inline uint32_t
    397   1.2      matt openpic_read(struct cpu_softc *cpu, bus_size_t offset)
    398   1.2      matt {
    399   1.2      matt 
    400   1.2      matt 	return bus_space_read_4(cpu->cpu_bst, cpu->cpu_bsh,
    401   1.2      matt 	    OPENPIC_BASE + offset);
    402   1.2      matt }
    403   1.2      matt 
    404   1.2      matt static inline void
    405   1.2      matt openpic_write(struct cpu_softc *cpu, bus_size_t offset, uint32_t val)
    406   1.2      matt {
    407   1.2      matt 
    408   1.2      matt 	return bus_space_write_4(cpu->cpu_bst, cpu->cpu_bsh,
    409   1.2      matt 	    OPENPIC_BASE + offset, val);
    410   1.2      matt }
    411   1.2      matt 
    412   1.2      matt static const char *
    413   1.2      matt e500_intr_external_name_lookup(int irq)
    414   1.2      matt {
    415   1.2      matt 	prop_array_t extirqs = board_info_get_object("external-irqs");
    416   1.2      matt 	prop_string_t irqname = prop_array_get(extirqs, irq);
    417   1.2      matt 	KASSERT(irqname != NULL);
    418   1.2      matt 	KASSERT(prop_object_type(irqname) == PROP_TYPE_STRING);
    419   1.2      matt 
    420   1.2      matt 	return prop_string_cstring_nocopy(irqname);
    421   1.2      matt }
    422   1.2      matt 
    423   1.2      matt static const char *
    424   1.2      matt e500_intr_name_lookup(const struct e500_intr_name *names, int irq)
    425   1.2      matt {
    426   1.2      matt 	for (; names->in_name[0] != '\0'; names++) {
    427   1.2      matt 		if (names->in_irq == irq)
    428   1.2      matt 			return names->in_name;
    429   1.2      matt 	}
    430   1.2      matt 
    431   1.2      matt 	return NULL;
    432   1.2      matt }
    433   1.2      matt 
    434   1.2      matt static const char *
    435   1.2      matt e500_intr_onchip_name_lookup(int irq)
    436   1.2      matt {
    437   1.2      matt 	const char *name;
    438   1.2      matt 
    439   1.5      matt 	name = e500_intr_name_lookup(e500_intr_info.ii_onchip_intr_names, irq);
    440   1.5      matt 	if (name == NULL)
    441   1.5      matt 	       name = e500_intr_name_lookup(e500_onchip_intr_names, irq);
    442   1.2      matt 
    443   1.5      matt 	return name;
    444   1.2      matt }
    445   1.2      matt 
    446   1.2      matt static inline void
    447   1.2      matt e500_splset(struct cpu_info *ci, int ipl)
    448   1.2      matt {
    449   1.2      matt 	struct cpu_softc * const cpu = ci->ci_softc;
    450  1.13      matt 
    451   1.2      matt 	//KASSERT(!cpu_intr_p() || ipl >= IPL_VM);
    452   1.2      matt 	KASSERT((curlwp->l_pflag & LP_INTR) == 0 || ipl != IPL_NONE);
    453   1.2      matt #if 0
    454   1.2      matt 	u_int ctpr = ipl;
    455   1.2      matt 	KASSERT(openpic_read(cpu, OPENPIC_CTPR) == ci->ci_cpl);
    456   1.2      matt #elif 0
    457   1.2      matt 	u_int old_ctpr = (ci->ci_cpl >= IPL_VM ? 15 : ci->ci_cpl);
    458   1.2      matt 	u_int ctpr = (ipl >= IPL_VM ? 15 : ipl);
    459   1.2      matt 	KASSERT(openpic_read(cpu, OPENPIC_CTPR) == old_ctpr);
    460   1.2      matt #else
    461  1.13      matt 	const u_int ctpr = IPL2CTPR(ipl);
    462  1.12      matt 	KASSERT(openpic_read(cpu, OPENPIC_CTPR) == IPL2CTPR(ci->ci_cpl));
    463   1.2      matt #endif
    464   1.2      matt 	openpic_write(cpu, OPENPIC_CTPR, ctpr);
    465   1.2      matt 	KASSERT(openpic_read(cpu, OPENPIC_CTPR) == ctpr);
    466   1.2      matt 	ci->ci_cpl = ipl;
    467   1.2      matt }
    468   1.2      matt 
    469   1.2      matt static void
    470   1.2      matt e500_spl0(void)
    471   1.2      matt {
    472  1.12      matt 	wrtee(0);
    473  1.12      matt 
    474   1.2      matt 	struct cpu_info * const ci = curcpu();
    475   1.2      matt 
    476   1.2      matt #ifdef __HAVE_FAST_SOFTINTS
    477   1.2      matt 	if (__predict_false(ci->ci_data.cpu_softints != 0)) {
    478   1.2      matt 		e500_splset(ci, IPL_HIGH);
    479  1.10      matt 		powerpc_softint(ci, IPL_NONE,
    480   1.8      matt 		    (vaddr_t)__builtin_return_address(0));
    481   1.2      matt 	}
    482   1.2      matt #endif /* __HAVE_FAST_SOFTINTS */
    483   1.2      matt 	e500_splset(ci, IPL_NONE);
    484   1.2      matt 
    485   1.2      matt 	wrtee(PSL_EE);
    486   1.2      matt }
    487   1.2      matt 
    488   1.2      matt static void
    489   1.2      matt e500_splx(int ipl)
    490   1.2      matt {
    491   1.2      matt 	struct cpu_info * const ci = curcpu();
    492   1.2      matt 	const int old_ipl = ci->ci_cpl;
    493   1.2      matt 
    494   1.2      matt 	KASSERT(mfmsr() & PSL_CE);
    495   1.2      matt 
    496   1.2      matt 	if (ipl == old_ipl)
    497   1.2      matt 		return;
    498   1.2      matt 
    499   1.2      matt 	if (__predict_false(ipl > old_ipl)) {
    500   1.2      matt 		printf("%s: %p: cpl=%u: ignoring splx(%u) to raise ipl\n",
    501   1.2      matt 		    __func__, __builtin_return_address(0), old_ipl, ipl);
    502   1.2      matt 		if (old_ipl == IPL_NONE)
    503   1.2      matt 			Debugger();
    504   1.2      matt 	}
    505   1.2      matt 
    506   1.2      matt 	// const
    507   1.2      matt 	register_t msr = wrtee(0);
    508   1.2      matt #ifdef __HAVE_FAST_SOFTINTS
    509   1.2      matt 	const u_int softints = (ci->ci_data.cpu_softints << ipl) & IPL_SOFTMASK;
    510   1.2      matt 	if (__predict_false(softints != 0)) {
    511   1.2      matt 		e500_splset(ci, IPL_HIGH);
    512  1.10      matt 		powerpc_softint(ci, ipl,
    513   1.8      matt 		    (vaddr_t)__builtin_return_address(0));
    514   1.2      matt 	}
    515   1.2      matt #endif /* __HAVE_FAST_SOFTINTS */
    516   1.2      matt 	e500_splset(ci, ipl);
    517   1.2      matt #if 1
    518   1.2      matt 	if (ipl < IPL_VM && old_ipl >= IPL_VM)
    519   1.2      matt 		msr = PSL_EE;
    520   1.2      matt #endif
    521   1.2      matt 	wrtee(msr);
    522   1.2      matt }
    523   1.2      matt 
    524   1.2      matt static int
    525   1.2      matt e500_splraise(int ipl)
    526   1.2      matt {
    527   1.2      matt 	struct cpu_info * const ci = curcpu();
    528   1.2      matt 	const int old_ipl = ci->ci_cpl;
    529   1.2      matt 
    530   1.2      matt 	KASSERT(mfmsr() & PSL_CE);
    531   1.2      matt 
    532   1.2      matt 	if (old_ipl < ipl) {
    533   1.2      matt 		//const
    534   1.2      matt 		register_t msr = wrtee(0);
    535   1.2      matt 		e500_splset(ci, ipl);
    536   1.2      matt #if 1
    537   1.2      matt 		if (old_ipl < IPL_VM && ipl >= IPL_VM)
    538   1.2      matt 			msr = 0;
    539   1.2      matt #endif
    540   1.2      matt 		wrtee(msr);
    541   1.2      matt 	} else if (ipl == IPL_NONE) {
    542   1.2      matt 		panic("%s: %p: cpl=%u: attempt to splraise(IPL_NONE)",
    543   1.2      matt 		    __func__, __builtin_return_address(0), old_ipl);
    544   1.2      matt #if 0
    545   1.2      matt 	} else if (old_ipl > ipl) {
    546   1.2      matt 		printf("%s: %p: cpl=%u: ignoring splraise(%u) to lower ipl\n",
    547   1.2      matt 		    __func__, __builtin_return_address(0), old_ipl, ipl);
    548   1.2      matt #endif
    549   1.2      matt 	}
    550   1.2      matt 
    551   1.2      matt 	return old_ipl;
    552   1.2      matt }
    553   1.2      matt 
    554   1.2      matt static int
    555   1.2      matt e500_intr_spurious(void *arg)
    556   1.2      matt {
    557   1.2      matt 	return 0;
    558   1.2      matt }
    559   1.2      matt 
    560   1.2      matt static bool
    561   1.2      matt e500_intr_irq_info_get(struct cpu_info *ci, u_int irq, int ipl, int ist,
    562   1.2      matt 	struct e500_intr_irq_info *ii)
    563   1.2      matt {
    564   1.2      matt 	const struct e500_intr_info * const info = &e500_intr_info;
    565   1.2      matt 	bool ok;
    566   1.2      matt 
    567   1.2      matt #if DEBUG > 2
    568   1.2      matt 	printf("%s(%p,irq=%u,ipl=%u,ist=%u,%p)\n", __func__, ci, irq, ipl, ist, ii);
    569   1.2      matt #endif
    570   1.2      matt 
    571   1.2      matt 	if (ipl < IPL_VM || ipl > IPL_HIGH) {
    572   1.2      matt #if DEBUG > 2
    573   1.2      matt 		printf("%s:%d ipl=%u\n", __func__, __LINE__, ipl);
    574   1.2      matt #endif
    575   1.2      matt 		return false;
    576   1.2      matt 	}
    577   1.2      matt 
    578   1.2      matt 	if (ist <= IST_NONE || ist >= IST_MAX) {
    579   1.2      matt #if DEBUG > 2
    580   1.2      matt 		printf("%s:%d ist=%u\n", __func__, __LINE__, ist);
    581   1.2      matt #endif
    582   1.2      matt 		return false;
    583   1.2      matt 	}
    584   1.2      matt 
    585   1.2      matt 	ii->irq_vector = irq + info->ii_ist_vectors[ist];
    586   1.8      matt 	if (IST_PERCPU_P(ist) && ist != IST_IPI)
    587   1.2      matt 		ii->irq_vector += ci->ci_cpuid * info->ii_percpu_sources;
    588   1.2      matt 
    589   1.2      matt 	switch (ist) {
    590   1.2      matt 	default:
    591   1.2      matt 		ii->irq_vpr = OPENPIC_EIVPR(irq);
    592   1.2      matt 		ii->irq_dr  = OPENPIC_EIDR(irq);
    593   1.2      matt 		ok = irq < info->ii_external_sources
    594   1.2      matt 		    && (ist == IST_EDGE
    595   1.2      matt 			|| ist == IST_LEVEL_LOW
    596   1.2      matt 			|| ist == IST_LEVEL_HIGH);
    597   1.2      matt 		break;
    598  1.11      matt 	case IST_PULSE:
    599  1.11      matt 		ok = false;
    600  1.11      matt 		break;
    601   1.2      matt 	case IST_ONCHIP:
    602   1.2      matt 		ii->irq_vpr = OPENPIC_IIVPR(irq);
    603   1.2      matt 		ii->irq_dr  = OPENPIC_IIDR(irq);
    604   1.2      matt 		ok = irq < 32 * __arraycount(info->ii_onchip_bitmap);
    605   1.2      matt #if DEBUG > 2
    606   1.2      matt 		printf("%s: irq=%u: ok=%u\n", __func__, irq, ok);
    607   1.2      matt #endif
    608   1.2      matt 		ok = ok && (info->ii_onchip_bitmap[irq/32] & (1 << (irq & 31)));
    609   1.2      matt #if DEBUG > 2
    610   1.2      matt 		printf("%s: %08x%08x -> %08x%08x: ok=%u\n", __func__,
    611   1.2      matt 		    irq < 32 ? 0 : (1 << irq), irq < 32 ? (1 << irq) : 0,
    612   1.2      matt 		    info->ii_onchip_bitmap[1], info->ii_onchip_bitmap[0],
    613   1.2      matt 		    ok);
    614   1.2      matt #endif
    615   1.2      matt 		break;
    616   1.2      matt 	case IST_MSIGROUP:
    617   1.2      matt 		ii->irq_vpr = OPENPIC_MSIVPR(irq);
    618   1.2      matt 		ii->irq_dr  = OPENPIC_MSIDR(irq);
    619   1.2      matt 		ok = irq < info->ii_msigroup_sources
    620   1.2      matt 		    && ipl == IPL_VM;
    621   1.2      matt 		break;
    622   1.2      matt 	case IST_TIMER:
    623   1.2      matt 		ii->irq_vpr = OPENPIC_GTVPR(ci->ci_cpuid, irq);
    624   1.2      matt 		ii->irq_dr  = OPENPIC_GTDR(ci->ci_cpuid, irq);
    625   1.2      matt 		ok = irq < info->ii_timer_sources;
    626   1.2      matt #if DEBUG > 2
    627   1.2      matt 		printf("%s: IST_TIMER irq=%u: ok=%u\n", __func__, irq, ok);
    628   1.2      matt #endif
    629   1.2      matt 		break;
    630   1.2      matt 	case IST_IPI:
    631   1.2      matt 		ii->irq_vpr = OPENPIC_IPIVPR(irq);
    632   1.2      matt 		ii->irq_dr  = OPENPIC_IPIDR(irq);
    633   1.2      matt 		ok = irq < info->ii_ipi_sources;
    634   1.2      matt 		break;
    635   1.2      matt 	case IST_MI:
    636   1.2      matt 		ii->irq_vpr = OPENPIC_MIVPR(irq);
    637   1.2      matt 		ii->irq_dr  = OPENPIC_MIDR(irq);
    638   1.2      matt 		ok = irq < info->ii_mi_sources;
    639   1.2      matt 		break;
    640   1.2      matt 	}
    641   1.2      matt 
    642   1.2      matt 	return ok;
    643   1.2      matt }
    644   1.2      matt 
    645   1.2      matt static const char *
    646   1.2      matt e500_intr_string(int irq, int ist)
    647   1.2      matt {
    648   1.2      matt 	struct cpu_info * const ci = curcpu();
    649   1.2      matt 	struct cpu_softc * const cpu = ci->ci_softc;
    650   1.2      matt 	struct e500_intr_irq_info ii;
    651   1.2      matt 
    652   1.2      matt 	if (!e500_intr_irq_info_get(ci, irq, IPL_VM, ist, &ii))
    653   1.2      matt 		return NULL;
    654   1.2      matt 
    655   1.2      matt 	return cpu->cpu_evcnt_intrs[ii.irq_vector].ev_name;
    656   1.2      matt }
    657   1.2      matt 
    658  1.11      matt __CTASSERT(__arraycount(ist_names) == IST_MAX);
    659  1.11      matt 
    660  1.11      matt static const char *
    661  1.11      matt e500_intr_typename(int ist)
    662  1.11      matt {
    663  1.11      matt 	if (IST_NONE <= ist && ist < IST_MAX)
    664  1.11      matt 		return ist_names[ist];
    665  1.11      matt 
    666  1.11      matt 	return NULL;
    667  1.11      matt }
    668  1.11      matt 
    669   1.2      matt static void *
    670   1.2      matt e500_intr_cpu_establish(struct cpu_info *ci, int irq, int ipl, int ist,
    671   1.2      matt 	int (*handler)(void *), void *arg)
    672   1.2      matt {
    673   1.2      matt 	struct cpu_softc * const cpu = ci->ci_softc;
    674   1.2      matt 	struct e500_intr_irq_info ii;
    675   1.2      matt 
    676   1.2      matt 	KASSERT(ipl >= IPL_VM && ipl <= IPL_HIGH);
    677   1.2      matt 	KASSERT(ist > IST_NONE && ist < IST_MAX && ist != IST_MSI);
    678   1.2      matt 
    679   1.2      matt 	if (!e500_intr_irq_info_get(ci, irq, ipl, ist, &ii)) {
    680   1.2      matt 		printf("%s: e500_intr_irq_info_get(%p,%u,%u,%u,%p) failed\n",
    681   1.2      matt 		    __func__, ci, irq, ipl, ist, &ii);
    682   1.2      matt 		return NULL;
    683   1.2      matt 	}
    684   1.2      matt 
    685   1.2      matt 	struct intr_source * const is = &e500_intr_sources[ii.irq_vector];
    686   1.2      matt 	mutex_enter(&e500_intr_lock);
    687   1.2      matt 	if (is->is_ipl != IPL_NONE)
    688   1.2      matt 		return NULL;
    689   1.2      matt 
    690   1.2      matt 	is->is_func = handler;
    691   1.2      matt 	is->is_arg = arg;
    692   1.2      matt 	is->is_ipl = ipl;
    693   1.2      matt 	is->is_ist = ist;
    694   1.2      matt 	is->is_irq = irq;
    695   1.2      matt 	is->is_vpr = ii.irq_vpr;
    696   1.2      matt 	is->is_dr = ii.irq_dr;
    697   1.2      matt 
    698   1.2      matt 	uint32_t vpr = VPR_PRIORITY_MAKE(IPL2CTPR(ipl))
    699   1.2      matt 	    | VPR_VECTOR_MAKE(((ii.irq_vector + 1) << 4) | ipl)
    700   1.2      matt 	    | (ist == IST_LEVEL_LOW
    701   1.2      matt 		? VPR_LEVEL_LOW
    702   1.2      matt 		: (ist == IST_LEVEL_HIGH
    703   1.2      matt 		    ? VPR_LEVEL_HIGH
    704   1.2      matt 		    : (ist == IST_ONCHIP
    705   1.2      matt 		      ? VPR_P_HIGH
    706   1.2      matt 		      : 0)));
    707   1.2      matt 
    708   1.2      matt 	/*
    709   1.2      matt 	 * All interrupts go to the primary except per-cpu interrupts which get
    710   1.2      matt 	 * routed to the appropriate cpu.
    711   1.2      matt 	 */
    712   1.8      matt 	uint32_t dr = openpic_read(cpu, ii.irq_dr);
    713   1.8      matt 
    714   1.8      matt 	dr |= 1 << (IST_PERCPU_P(ist) ? ci->ci_cpuid : 0);
    715   1.2      matt 
    716   1.2      matt 	/*
    717   1.2      matt 	 * Update the vector/priority and destination registers keeping the
    718   1.2      matt 	 * interrupt masked.
    719   1.2      matt 	 */
    720   1.2      matt 	const register_t msr = wrtee(0);	/* disable interrupts */
    721   1.2      matt 	openpic_write(cpu, ii.irq_vpr, vpr | VPR_MSK);
    722   1.2      matt 	openpic_write(cpu, ii.irq_dr, dr);
    723   1.2      matt 
    724   1.2      matt 	/*
    725   1.2      matt 	 * Now unmask the interrupt.
    726   1.2      matt 	 */
    727   1.2      matt 	openpic_write(cpu, ii.irq_vpr, vpr);
    728   1.2      matt 
    729   1.2      matt 	wrtee(msr);				/* re-enable interrupts */
    730   1.2      matt 
    731   1.2      matt 	mutex_exit(&e500_intr_lock);
    732   1.2      matt 
    733   1.2      matt 	return is;
    734   1.2      matt }
    735   1.2      matt 
    736   1.2      matt static void *
    737   1.2      matt e500_intr_establish(int irq, int ipl, int ist,
    738   1.2      matt 	int (*handler)(void *), void *arg)
    739   1.2      matt {
    740   1.2      matt 	return e500_intr_cpu_establish(curcpu(), irq, ipl, ist, handler, arg);
    741   1.2      matt }
    742   1.2      matt 
    743   1.2      matt static void
    744   1.2      matt e500_intr_disestablish(void *vis)
    745   1.2      matt {
    746   1.2      matt 	struct cpu_softc * const cpu = curcpu()->ci_softc;
    747   1.2      matt 	struct intr_source * const is = vis;
    748   1.2      matt 	struct e500_intr_irq_info ii;
    749   1.2      matt 
    750   1.2      matt 	KASSERT(e500_intr_sources <= is);
    751   1.2      matt 	KASSERT(is < e500_intr_last_source);
    752   1.2      matt 	KASSERT(!cpu_intr_p());
    753   1.2      matt 
    754   1.2      matt 	bool ok = e500_intr_irq_info_get(curcpu(), is->is_irq, is->is_ipl,
    755   1.2      matt 	    is->is_ist, &ii);
    756   1.2      matt 	(void)ok;	/* appease gcc */
    757   1.2      matt 	KASSERT(ok);
    758   1.2      matt 	KASSERT(is - e500_intr_sources == ii.irq_vector);
    759   1.2      matt 
    760   1.2      matt 	mutex_enter(&e500_intr_lock);
    761   1.2      matt 	/*
    762   1.2      matt 	 * Mask the source using the mask (MSK) bit in the vector/priority reg.
    763   1.2      matt 	 */
    764   1.2      matt 	uint32_t vpr = openpic_read(cpu, ii.irq_vpr);
    765   1.2      matt 	openpic_write(cpu, ii.irq_vpr, VPR_MSK | vpr);
    766   1.2      matt 
    767   1.2      matt 	/*
    768   1.2      matt 	 * Wait for the Activity (A) bit for the source to be cleared.
    769   1.2      matt 	 */
    770   1.2      matt 	while (openpic_read(cpu, ii.irq_vpr) & VPR_A)
    771   1.2      matt 		;
    772   1.2      matt 
    773   1.2      matt 	/*
    774   1.2      matt 	 * Now the source can be modified.
    775   1.2      matt 	 */
    776   1.2      matt 	openpic_write(cpu, ii.irq_dr, 0);		/* stop delivery */
    777   1.2      matt 	openpic_write(cpu, ii.irq_vpr, VPR_MSK);	/* mask/reset it */
    778   1.2      matt 
    779   1.2      matt 	*is = (struct intr_source)INTR_SOURCE_INITIALIZER;
    780   1.2      matt 
    781   1.2      matt 	mutex_exit(&e500_intr_lock);
    782   1.2      matt }
    783   1.2      matt 
    784   1.2      matt static void
    785   1.2      matt e500_critintr(struct trapframe *tf)
    786   1.2      matt {
    787   1.2      matt 	panic("%s: srr0/srr1=%#lx/%#lx", __func__, tf->tf_srr0, tf->tf_srr1);
    788   1.2      matt }
    789   1.2      matt 
    790   1.2      matt static void
    791   1.2      matt e500_decrintr(struct trapframe *tf)
    792   1.2      matt {
    793   1.2      matt 	panic("%s: srr0/srr1=%#lx/%#lx", __func__, tf->tf_srr0, tf->tf_srr1);
    794   1.2      matt }
    795   1.2      matt 
    796   1.2      matt static void
    797   1.2      matt e500_fitintr(struct trapframe *tf)
    798   1.2      matt {
    799   1.2      matt 	panic("%s: srr0/srr1=%#lx/%#lx", __func__, tf->tf_srr0, tf->tf_srr1);
    800   1.2      matt }
    801   1.2      matt 
    802   1.2      matt static void
    803   1.2      matt e500_wdogintr(struct trapframe *tf)
    804   1.2      matt {
    805   1.2      matt 	mtspr(SPR_TSR, TSR_ENW|TSR_WIS);
    806   1.2      matt 	panic("%s: tf=%p tb=%"PRId64" srr0/srr1=%#lx/%#lx", __func__, tf,
    807   1.2      matt 	    mftb(), tf->tf_srr0, tf->tf_srr1);
    808   1.2      matt }
    809   1.2      matt 
    810   1.2      matt static void
    811   1.2      matt e500_extintr(struct trapframe *tf)
    812   1.2      matt {
    813   1.2      matt 	struct cpu_info * const ci = curcpu();
    814   1.2      matt 	struct cpu_softc * const cpu = ci->ci_softc;
    815   1.2      matt 	const int old_ipl = ci->ci_cpl;
    816   1.2      matt 
    817   1.2      matt 	KASSERT(mfmsr() & PSL_CE);
    818   1.2      matt 
    819   1.2      matt #if 0
    820   1.2      matt //	printf("%s(%p): idepth=%d enter\n", __func__, tf, ci->ci_idepth);
    821   1.2      matt 	if ((register_t)tf >= (register_t)curlwp->l_addr + USPACE
    822   1.2      matt 	    || (register_t)tf < (register_t)curlwp->l_addr + NBPG) {
    823   1.2      matt 		printf("%s(entry): pid %d.%d (%s): srr0/srr1=%#lx/%#lx: invalid tf addr %p\n",
    824   1.2      matt 		    __func__, curlwp->l_proc->p_pid, curlwp->l_lid,
    825   1.2      matt 		    curlwp->l_proc->p_comm, tf->tf_srr0, tf->tf_srr1, tf);
    826   1.2      matt 	}
    827   1.2      matt #endif
    828   1.2      matt 
    829   1.2      matt 
    830   1.2      matt 	ci->ci_data.cpu_nintr++;
    831   1.2      matt 	tf->tf_cf.cf_idepth = ci->ci_idepth++;
    832   1.2      matt 	cpu->cpu_pcpls[ci->ci_idepth] = old_ipl;
    833   1.2      matt #if 1
    834   1.2      matt 	if (mfmsr() & PSL_EE)
    835   1.2      matt 		panic("%s(%p): MSR[EE] is on (%#lx)!", __func__, tf, mfmsr());
    836   1.2      matt 	if (old_ipl == IPL_HIGH
    837   1.2      matt 	    || IPL2CTPR(old_ipl) != openpic_read(cpu, OPENPIC_CTPR))
    838   1.2      matt 		panic("%s(%p): old_ipl(%u) == IPL_HIGH(%u) "
    839   1.2      matt 		    "|| old_ipl + %u != OPENPIC_CTPR (%u)",
    840   1.2      matt 		    __func__, tf, old_ipl, IPL_HIGH,
    841   1.2      matt 		    15 - IPL_HIGH, openpic_read(cpu, OPENPIC_CTPR));
    842   1.2      matt #else
    843   1.2      matt 	if (old_ipl >= IPL_VM)
    844   1.2      matt 		panic("%s(%p): old_ipl(%u) >= IPL_VM(%u) CTPR=%u",
    845   1.2      matt 		    __func__, tf, old_ipl, IPL_VM, openpic_read(cpu, OPENPIC_CTPR));
    846   1.2      matt #endif
    847   1.2      matt 
    848   1.2      matt 	for (;;) {
    849   1.2      matt 		/*
    850   1.2      matt 		 * Find out the pending interrupt.
    851   1.2      matt 		 */
    852   1.2      matt 	if (mfmsr() & PSL_EE)
    853   1.2      matt 		panic("%s(%p): MSR[EE] turned on (%#lx)!", __func__, tf, mfmsr());
    854   1.2      matt 		if (IPL2CTPR(old_ipl) != openpic_read(cpu, OPENPIC_CTPR))
    855   1.2      matt 			panic("%s(%p): %d: old_ipl(%u) + %u != OPENPIC_CTPR (%u)",
    856   1.2      matt 			    __func__, tf, __LINE__, old_ipl,
    857   1.2      matt 			    15 - IPL_HIGH, openpic_read(cpu, OPENPIC_CTPR));
    858   1.2      matt 		const uint32_t iack = openpic_read(cpu, OPENPIC_IACK);
    859   1.6    dyoung #ifdef DIAGNOSTIC
    860   1.2      matt 		const int ipl = iack & 0xf;
    861   1.6    dyoung #endif
    862   1.2      matt 		const int irq = (iack >> 4) - 1;
    863   1.2      matt #if 0
    864   1.2      matt 		printf("%s: iack=%d ipl=%d irq=%d <%s>\n",
    865   1.2      matt 		    __func__, iack, ipl, irq,
    866   1.2      matt 		    (iack != IRQ_SPURIOUS ?
    867   1.2      matt 			cpu->cpu_evcnt_intrs[irq].ev_name : "spurious"));
    868   1.2      matt #endif
    869   1.2      matt 		if (IPL2CTPR(old_ipl) != openpic_read(cpu, OPENPIC_CTPR))
    870   1.2      matt 			panic("%s(%p): %d: old_ipl(%u) + %u != OPENPIC_CTPR (%u)",
    871   1.2      matt 			    __func__, tf, __LINE__, old_ipl,
    872   1.2      matt 			    15 - IPL_HIGH, openpic_read(cpu, OPENPIC_CTPR));
    873   1.2      matt 		if (iack == IRQ_SPURIOUS)
    874   1.2      matt 			break;
    875   1.2      matt 
    876   1.2      matt 		struct intr_source * const is = &e500_intr_sources[irq];
    877   1.2      matt 		if (__predict_true(is < e500_intr_last_source)) {
    878   1.2      matt 			/*
    879   1.2      matt 			 * Timer interrupts get their argument overriden with
    880   1.2      matt 			 * the pointer to the trapframe.
    881   1.2      matt 			 */
    882   1.2      matt 			KASSERT(is->is_ipl == ipl);
    883   1.2      matt 			void *arg = (is->is_ist == IST_TIMER ? tf : is->is_arg);
    884   1.2      matt 			if (is->is_ipl <= old_ipl)
    885   1.2      matt 				panic("%s(%p): %s (%u): is->is_ipl (%u) <= old_ipl (%u)\n",
    886   1.2      matt 				    __func__, tf,
    887   1.2      matt 				    cpu->cpu_evcnt_intrs[irq].ev_name, irq,
    888   1.2      matt 				    is->is_ipl, old_ipl);
    889   1.2      matt 			KASSERT(is->is_ipl > old_ipl);
    890   1.2      matt 			e500_splset(ci, is->is_ipl);	/* change IPL */
    891   1.2      matt 			if (__predict_false(is->is_func == NULL)) {
    892   1.2      matt 				aprint_error_dev(ci->ci_dev,
    893   1.2      matt 				    "interrupt from unestablished irq %d\n",
    894   1.2      matt 				    irq);
    895   1.2      matt 			} else {
    896   1.2      matt 				int (*func)(void *) = is->is_func;
    897   1.2      matt 				wrtee(PSL_EE);
    898   1.2      matt 				int rv = (*func)(arg);
    899   1.2      matt 				wrtee(0);
    900   1.2      matt #if DEBUG > 2
    901   1.2      matt 				printf("%s: %s handler %p(%p) returned %d\n",
    902   1.2      matt 				    __func__,
    903   1.2      matt 				    cpu->cpu_evcnt_intrs[irq].ev_name,
    904   1.2      matt 				    func, arg, rv);
    905   1.2      matt #endif
    906   1.2      matt 				if (rv == 0)
    907   1.2      matt 					cpu->cpu_evcnt_spurious_intr.ev_count++;
    908   1.2      matt 			}
    909   1.2      matt 			e500_splset(ci, old_ipl);	/* restore IPL */
    910   1.2      matt 			cpu->cpu_evcnt_intrs[irq].ev_count++;
    911   1.2      matt 		} else {
    912   1.2      matt 			aprint_error_dev(ci->ci_dev,
    913   1.2      matt 			    "interrupt from illegal irq %d\n", irq);
    914   1.2      matt 			cpu->cpu_evcnt_spurious_intr.ev_count++;
    915   1.2      matt 		}
    916   1.2      matt 		/*
    917   1.2      matt 		 * If this is a nested interrupt, simply ack it and exit
    918   1.2      matt 		 * because the loop we interrupted will complete looking
    919   1.2      matt 		 * for interrupts.
    920   1.2      matt 		 */
    921   1.2      matt 	if (mfmsr() & PSL_EE)
    922   1.2      matt 		panic("%s(%p): MSR[EE] left on (%#lx)!", __func__, tf, mfmsr());
    923   1.2      matt 		if (IPL2CTPR(old_ipl) != openpic_read(cpu, OPENPIC_CTPR))
    924   1.2      matt 			panic("%s(%p): %d: old_ipl(%u) + %u != OPENPIC_CTPR (%u)",
    925   1.2      matt 			    __func__, tf, __LINE__, old_ipl,
    926   1.2      matt 			    15 - IPL_HIGH, openpic_read(cpu, OPENPIC_CTPR));
    927   1.2      matt 
    928   1.2      matt 		openpic_write(cpu, OPENPIC_EOI, 0);
    929   1.2      matt 		if (IPL2CTPR(old_ipl) != openpic_read(cpu, OPENPIC_CTPR))
    930   1.2      matt 			panic("%s(%p): %d: old_ipl(%u) + %u != OPENPIC_CTPR (%u)",
    931   1.2      matt 			    __func__, tf, __LINE__, old_ipl,
    932   1.2      matt 			    15 - IPL_HIGH, openpic_read(cpu, OPENPIC_CTPR));
    933   1.2      matt 		if (ci->ci_idepth > 0)
    934   1.2      matt 			break;
    935   1.2      matt 	}
    936   1.2      matt 
    937   1.2      matt 	ci->ci_idepth--;
    938   1.2      matt 
    939   1.2      matt #ifdef __HAVE_FAST_SOFTINTS
    940   1.2      matt 	/*
    941   1.2      matt 	 * Before exiting, deal with any softints that need to be dealt with.
    942   1.2      matt 	 */
    943   1.2      matt 	const u_int softints = (ci->ci_data.cpu_softints << old_ipl) & IPL_SOFTMASK;
    944   1.2      matt 	if (__predict_false(softints != 0)) {
    945   1.2      matt 		KASSERT(old_ipl < IPL_VM);
    946   1.2      matt 		e500_splset(ci, IPL_HIGH);	/* pop to high */
    947  1.10      matt 		powerpc_softint(ci, old_ipl,	/* deal with them */
    948   1.8      matt 		    tf->tf_srr0);
    949   1.2      matt 		e500_splset(ci, old_ipl);	/* and drop back */
    950   1.2      matt 	}
    951   1.2      matt #endif /* __HAVE_FAST_SOFTINTS */
    952   1.2      matt #if 1
    953   1.2      matt 	KASSERT(ci->ci_cpl == old_ipl);
    954   1.2      matt #else
    955   1.2      matt 	e500_splset(ci, old_ipl);		/* and drop back */
    956   1.2      matt #endif
    957   1.2      matt 
    958  1.13      matt 	/*
    959  1.13      matt 	 * If we interrupted while power-saving and we need to exit idle,
    960  1.13      matt 	 * we need to clear PSL_POW so we won't go back into power-saving.
    961  1.13      matt 	 */
    962  1.13      matt 	if (__predict_false(tf->tf_srr1 & PSL_POW) && ci->ci_want_resched)
    963  1.13      matt 		tf->tf_srr1 &= ~PSL_POW;
    964  1.13      matt 
    965   1.2      matt //	printf("%s(%p): idepth=%d exit\n", __func__, tf, ci->ci_idepth);
    966   1.2      matt }
    967   1.2      matt 
    968   1.2      matt static void
    969   1.2      matt e500_intr_init(void)
    970   1.2      matt {
    971   1.2      matt 	struct cpu_info * const ci = curcpu();
    972   1.2      matt 	struct cpu_softc * const cpu = ci->ci_softc;
    973   1.2      matt 	const uint32_t frr = openpic_read(cpu, OPENPIC_FRR);
    974   1.2      matt 	const u_int nirq = FRR_NIRQ_GET(frr) + 1;
    975   1.2      matt //	const u_int ncpu = FRR_NCPU_GET(frr) + 1;
    976   1.2      matt 	struct intr_source *is;
    977   1.2      matt 	struct e500_intr_info * const ii = &e500_intr_info;
    978   1.2      matt 
    979   1.4      matt 	const uint16_t svr = (mfspr(SPR_SVR) & ~0x80000) >> 16;
    980   1.3      matt 	switch (svr) {
    981   1.3      matt #ifdef MPC8536
    982   1.3      matt 	case SVR_MPC8536v1 >> 16:
    983   1.3      matt 		*ii = mpc8536_intr_info;
    984   1.3      matt 		break;
    985   1.3      matt #endif
    986   1.3      matt #ifdef MPC8544
    987   1.3      matt 	case SVR_MPC8544v1 >> 16:
    988   1.3      matt 		*ii = mpc8544_intr_info;
    989   1.3      matt 		break;
    990   1.3      matt #endif
    991   1.3      matt #ifdef MPC8548
    992   1.3      matt 	case SVR_MPC8543v1 >> 16:
    993   1.3      matt 	case SVR_MPC8548v1 >> 16:
    994   1.2      matt 		*ii = mpc8548_intr_info;
    995   1.2      matt 		break;
    996   1.3      matt #endif
    997   1.3      matt #ifdef MPC8555
    998   1.3      matt 	case SVR_MPC8541v1 >> 16:
    999   1.3      matt 	case SVR_MPC8555v1 >> 16:
   1000   1.3      matt 		*ii = mpc8555_intr_info;
   1001   1.3      matt 		break;
   1002   1.3      matt #endif
   1003   1.3      matt #ifdef MPC8568
   1004   1.3      matt 	case SVR_MPC8568v1 >> 16:
   1005   1.3      matt 		*ii = mpc8568_intr_info;
   1006   1.2      matt 		break;
   1007   1.3      matt #endif
   1008   1.3      matt #ifdef MPC8572
   1009   1.3      matt 	case SVR_MPC8572v1 >> 16:
   1010   1.2      matt 		*ii = mpc8572_intr_info;
   1011   1.2      matt 		break;
   1012   1.3      matt #endif
   1013   1.3      matt #ifdef P2020
   1014   1.3      matt 	case SVR_P2010v2 >> 16:
   1015   1.3      matt 	case SVR_P2020v2 >> 16:
   1016   1.3      matt 		*ii = p20x0_intr_info;
   1017   1.3      matt 		break;
   1018   1.3      matt #endif
   1019   1.2      matt 	default:
   1020   1.3      matt 		panic("%s: don't know how to deal with SVR %#lx",
   1021   1.3      matt 		    __func__, mfspr(SPR_SVR));
   1022   1.2      matt 	}
   1023   1.2      matt 
   1024   1.2      matt 	/*
   1025   1.2      matt 	 * We need to be in mixed mode.
   1026   1.2      matt 	 */
   1027   1.2      matt 	openpic_write(cpu, OPENPIC_GCR, GCR_M);
   1028   1.2      matt 
   1029   1.2      matt 	/*
   1030   1.2      matt 	 * Make we and the openpic both agree about the current SPL level.
   1031   1.2      matt 	 */
   1032   1.2      matt 	e500_splset(ci, ci->ci_cpl);
   1033   1.2      matt 
   1034   1.2      matt 	/*
   1035   1.2      matt 	 * Allow the required number of interrupt sources.
   1036   1.2      matt 	 */
   1037   1.2      matt 	is = kmem_zalloc(nirq * sizeof(*is), KM_SLEEP);
   1038   1.2      matt 	KASSERT(is);
   1039   1.2      matt 	e500_intr_sources = is;
   1040   1.2      matt 	e500_intr_last_source = is + nirq;
   1041   1.2      matt 
   1042   1.2      matt 	/*
   1043   1.2      matt 	 * Initialize all the external interrupts as active low.
   1044   1.2      matt 	 */
   1045   1.2      matt 	for (u_int irq = 0; irq < e500_intr_info.ii_external_sources; irq++) {
   1046   1.2      matt 		openpic_write(cpu, OPENPIC_EIVPR(irq),
   1047   1.2      matt 		    VPR_VECTOR_MAKE(irq) | VPR_LEVEL_LOW);
   1048   1.2      matt 	}
   1049   1.2      matt }
   1050   1.2      matt 
   1051   1.2      matt static void
   1052   1.9      matt e500_idlespin(void)
   1053   1.9      matt {
   1054   1.9      matt 	KASSERTMSG(curcpu()->ci_cpl == IPL_NONE,
   1055   1.9      matt 	    ("%s: cpu%u: ci_cpl (%d) != 0", __func__, cpu_number(),
   1056   1.9      matt 	     curcpu()->ci_cpl));
   1057   1.9      matt 	KASSERTMSG(CTPR2IPL(openpic_read(curcpu()->ci_softc, OPENPIC_CTPR)) == IPL_NONE,
   1058   1.9      matt 	    ("%s: cpu%u: CTPR (%d) != IPL_NONE", __func__, cpu_number(),
   1059   1.9      matt 	     CTPR2IPL(openpic_read(curcpu()->ci_softc, OPENPIC_CTPR))));
   1060   1.9      matt 	KASSERT(mfmsr() & PSL_EE);
   1061  1.13      matt 
   1062  1.13      matt 	if (powersave > 0)
   1063  1.13      matt 		mtmsr(mfmsr() | PSL_POW);
   1064   1.9      matt }
   1065   1.9      matt 
   1066   1.9      matt static void
   1067   1.8      matt e500_intr_cpu_attach(struct cpu_info *ci)
   1068   1.2      matt {
   1069   1.2      matt 	struct cpu_softc * const cpu = ci->ci_softc;
   1070   1.2      matt 	const char * const xname = device_xname(ci->ci_dev);
   1071   1.2      matt 
   1072   1.2      matt 	const u_int32_t frr = openpic_read(cpu, OPENPIC_FRR);
   1073   1.2      matt 	const u_int nirq = FRR_NIRQ_GET(frr) + 1;
   1074   1.2      matt //	const u_int ncpu = FRR_NCPU_GET(frr) + 1;
   1075   1.2      matt 
   1076   1.2      matt 	const struct e500_intr_info * const info = &e500_intr_info;
   1077   1.2      matt 
   1078   1.2      matt 	cpu->cpu_clock_gtbcr = OPENPIC_GTBCR(ci->ci_cpuid, E500_CLOCK_TIMER);
   1079   1.2      matt 
   1080   1.2      matt 	cpu->cpu_evcnt_intrs =
   1081   1.2      matt 	    kmem_zalloc(nirq * sizeof(cpu->cpu_evcnt_intrs[0]), KM_SLEEP);
   1082   1.2      matt 	KASSERT(cpu->cpu_evcnt_intrs);
   1083   1.2      matt 
   1084   1.2      matt 	struct evcnt *evcnt = cpu->cpu_evcnt_intrs;
   1085   1.2      matt 	for (size_t j = 0; j < info->ii_external_sources; j++, evcnt++) {
   1086   1.2      matt 		const char *name = e500_intr_external_name_lookup(j);
   1087   1.2      matt 		evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR, NULL, xname, name);
   1088   1.2      matt 	}
   1089   1.2      matt 	KASSERT(evcnt == cpu->cpu_evcnt_intrs + info->ii_ist_vectors[IST_ONCHIP]);
   1090   1.2      matt 	for (size_t j = 0; j < info->ii_onchip_sources; j++, evcnt++) {
   1091   1.5      matt 		if (info->ii_onchip_bitmap[j / 32] & __BIT(j & 31)) {
   1092   1.5      matt 			const char *name = e500_intr_onchip_name_lookup(j);
   1093   1.5      matt 			if (name != NULL) {
   1094   1.5      matt 				evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR,
   1095   1.5      matt 				    NULL, xname, name);
   1096   1.5      matt #ifdef DIAGNOSTIC
   1097   1.5      matt 			} else {
   1098   1.5      matt 				printf("%s: missing evcnt for onchip irq %zu\n",
   1099   1.5      matt 				    __func__, j);
   1100   1.5      matt #endif
   1101   1.5      matt 			}
   1102   1.2      matt 		}
   1103   1.2      matt 	}
   1104   1.2      matt 
   1105   1.2      matt 	KASSERT(evcnt == cpu->cpu_evcnt_intrs + info->ii_ist_vectors[IST_MSIGROUP]);
   1106   1.2      matt 	for (size_t j = 0; j < info->ii_msigroup_sources; j++, evcnt++) {
   1107   1.2      matt 		evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR,
   1108   1.2      matt 		    NULL, xname, e500_msigroup_intr_names[j].in_name);
   1109   1.2      matt 	}
   1110   1.2      matt 
   1111   1.2      matt 	KASSERT(evcnt == cpu->cpu_evcnt_intrs + info->ii_ist_vectors[IST_TIMER]);
   1112   1.2      matt 	evcnt += ci->ci_cpuid * info->ii_percpu_sources;
   1113   1.2      matt 	for (size_t j = 0; j < info->ii_timer_sources; j++, evcnt++) {
   1114   1.2      matt 		evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR,
   1115   1.2      matt 		    NULL, xname, e500_timer_intr_names[j].in_name);
   1116   1.2      matt 	}
   1117   1.2      matt 
   1118   1.2      matt 	for (size_t j = 0; j < info->ii_ipi_sources; j++, evcnt++) {
   1119   1.2      matt 		evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR,
   1120   1.2      matt 		    NULL, xname, e500_ipi_intr_names[j].in_name);
   1121   1.2      matt 	}
   1122   1.2      matt 
   1123   1.2      matt 	for (size_t j = 0; j < info->ii_mi_sources; j++, evcnt++) {
   1124   1.2      matt 		evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR,
   1125   1.2      matt 		    NULL, xname, e500_mi_intr_names[j].in_name);
   1126   1.2      matt 	}
   1127   1.9      matt 
   1128   1.9      matt 	ci->ci_idlespin = e500_idlespin;
   1129   1.8      matt }
   1130   1.8      matt 
   1131   1.8      matt static void
   1132   1.8      matt e500_intr_cpu_send_ipi(cpuid_t target, uint32_t ipimsg)
   1133   1.8      matt {
   1134   1.8      matt 	struct cpu_info * const ci = curcpu();
   1135   1.8      matt 	struct cpu_softc * const cpu = ci->ci_softc;
   1136   1.8      matt 	uint32_t dstmask;
   1137   1.8      matt 
   1138  1.14      matt 	if (target >= CPU_MAXNUM) {
   1139   1.8      matt 		CPU_INFO_ITERATOR cii;
   1140   1.8      matt 		struct cpu_info *dst_ci;
   1141   1.8      matt 
   1142   1.8      matt 		KASSERT(target == IPI_DST_NOTME || target == IPI_DST_ALL);
   1143   1.8      matt 
   1144   1.8      matt 		dstmask = 0;
   1145   1.8      matt 		for (CPU_INFO_FOREACH(cii, dst_ci)) {
   1146   1.8      matt 			if (target == IPI_DST_ALL || ci != dst_ci) {
   1147   1.8      matt 				dstmask |= 1 << cpu_index(ci);
   1148   1.8      matt 				if (ipimsg)
   1149   1.8      matt 					atomic_or_32(&dst_ci->ci_pending_ipis,
   1150   1.8      matt 					    ipimsg);
   1151   1.8      matt 			}
   1152   1.8      matt 		}
   1153   1.8      matt 	} else {
   1154   1.8      matt 		struct cpu_info * const dst_ci = cpu_lookup(target);
   1155  1.14      matt 		KASSERT(dst_ci != NULL);
   1156  1.14      matt 		KASSERTMSG(target == cpu_index(dst_ci),
   1157  1.14      matt 		    ("%s: target (%lu) != cpu_index(cpu%u)",
   1158  1.14      matt 		     __func__, target, cpu_index(dst_ci)));
   1159   1.8      matt 		dstmask = (1 << target);
   1160   1.8      matt 		if (ipimsg)
   1161   1.8      matt 			atomic_or_32(&dst_ci->ci_pending_ipis, ipimsg);
   1162   1.8      matt 	}
   1163   1.8      matt 
   1164   1.8      matt 	openpic_write(cpu, OPENPIC_IPIDR(0), dstmask);
   1165   1.8      matt }
   1166   1.8      matt 
   1167   1.8      matt typedef void (*ipifunc_t)(void);
   1168   1.8      matt 
   1169   1.8      matt #ifdef __HAVE_PREEEMPTION
   1170   1.8      matt static void
   1171   1.8      matt e500_ipi_kpreempt(void)
   1172   1.8      matt {
   1173  1.10      matt 	poowerpc_softint_trigger(1 << IPL_NONE);
   1174   1.8      matt }
   1175   1.8      matt #endif
   1176   1.8      matt 
   1177   1.8      matt static const ipifunc_t e500_ipifuncs[] = {
   1178   1.8      matt 	[ilog2(IPI_XCALL)] =	xc_ipi_handler,
   1179   1.8      matt 	[ilog2(IPI_HALT)] =	e500_ipi_halt,
   1180   1.8      matt #ifdef __HAVE_PREEMPTION
   1181   1.8      matt 	[ilog2(IPI_KPREEMPT)] =	e500_ipi_kpreempt,
   1182   1.8      matt #endif
   1183   1.8      matt 	[ilog2(IPI_TLB1SYNC)] =	e500_tlb1_sync,
   1184   1.8      matt };
   1185   1.8      matt 
   1186   1.8      matt static int
   1187   1.8      matt e500_ipi_intr(void *v)
   1188   1.8      matt {
   1189   1.8      matt 	struct cpu_info * const ci = curcpu();
   1190   1.8      matt 
   1191   1.8      matt 	ci->ci_ev_ipi.ev_count++;
   1192   1.8      matt 
   1193   1.8      matt 	uint32_t pending_ipis = atomic_swap_32(&ci->ci_pending_ipis, 0);
   1194   1.8      matt 	for (u_int ipi = 31; pending_ipis != 0; ipi--, pending_ipis <<= 1) {
   1195   1.8      matt 		const u_int bits = __builtin_clz(pending_ipis);
   1196   1.8      matt 		ipi -= bits;
   1197   1.8      matt 		pending_ipis <<= bits;
   1198   1.8      matt 		KASSERT(e500_ipifuncs[ipi] != NULL);
   1199   1.8      matt 		(*e500_ipifuncs[ipi])();
   1200   1.8      matt 	}
   1201   1.8      matt 
   1202   1.8      matt 	return 1;
   1203   1.8      matt }
   1204   1.2      matt 
   1205   1.8      matt static void
   1206   1.8      matt e500_intr_cpu_hatch(struct cpu_info *ci)
   1207   1.8      matt {
   1208   1.2      matt 	/*
   1209   1.8      matt 	 * Establish clock interrupt for this CPU.
   1210   1.2      matt 	 */
   1211   1.2      matt 	if (e500_intr_cpu_establish(ci, E500_CLOCK_TIMER, IPL_CLOCK, IST_TIMER,
   1212   1.2      matt 	    e500_clock_intr, NULL) == NULL)
   1213   1.2      matt 		panic("%s: failed to establish clock interrupt!", __func__);
   1214   1.2      matt 
   1215   1.2      matt 	/*
   1216   1.8      matt 	 * Establish the IPI interrupts for this CPU.
   1217   1.8      matt 	 */
   1218   1.8      matt 	if (e500_intr_cpu_establish(ci, 0, IPL_VM, IST_IPI, e500_ipi_intr,
   1219   1.8      matt 	    NULL) == NULL)
   1220   1.8      matt 		panic("%s: failed to establish ipi interrupt!", __func__);
   1221   1.8      matt 
   1222   1.8      matt 	/*
   1223   1.2      matt 	 * Enable watchdog interrupts.
   1224   1.2      matt 	 */
   1225   1.2      matt 	uint32_t tcr = mfspr(SPR_TCR);
   1226   1.2      matt 	tcr |= TCR_WIE;
   1227   1.2      matt 	mtspr(SPR_TCR, tcr);
   1228   1.2      matt }
   1229