Home | History | Annotate | Line # | Download | only in pci
virtio_pci.c revision 1.34
      1  1.34       uwe /* $NetBSD: virtio_pci.c,v 1.34 2022/03/14 12:22:02 uwe Exp $ */
      2   1.1    cherry 
      3   1.1    cherry /*
      4  1.15   reinoud  * Copyright (c) 2020 The NetBSD Foundation, Inc.
      5  1.15   reinoud  * Copyright (c) 2012 Stefan Fritsch.
      6   1.1    cherry  * Copyright (c) 2010 Minoura Makoto.
      7   1.1    cherry  * All rights reserved.
      8   1.1    cherry  *
      9   1.1    cherry  * Redistribution and use in source and binary forms, with or without
     10   1.1    cherry  * modification, are permitted provided that the following conditions
     11   1.1    cherry  * are met:
     12   1.1    cherry  * 1. Redistributions of source code must retain the above copyright
     13   1.1    cherry  *    notice, this list of conditions and the following disclaimer.
     14   1.1    cherry  * 2. Redistributions in binary form must reproduce the above copyright
     15   1.1    cherry  *    notice, this list of conditions and the following disclaimer in the
     16   1.1    cherry  *    documentation and/or other materials provided with the distribution.
     17   1.1    cherry  *
     18   1.1    cherry  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19   1.1    cherry  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     20   1.1    cherry  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     21   1.1    cherry  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     22   1.1    cherry  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     23   1.1    cherry  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     24   1.1    cherry  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     25   1.1    cherry  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     26   1.1    cherry  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     27   1.1    cherry  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     28   1.1    cherry  */
     29   1.1    cherry 
     30   1.1    cherry #include <sys/cdefs.h>
     31  1.34       uwe __KERNEL_RCSID(0, "$NetBSD: virtio_pci.c,v 1.34 2022/03/14 12:22:02 uwe Exp $");
     32   1.1    cherry 
     33   1.1    cherry #include <sys/param.h>
     34   1.1    cherry #include <sys/systm.h>
     35   1.4  jakllsch #include <sys/kmem.h>
     36   1.5  jakllsch #include <sys/module.h>
     37  1.19  christos #include <sys/endian.h>
     38   1.6  yamaguch #include <sys/interrupt.h>
     39  1.33  yamaguch #include <sys/syslog.h>
     40   1.1    cherry 
     41   1.1    cherry #include <sys/device.h>
     42   1.1    cherry 
     43   1.1    cherry #include <dev/pci/pcidevs.h>
     44   1.1    cherry #include <dev/pci/pcireg.h>
     45   1.1    cherry #include <dev/pci/pcivar.h>
     46   1.1    cherry 
     47  1.15   reinoud #include <dev/pci/virtioreg.h> /* XXX: move to non-pci */
     48  1.15   reinoud #include <dev/pci/virtio_pcireg.h>
     49  1.15   reinoud 
     50   1.1    cherry #define VIRTIO_PRIVATE
     51  1.15   reinoud #include <dev/pci/virtiovar.h> /* XXX: move to non-pci */
     52   1.1    cherry 
     53   1.1    cherry 
     54  1.33  yamaguch #define VIRTIO_PCI_LOG(_sc, _use_log, _fmt, _args...)	\
     55  1.33  yamaguch do {							\
     56  1.33  yamaguch 	if ((_use_log)) {				\
     57  1.33  yamaguch 		log(LOG_DEBUG, "%s: " _fmt,		\
     58  1.33  yamaguch 		    device_xname((_sc)->sc_dev),	\
     59  1.33  yamaguch 		    ##_args);				\
     60  1.33  yamaguch 	} else {					\
     61  1.33  yamaguch 		aprint_error_dev((_sc)->sc_dev,		\
     62  1.33  yamaguch 		    _fmt, ##_args);			\
     63  1.33  yamaguch 	}						\
     64  1.33  yamaguch } while(0)
     65  1.33  yamaguch 
     66   1.4  jakllsch static int	virtio_pci_match(device_t, cfdata_t, void *);
     67   1.4  jakllsch static void	virtio_pci_attach(device_t, device_t, void *);
     68   1.4  jakllsch static int	virtio_pci_rescan(device_t, const char *, const int *);
     69   1.4  jakllsch static int	virtio_pci_detach(device_t, int);
     70   1.4  jakllsch 
     71  1.22   reinoud 
     72  1.22   reinoud #define NMAPREG		((PCI_MAPREG_END - PCI_MAPREG_START) / \
     73  1.22   reinoud 				sizeof(pcireg_t))
     74   1.4  jakllsch struct virtio_pci_softc {
     75   1.4  jakllsch 	struct virtio_softc	sc_sc;
     76  1.15   reinoud 
     77  1.15   reinoud 	/* IO space */
     78   1.4  jakllsch 	bus_space_tag_t		sc_iot;
     79   1.4  jakllsch 	bus_space_handle_t	sc_ioh;
     80   1.4  jakllsch 	bus_size_t		sc_iosize;
     81  1.15   reinoud 	bus_size_t		sc_mapped_iosize;
     82  1.15   reinoud 
     83  1.15   reinoud 	/* BARs */
     84  1.21   reinoud 	bus_space_tag_t		sc_bars_iot[NMAPREG];
     85  1.21   reinoud 	bus_space_handle_t	sc_bars_ioh[NMAPREG];
     86  1.21   reinoud 	bus_size_t		sc_bars_iosize[NMAPREG];
     87  1.15   reinoud 
     88  1.15   reinoud 	/* notify space */
     89  1.15   reinoud 	bus_space_tag_t		sc_notify_iot;
     90  1.15   reinoud 	bus_space_handle_t	sc_notify_ioh;
     91  1.15   reinoud 	bus_size_t		sc_notify_iosize;
     92  1.15   reinoud 	uint32_t		sc_notify_off_multiplier;
     93  1.15   reinoud 
     94  1.15   reinoud 	/* isr space */
     95  1.15   reinoud 	bus_space_tag_t		sc_isr_iot;
     96  1.15   reinoud 	bus_space_handle_t	sc_isr_ioh;
     97  1.15   reinoud 	bus_size_t		sc_isr_iosize;
     98  1.15   reinoud 
     99  1.15   reinoud 	/* generic */
    100   1.4  jakllsch 	struct pci_attach_args	sc_pa;
    101   1.4  jakllsch 	pci_intr_handle_t	*sc_ihp;
    102   1.4  jakllsch 	void			**sc_ihs;
    103   1.4  jakllsch 	int			sc_ihs_num;
    104  1.15   reinoud 	int			sc_devcfg_offset;	/* for 0.9 */
    105   1.4  jakllsch };
    106   1.4  jakllsch 
    107  1.15   reinoud static int	virtio_pci_attach_09(device_t, void *);
    108  1.15   reinoud static void	virtio_pci_kick_09(struct virtio_softc *, uint16_t);
    109  1.15   reinoud static uint16_t	virtio_pci_read_queue_size_09(struct virtio_softc *, uint16_t);
    110  1.15   reinoud static void	virtio_pci_setup_queue_09(struct virtio_softc *, uint16_t, uint64_t);
    111  1.15   reinoud static void	virtio_pci_set_status_09(struct virtio_softc *, int);
    112  1.15   reinoud static void	virtio_pci_negotiate_features_09(struct virtio_softc *, uint64_t);
    113  1.15   reinoud 
    114  1.15   reinoud static int	virtio_pci_attach_10(device_t, void *);
    115  1.15   reinoud static void	virtio_pci_kick_10(struct virtio_softc *, uint16_t);
    116  1.15   reinoud static uint16_t	virtio_pci_read_queue_size_10(struct virtio_softc *, uint16_t);
    117  1.15   reinoud static void	virtio_pci_setup_queue_10(struct virtio_softc *, uint16_t, uint64_t);
    118  1.15   reinoud static void	virtio_pci_set_status_10(struct virtio_softc *, int);
    119  1.15   reinoud static void	virtio_pci_negotiate_features_10(struct virtio_softc *, uint64_t);
    120  1.15   reinoud static int	virtio_pci_find_cap(struct virtio_pci_softc *psc, int cfg_type, void *buf, int buflen);
    121  1.15   reinoud 
    122  1.31  yamaguch static int	virtio_pci_alloc_interrupts(struct virtio_softc *);
    123   1.4  jakllsch static void	virtio_pci_free_interrupts(struct virtio_softc *);
    124  1.15   reinoud static int	virtio_pci_adjust_config_region(struct virtio_pci_softc *psc);
    125   1.4  jakllsch static int	virtio_pci_intr(void *arg);
    126   1.4  jakllsch static int	virtio_pci_msix_queue_intr(void *);
    127   1.4  jakllsch static int	virtio_pci_msix_config_intr(void *);
    128  1.32  yamaguch static int	virtio_pci_setup_interrupts_09(struct virtio_softc *, int);
    129  1.32  yamaguch static int	virtio_pci_setup_interrupts_10(struct virtio_softc *, int);
    130  1.31  yamaguch static int	virtio_pci_establish_msix_interrupts(struct virtio_softc *,
    131   1.4  jakllsch 		    struct pci_attach_args *);
    132  1.31  yamaguch static int	virtio_pci_establish_intx_interrupt(struct virtio_softc *,
    133   1.4  jakllsch 		    struct pci_attach_args *);
    134  1.31  yamaguch static bool	virtio_pci_msix_enabled(struct virtio_pci_softc *);
    135   1.4  jakllsch 
    136   1.4  jakllsch #define VIRTIO_MSIX_CONFIG_VECTOR_INDEX	0
    137   1.4  jakllsch #define VIRTIO_MSIX_QUEUE_VECTOR_INDEX	1
    138   1.4  jakllsch 
    139  1.27   reinoud /*
    140  1.27   reinoud  * When using PCI attached virtio on aarch64-eb under Qemu, the IO space
    141  1.27   reinoud  * suddenly read BIG_ENDIAN where it should stay LITTLE_ENDIAN. The data read
    142  1.27   reinoud  * 1 byte at a time seem OK but reading bigger lengths result in swapped
    143  1.27   reinoud  * endian. This is most notable on reading 8 byters since we can't use
    144  1.28   reinoud  * bus_space_{read,write}_8().
    145  1.27   reinoud  */
    146   1.4  jakllsch 
    147  1.27   reinoud #if defined(__aarch64__) && BYTE_ORDER == BIG_ENDIAN
    148  1.28   reinoud #	define READ_ENDIAN_09	BIG_ENDIAN	/* should be LITTLE_ENDIAN */
    149  1.27   reinoud #	define READ_ENDIAN_10	BIG_ENDIAN
    150  1.27   reinoud #	define STRUCT_ENDIAN_09	BIG_ENDIAN
    151  1.27   reinoud #	define STRUCT_ENDIAN_10	LITTLE_ENDIAN
    152  1.27   reinoud #elif BYTE_ORDER == BIG_ENDIAN
    153  1.27   reinoud #	define READ_ENDIAN_09	LITTLE_ENDIAN
    154  1.27   reinoud #	define READ_ENDIAN_10	BIG_ENDIAN
    155  1.27   reinoud #	define STRUCT_ENDIAN_09	BIG_ENDIAN
    156  1.27   reinoud #	define STRUCT_ENDIAN_10	LITTLE_ENDIAN
    157  1.27   reinoud #else /* little endian */
    158  1.27   reinoud #	define READ_ENDIAN_09	LITTLE_ENDIAN
    159  1.27   reinoud #	define READ_ENDIAN_10	LITTLE_ENDIAN
    160  1.27   reinoud #	define STRUCT_ENDIAN_09	LITTLE_ENDIAN
    161  1.27   reinoud #	define STRUCT_ENDIAN_10	LITTLE_ENDIAN
    162  1.15   reinoud #endif
    163  1.15   reinoud 
    164   1.1    cherry 
    165   1.4  jakllsch CFATTACH_DECL3_NEW(virtio_pci, sizeof(struct virtio_pci_softc),
    166   1.4  jakllsch     virtio_pci_match, virtio_pci_attach, virtio_pci_detach, NULL,
    167   1.4  jakllsch     virtio_pci_rescan, NULL, DVF_DETACH_SHUTDOWN);
    168   1.4  jakllsch 
    169  1.15   reinoud static const struct virtio_ops virtio_pci_ops_09 = {
    170  1.15   reinoud 	.kick = virtio_pci_kick_09,
    171  1.15   reinoud 	.read_queue_size = virtio_pci_read_queue_size_09,
    172  1.15   reinoud 	.setup_queue = virtio_pci_setup_queue_09,
    173  1.15   reinoud 	.set_status = virtio_pci_set_status_09,
    174  1.15   reinoud 	.neg_features = virtio_pci_negotiate_features_09,
    175  1.31  yamaguch 	.alloc_interrupts = virtio_pci_alloc_interrupts,
    176  1.15   reinoud 	.free_interrupts = virtio_pci_free_interrupts,
    177  1.31  yamaguch 	.setup_interrupts = virtio_pci_setup_interrupts_09,
    178  1.15   reinoud };
    179  1.15   reinoud 
    180  1.15   reinoud static const struct virtio_ops virtio_pci_ops_10 = {
    181  1.15   reinoud 	.kick = virtio_pci_kick_10,
    182  1.15   reinoud 	.read_queue_size = virtio_pci_read_queue_size_10,
    183  1.15   reinoud 	.setup_queue = virtio_pci_setup_queue_10,
    184  1.15   reinoud 	.set_status = virtio_pci_set_status_10,
    185  1.15   reinoud 	.neg_features = virtio_pci_negotiate_features_10,
    186  1.31  yamaguch 	.alloc_interrupts = virtio_pci_alloc_interrupts,
    187   1.4  jakllsch 	.free_interrupts = virtio_pci_free_interrupts,
    188  1.31  yamaguch 	.setup_interrupts = virtio_pci_setup_interrupts_10,
    189   1.4  jakllsch };
    190   1.1    cherry 
    191   1.1    cherry static int
    192   1.4  jakllsch virtio_pci_match(device_t parent, cfdata_t match, void *aux)
    193   1.1    cherry {
    194   1.1    cherry 	struct pci_attach_args *pa;
    195   1.1    cherry 
    196   1.1    cherry 	pa = (struct pci_attach_args *)aux;
    197   1.1    cherry 	switch (PCI_VENDOR(pa->pa_id)) {
    198   1.1    cherry 	case PCI_VENDOR_QUMRANET:
    199  1.34       uwe 		/* Transitional devices MUST have a PCI Revision ID of 0. */
    200  1.15   reinoud 		if (((PCI_PRODUCT_QUMRANET_VIRTIO_1000 <=
    201  1.15   reinoud 		      PCI_PRODUCT(pa->pa_id)) &&
    202  1.15   reinoud 		     (PCI_PRODUCT(pa->pa_id) <=
    203  1.15   reinoud 		      PCI_PRODUCT_QUMRANET_VIRTIO_103F)) &&
    204  1.15   reinoud 	              PCI_REVISION(pa->pa_class) == 0)
    205  1.15   reinoud 			return 1;
    206  1.34       uwe 		/*
    207  1.34       uwe 		 * Non-transitional devices SHOULD have a PCI Revision
    208  1.34       uwe 		 * ID of 1 or higher.  Drivers MUST match any PCI
    209  1.34       uwe 		 * Revision ID value.
    210  1.34       uwe 		 */
    211  1.15   reinoud 		if (((PCI_PRODUCT_QUMRANET_VIRTIO_1040 <=
    212  1.15   reinoud 		      PCI_PRODUCT(pa->pa_id)) &&
    213  1.15   reinoud 		     (PCI_PRODUCT(pa->pa_id) <=
    214  1.15   reinoud 		      PCI_PRODUCT_QUMRANET_VIRTIO_107F)) &&
    215  1.34       uwe 		      /* XXX: TODO */
    216  1.15   reinoud 		      PCI_REVISION(pa->pa_class) == 1)
    217   1.1    cherry 			return 1;
    218   1.1    cherry 		break;
    219   1.1    cherry 	}
    220   1.1    cherry 
    221   1.1    cherry 	return 0;
    222   1.1    cherry }
    223   1.1    cherry 
    224   1.1    cherry static void
    225   1.4  jakllsch virtio_pci_attach(device_t parent, device_t self, void *aux)
    226   1.1    cherry {
    227   1.4  jakllsch 	struct virtio_pci_softc * const psc = device_private(self);
    228   1.4  jakllsch 	struct virtio_softc * const sc = &psc->sc_sc;
    229   1.1    cherry 	struct pci_attach_args *pa = (struct pci_attach_args *)aux;
    230   1.1    cherry 	pci_chipset_tag_t pc = pa->pa_pc;
    231   1.1    cherry 	pcitag_t tag = pa->pa_tag;
    232   1.1    cherry 	int revision;
    233  1.15   reinoud 	int ret;
    234   1.1    cherry 	pcireg_t id;
    235   1.2       uwe 	pcireg_t csr;
    236   1.1    cherry 
    237   1.1    cherry 	revision = PCI_REVISION(pa->pa_class);
    238  1.15   reinoud 	switch (revision) {
    239  1.15   reinoud 	case 0:
    240  1.15   reinoud 		/* subsystem ID shows what I am */
    241  1.15   reinoud 		id = PCI_SUBSYS_ID(pci_conf_read(pc, tag, PCI_SUBSYS_ID_REG));
    242  1.15   reinoud 		break;
    243  1.15   reinoud 	case 1:
    244  1.15   reinoud 		/* pci product number shows what I am */
    245  1.15   reinoud 		id = PCI_PRODUCT(pa->pa_id) - PCI_PRODUCT_QUMRANET_VIRTIO_1040;
    246  1.15   reinoud 		break;
    247  1.15   reinoud 	default:
    248   1.1    cherry 		aprint_normal(": unknown revision 0x%02x; giving up\n",
    249   1.1    cherry 			      revision);
    250   1.1    cherry 		return;
    251   1.1    cherry 	}
    252  1.15   reinoud 
    253   1.1    cherry 	aprint_normal("\n");
    254   1.1    cherry 	aprint_naive("\n");
    255  1.15   reinoud 	virtio_print_device_type(self, id, revision);
    256   1.1    cherry 
    257   1.2       uwe 	csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
    258   1.2       uwe 	csr |= PCI_COMMAND_MASTER_ENABLE | PCI_COMMAND_IO_ENABLE;
    259   1.2       uwe 	pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, csr);
    260   1.2       uwe 
    261   1.1    cherry 	sc->sc_dev = self;
    262   1.4  jakllsch 	psc->sc_pa = *pa;
    263   1.4  jakllsch 	psc->sc_iot = pa->pa_iot;
    264  1.15   reinoud 
    265  1.15   reinoud 	sc->sc_dmat = pa->pa_dmat;
    266   1.1    cherry 	if (pci_dma64_available(pa))
    267   1.1    cherry 		sc->sc_dmat = pa->pa_dmat64;
    268   1.1    cherry 
    269  1.15   reinoud 	/* attach is dependent on revision */
    270  1.15   reinoud 	ret = 0;
    271  1.15   reinoud 	if (revision == 1) {
    272  1.15   reinoud 		/* try to attach 1.0 */
    273  1.15   reinoud 		ret = virtio_pci_attach_10(self, aux);
    274  1.15   reinoud 	}
    275  1.15   reinoud 	if (ret == 0 && revision == 0) {
    276  1.15   reinoud 		/* revision 0 means 0.9 only or both 0.9 and 1.0 */
    277  1.15   reinoud 		ret = virtio_pci_attach_09(self, aux);
    278  1.15   reinoud 	}
    279  1.15   reinoud 	if (ret) {
    280  1.15   reinoud 		aprint_error_dev(self, "cannot attach (%d)\n", ret);
    281   1.1    cherry 		return;
    282   1.1    cherry 	}
    283  1.15   reinoud 	KASSERT(sc->sc_ops);
    284  1.15   reinoud 
    285  1.15   reinoud 	/* preset config region */
    286  1.15   reinoud 	psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_NOMSI;
    287  1.15   reinoud 	if (virtio_pci_adjust_config_region(psc))
    288  1.15   reinoud 		return;
    289   1.1    cherry 
    290  1.15   reinoud 	/* generic */
    291   1.1    cherry 	virtio_device_reset(sc);
    292   1.1    cherry 	virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_ACK);
    293   1.1    cherry 	virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_DRIVER);
    294   1.1    cherry 
    295  1.15   reinoud 	sc->sc_childdevid = id;
    296   1.1    cherry 	sc->sc_child = NULL;
    297  1.29   thorpej 	virtio_pci_rescan(self, NULL, NULL);
    298   1.1    cherry 	return;
    299   1.1    cherry }
    300   1.1    cherry 
    301   1.1    cherry /* ARGSUSED */
    302   1.1    cherry static int
    303  1.29   thorpej virtio_pci_rescan(device_t self, const char *ifattr, const int *locs)
    304   1.1    cherry {
    305   1.4  jakllsch 	struct virtio_pci_softc * const psc = device_private(self);
    306   1.4  jakllsch 	struct virtio_softc * const sc = &psc->sc_sc;
    307   1.1    cherry 	struct virtio_attach_args va;
    308   1.1    cherry 
    309   1.1    cherry 	if (sc->sc_child)	/* Child already attached? */
    310   1.1    cherry 		return 0;
    311   1.1    cherry 
    312   1.1    cherry 	memset(&va, 0, sizeof(va));
    313   1.1    cherry 	va.sc_childdevid = sc->sc_childdevid;
    314   1.1    cherry 
    315  1.30   thorpej 	config_found(self, &va, NULL, CFARGS_NONE);
    316   1.1    cherry 
    317  1.15   reinoud 	if (virtio_attach_failed(sc))
    318   1.1    cherry 		return 0;
    319   1.1    cherry 
    320   1.1    cherry 	return 0;
    321   1.1    cherry }
    322   1.1    cherry 
    323   1.1    cherry 
    324   1.1    cherry static int
    325   1.4  jakllsch virtio_pci_detach(device_t self, int flags)
    326   1.1    cherry {
    327   1.4  jakllsch 	struct virtio_pci_softc * const psc = device_private(self);
    328   1.4  jakllsch 	struct virtio_softc * const sc = &psc->sc_sc;
    329   1.1    cherry 	int r;
    330   1.1    cherry 
    331   1.1    cherry 	if (sc->sc_child != NULL) {
    332   1.1    cherry 		r = config_detach(sc->sc_child, flags);
    333   1.1    cherry 		if (r)
    334   1.1    cherry 			return r;
    335   1.1    cherry 	}
    336   1.1    cherry 
    337   1.1    cherry 	/* Check that child detached properly */
    338   1.1    cherry 	KASSERT(sc->sc_child == NULL);
    339   1.1    cherry 	KASSERT(sc->sc_vqs == NULL);
    340   1.4  jakllsch 	KASSERT(psc->sc_ihs_num == 0);
    341   1.1    cherry 
    342   1.4  jakllsch 	if (psc->sc_iosize)
    343  1.15   reinoud 		bus_space_unmap(psc->sc_iot, psc->sc_ioh,
    344  1.15   reinoud 			psc->sc_mapped_iosize);
    345   1.4  jakllsch 	psc->sc_iosize = 0;
    346   1.1    cherry 
    347   1.1    cherry 	return 0;
    348   1.1    cherry }
    349   1.4  jakllsch 
    350  1.15   reinoud 
    351  1.15   reinoud static int
    352  1.15   reinoud virtio_pci_attach_09(device_t self, void *aux)
    353  1.15   reinoud 	//struct virtio_pci_softc *psc, struct pci_attach_args *pa)
    354  1.15   reinoud {
    355  1.15   reinoud 	struct virtio_pci_softc * const psc = device_private(self);
    356  1.15   reinoud 	struct pci_attach_args *pa = (struct pci_attach_args *)aux;
    357  1.15   reinoud 	struct virtio_softc * const sc = &psc->sc_sc;
    358  1.15   reinoud //	pci_chipset_tag_t pc = pa->pa_pc;
    359  1.15   reinoud //	pcitag_t tag = pa->pa_tag;
    360  1.15   reinoud 
    361  1.15   reinoud 	/* complete IO region */
    362  1.15   reinoud 	if (pci_mapreg_map(pa, PCI_MAPREG_START, PCI_MAPREG_TYPE_IO, 0,
    363  1.15   reinoud 			   &psc->sc_iot, &psc->sc_ioh, NULL, &psc->sc_iosize)) {
    364  1.15   reinoud 		aprint_error_dev(self, "can't map i/o space\n");
    365  1.15   reinoud 		return EIO;
    366  1.15   reinoud 	}
    367  1.15   reinoud 	psc->sc_mapped_iosize = psc->sc_iosize;
    368  1.15   reinoud 
    369  1.15   reinoud 	/* queue space */
    370  1.15   reinoud 	if (bus_space_subregion(psc->sc_iot, psc->sc_ioh,
    371  1.15   reinoud 			VIRTIO_CONFIG_QUEUE_NOTIFY, 2, &psc->sc_notify_ioh)) {
    372  1.15   reinoud 		aprint_error_dev(self, "can't map notify i/o space\n");
    373  1.15   reinoud 		return EIO;
    374  1.15   reinoud 	}
    375  1.15   reinoud 	psc->sc_notify_iosize = 2;
    376  1.15   reinoud 	psc->sc_notify_iot = psc->sc_iot;
    377  1.15   reinoud 
    378  1.15   reinoud 	/* ISR space */
    379  1.15   reinoud 	if (bus_space_subregion(psc->sc_iot, psc->sc_ioh,
    380  1.15   reinoud 			VIRTIO_CONFIG_ISR_STATUS, 1, &psc->sc_isr_ioh)) {
    381  1.15   reinoud 		aprint_error_dev(self, "can't map isr i/o space\n");
    382  1.15   reinoud 		return EIO;
    383  1.15   reinoud 	}
    384  1.15   reinoud 	psc->sc_isr_iosize = 1;
    385  1.15   reinoud 	psc->sc_isr_iot = psc->sc_iot;
    386  1.15   reinoud 
    387  1.15   reinoud 	/* set our version 0.9 ops */
    388  1.15   reinoud 	sc->sc_ops = &virtio_pci_ops_09;
    389  1.27   reinoud 	sc->sc_bus_endian    = READ_ENDIAN_09;
    390  1.27   reinoud 	sc->sc_struct_endian = STRUCT_ENDIAN_09;
    391  1.15   reinoud 	return 0;
    392  1.15   reinoud }
    393  1.15   reinoud 
    394  1.15   reinoud 
    395  1.15   reinoud static int
    396  1.15   reinoud virtio_pci_attach_10(device_t self, void *aux)
    397   1.4  jakllsch {
    398  1.15   reinoud 	struct virtio_pci_softc * const psc = device_private(self);
    399  1.15   reinoud 	struct pci_attach_args *pa = (struct pci_attach_args *)aux;
    400  1.15   reinoud 	struct virtio_softc * const sc = &psc->sc_sc;
    401  1.15   reinoud 	pci_chipset_tag_t pc = pa->pa_pc;
    402  1.15   reinoud 	pcitag_t tag = pa->pa_tag;
    403  1.15   reinoud 
    404  1.15   reinoud 	struct virtio_pci_cap common, isr, device;
    405  1.15   reinoud 	struct virtio_pci_notify_cap notify;
    406  1.15   reinoud 	int have_device_cfg = 0;
    407  1.15   reinoud 	bus_size_t bars[NMAPREG] = { 0 };
    408  1.15   reinoud 	int bars_idx[NMAPREG] = { 0 };
    409  1.15   reinoud 	struct virtio_pci_cap *caps[] = { &common, &isr, &device, &notify.cap };
    410  1.26   reinoud 	int i, j, ret = 0;
    411  1.15   reinoud 
    412  1.15   reinoud 	if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_COMMON_CFG,
    413  1.15   reinoud 			&common, sizeof(common)))
    414  1.15   reinoud 		return ENODEV;
    415  1.15   reinoud 	if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_NOTIFY_CFG,
    416  1.15   reinoud 			&notify, sizeof(notify)))
    417  1.15   reinoud 		return ENODEV;
    418  1.15   reinoud 	if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_ISR_CFG,
    419  1.15   reinoud 			&isr, sizeof(isr)))
    420  1.15   reinoud 		return ENODEV;
    421  1.15   reinoud 	if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_DEVICE_CFG,
    422  1.15   reinoud 			&device, sizeof(device)))
    423  1.15   reinoud 		memset(&device, 0, sizeof(device));
    424  1.15   reinoud 	else
    425  1.15   reinoud 		have_device_cfg = 1;
    426  1.15   reinoud 
    427  1.15   reinoud 	/* Figure out which bars we need to map */
    428  1.15   reinoud 	for (i = 0; i < __arraycount(caps); i++) {
    429  1.15   reinoud 		int bar = caps[i]->bar;
    430  1.15   reinoud 		bus_size_t len = caps[i]->offset + caps[i]->length;
    431  1.15   reinoud 		if (caps[i]->length == 0)
    432  1.15   reinoud 			continue;
    433  1.15   reinoud 		if (bars[bar] < len)
    434  1.15   reinoud 			bars[bar] = len;
    435  1.15   reinoud 	}
    436  1.15   reinoud 
    437  1.26   reinoud 	for (i = j = 0; i < __arraycount(bars); i++) {
    438  1.15   reinoud 		int reg;
    439  1.15   reinoud 		pcireg_t type;
    440  1.15   reinoud 		if (bars[i] == 0)
    441  1.15   reinoud 			continue;
    442  1.15   reinoud 		reg = PCI_MAPREG_START + i * 4;
    443  1.15   reinoud 		type = pci_mapreg_type(pc, tag, reg);
    444  1.15   reinoud 		if (pci_mapreg_map(pa, reg, type, 0,
    445  1.15   reinoud 				&psc->sc_bars_iot[j], &psc->sc_bars_ioh[j],
    446  1.15   reinoud 				NULL, &psc->sc_bars_iosize[j])) {
    447  1.15   reinoud 			aprint_error_dev(self, "can't map bar %u \n", i);
    448  1.15   reinoud 			ret = EIO;
    449  1.15   reinoud 			goto err;
    450  1.15   reinoud 		}
    451  1.17    martin 		aprint_debug_dev(self,
    452  1.17    martin 		    "bar[%d]: iot %p, size 0x%" PRIxBUSSIZE "\n",
    453  1.17    martin 		    j, psc->sc_bars_iot[j], psc->sc_bars_iosize[j]);
    454  1.15   reinoud 		bars_idx[i] = j;
    455  1.15   reinoud 		j++;
    456  1.15   reinoud 	}
    457  1.15   reinoud 
    458  1.15   reinoud 	i = bars_idx[notify.cap.bar];
    459  1.15   reinoud 	if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
    460  1.15   reinoud 			notify.cap.offset, notify.cap.length,
    461  1.15   reinoud 			&psc->sc_notify_ioh)) {
    462  1.15   reinoud 		aprint_error_dev(self, "can't map notify i/o space\n");
    463  1.15   reinoud 		ret = EIO;
    464  1.15   reinoud 		goto err;
    465  1.15   reinoud 	}
    466  1.15   reinoud 	psc->sc_notify_iosize = notify.cap.length;
    467  1.15   reinoud 	psc->sc_notify_iot = psc->sc_bars_iot[i];
    468  1.15   reinoud 	psc->sc_notify_off_multiplier = le32toh(notify.notify_off_multiplier);
    469  1.15   reinoud 
    470  1.15   reinoud 	if (have_device_cfg) {
    471  1.15   reinoud 		i = bars_idx[device.bar];
    472  1.15   reinoud 		if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
    473  1.15   reinoud 				device.offset, device.length,
    474  1.15   reinoud 				&sc->sc_devcfg_ioh)) {
    475  1.15   reinoud 			aprint_error_dev(self, "can't map devcfg i/o space\n");
    476  1.15   reinoud 			ret = EIO;
    477  1.15   reinoud 			goto err;
    478  1.15   reinoud 		}
    479  1.15   reinoud 		aprint_debug_dev(self,
    480  1.15   reinoud 			"device.offset = 0x%x, device.length = 0x%x\n",
    481  1.15   reinoud 			device.offset, device.length);
    482  1.15   reinoud 		sc->sc_devcfg_iosize = device.length;
    483  1.15   reinoud 		sc->sc_devcfg_iot = psc->sc_bars_iot[i];
    484  1.15   reinoud 	}
    485  1.15   reinoud 
    486  1.15   reinoud 	i = bars_idx[isr.bar];
    487  1.15   reinoud 	if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
    488  1.15   reinoud 			isr.offset, isr.length, &psc->sc_isr_ioh)) {
    489  1.15   reinoud 		aprint_error_dev(self, "can't map isr i/o space\n");
    490  1.15   reinoud 		ret = EIO;
    491  1.15   reinoud 		goto err;
    492  1.15   reinoud 	}
    493  1.15   reinoud 	psc->sc_isr_iosize = isr.length;
    494  1.15   reinoud 	psc->sc_isr_iot = psc->sc_bars_iot[i];
    495  1.15   reinoud 
    496  1.15   reinoud 	i = bars_idx[common.bar];
    497  1.15   reinoud 	if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
    498  1.15   reinoud 			common.offset, common.length, &psc->sc_ioh)) {
    499  1.15   reinoud 		aprint_error_dev(self, "can't map common i/o space\n");
    500  1.15   reinoud 		ret = EIO;
    501  1.15   reinoud 		goto err;
    502  1.15   reinoud 	}
    503  1.15   reinoud 	psc->sc_iosize = common.length;
    504  1.15   reinoud 	psc->sc_iot = psc->sc_bars_iot[i];
    505  1.15   reinoud 	psc->sc_mapped_iosize = psc->sc_bars_iosize[i];
    506  1.15   reinoud 
    507  1.15   reinoud 	psc->sc_sc.sc_version_1 = 1;
    508  1.15   reinoud 
    509  1.15   reinoud 	/* set our version 1.0 ops */
    510  1.15   reinoud 	sc->sc_ops = &virtio_pci_ops_10;
    511  1.27   reinoud 	sc->sc_bus_endian    = READ_ENDIAN_10;
    512  1.27   reinoud 	sc->sc_struct_endian = STRUCT_ENDIAN_10;
    513  1.15   reinoud 	return 0;
    514   1.4  jakllsch 
    515  1.15   reinoud err:
    516  1.23   reinoud 	/* undo our pci_mapreg_map()s */
    517  1.23   reinoud 	for (i = 0; i < __arraycount(bars); i++) {
    518  1.26   reinoud 		if (psc->sc_bars_iosize[i] == 0)
    519  1.23   reinoud 			continue;
    520  1.26   reinoud 		bus_space_unmap(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
    521  1.26   reinoud 				psc->sc_bars_iosize[i]);
    522  1.23   reinoud 	}
    523  1.15   reinoud 	return ret;
    524   1.4  jakllsch }
    525   1.4  jakllsch 
    526  1.15   reinoud /* v1.0 attach helper */
    527  1.15   reinoud static int
    528  1.15   reinoud virtio_pci_find_cap(struct virtio_pci_softc *psc, int cfg_type, void *buf, int buflen)
    529   1.4  jakllsch {
    530  1.15   reinoud 	device_t self = psc->sc_sc.sc_dev;
    531  1.15   reinoud 	pci_chipset_tag_t pc = psc->sc_pa.pa_pc;
    532  1.15   reinoud 	pcitag_t tag = psc->sc_pa.pa_tag;
    533  1.15   reinoud 	unsigned int offset, i, len;
    534  1.15   reinoud 	union {
    535  1.15   reinoud 		pcireg_t reg[8];
    536  1.15   reinoud 		struct virtio_pci_cap vcap;
    537  1.15   reinoud 	} *v = buf;
    538  1.15   reinoud 
    539  1.15   reinoud 	if (buflen < sizeof(struct virtio_pci_cap))
    540  1.15   reinoud 		return ERANGE;
    541  1.15   reinoud 
    542  1.15   reinoud 	if (!pci_get_capability(pc, tag, PCI_CAP_VENDSPEC, &offset, &v->reg[0]))
    543  1.15   reinoud 		return ENOENT;
    544  1.15   reinoud 
    545  1.15   reinoud 	do {
    546  1.15   reinoud 		for (i = 0; i < 4; i++)
    547  1.15   reinoud 			v->reg[i] =
    548  1.15   reinoud 				le32toh(pci_conf_read(pc, tag, offset + i * 4));
    549  1.15   reinoud 		if (v->vcap.cfg_type == cfg_type)
    550  1.15   reinoud 			break;
    551  1.15   reinoud 		offset = v->vcap.cap_next;
    552  1.15   reinoud 	} while (offset != 0);
    553  1.15   reinoud 
    554  1.15   reinoud 	if (offset == 0)
    555  1.15   reinoud 		return ENOENT;
    556  1.15   reinoud 
    557  1.15   reinoud 	if (v->vcap.cap_len > sizeof(struct virtio_pci_cap)) {
    558  1.15   reinoud 		len = roundup(v->vcap.cap_len, sizeof(pcireg_t));
    559  1.15   reinoud 		if (len > buflen) {
    560  1.15   reinoud 			aprint_error_dev(self, "%s cap too large\n", __func__);
    561  1.15   reinoud 			return ERANGE;
    562  1.15   reinoud 		}
    563  1.15   reinoud 		for (i = 4; i < len / sizeof(pcireg_t);  i++)
    564  1.15   reinoud 			v->reg[i] =
    565  1.15   reinoud 				le32toh(pci_conf_read(pc, tag, offset + i * 4));
    566  1.15   reinoud 	}
    567  1.15   reinoud 
    568  1.15   reinoud 	/* endian fixup */
    569  1.15   reinoud 	v->vcap.offset = le32toh(v->vcap.offset);
    570  1.15   reinoud 	v->vcap.length = le32toh(v->vcap.length);
    571  1.15   reinoud 	return 0;
    572   1.4  jakllsch }
    573   1.4  jakllsch 
    574  1.15   reinoud 
    575  1.15   reinoud /* -------------------------------------
    576  1.15   reinoud  * Version 0.9 support
    577  1.15   reinoud  * -------------------------------------*/
    578  1.15   reinoud 
    579  1.15   reinoud static void
    580  1.15   reinoud virtio_pci_kick_09(struct virtio_softc *sc, uint16_t idx)
    581   1.4  jakllsch {
    582   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    583  1.15   reinoud 
    584  1.15   reinoud 	bus_space_write_2(psc->sc_notify_iot, psc->sc_notify_ioh, 0, idx);
    585   1.4  jakllsch }
    586   1.4  jakllsch 
    587  1.15   reinoud /* only applicable for v 0.9 but also called for 1.0 */
    588  1.15   reinoud static int
    589  1.15   reinoud virtio_pci_adjust_config_region(struct virtio_pci_softc *psc)
    590   1.4  jakllsch {
    591  1.15   reinoud 	struct virtio_softc * const sc = (struct virtio_softc *) psc;
    592  1.15   reinoud 	device_t self = psc->sc_sc.sc_dev;
    593  1.15   reinoud 
    594  1.15   reinoud 	if (psc->sc_sc.sc_version_1)
    595  1.15   reinoud 		return 0;
    596  1.15   reinoud 
    597  1.15   reinoud 	sc->sc_devcfg_iosize = psc->sc_iosize - psc->sc_devcfg_offset;
    598  1.15   reinoud 	sc->sc_devcfg_iot = psc->sc_iot;
    599  1.15   reinoud 	if (bus_space_subregion(psc->sc_iot, psc->sc_ioh,
    600  1.15   reinoud 			psc->sc_devcfg_offset, sc->sc_devcfg_iosize,
    601  1.15   reinoud 			&sc->sc_devcfg_ioh)) {
    602  1.15   reinoud 		aprint_error_dev(self, "can't map config i/o space\n");
    603  1.15   reinoud 		return EIO;
    604  1.15   reinoud 	}
    605  1.15   reinoud 
    606  1.15   reinoud 	return 0;
    607   1.4  jakllsch }
    608   1.4  jakllsch 
    609  1.15   reinoud static uint16_t
    610  1.15   reinoud virtio_pci_read_queue_size_09(struct virtio_softc *sc, uint16_t idx)
    611   1.4  jakllsch {
    612   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    613   1.4  jakllsch 
    614  1.15   reinoud 	bus_space_write_2(psc->sc_iot, psc->sc_ioh,
    615  1.15   reinoud 	    VIRTIO_CONFIG_QUEUE_SELECT, idx);
    616  1.15   reinoud 	return bus_space_read_2(psc->sc_iot, psc->sc_ioh,
    617  1.15   reinoud 	    VIRTIO_CONFIG_QUEUE_SIZE);
    618   1.4  jakllsch }
    619   1.4  jakllsch 
    620   1.4  jakllsch static void
    621  1.15   reinoud virtio_pci_setup_queue_09(struct virtio_softc *sc, uint16_t idx, uint64_t addr)
    622   1.4  jakllsch {
    623   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    624   1.4  jakllsch 
    625  1.15   reinoud 	bus_space_write_2(psc->sc_iot, psc->sc_ioh,
    626  1.15   reinoud 	    VIRTIO_CONFIG_QUEUE_SELECT, idx);
    627  1.15   reinoud 	bus_space_write_4(psc->sc_iot, psc->sc_ioh,
    628  1.15   reinoud 	    VIRTIO_CONFIG_QUEUE_ADDRESS, addr / VIRTIO_PAGE_SIZE);
    629  1.15   reinoud 
    630  1.15   reinoud 	if (psc->sc_ihs_num > 1) {
    631  1.15   reinoud 		int vec = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
    632  1.15   reinoud 		if (sc->sc_child_mq)
    633  1.15   reinoud 			vec += idx;
    634  1.15   reinoud 		bus_space_write_2(psc->sc_iot, psc->sc_ioh,
    635  1.15   reinoud 		    VIRTIO_CONFIG_MSI_QUEUE_VECTOR, vec);
    636  1.15   reinoud 	}
    637   1.4  jakllsch }
    638   1.4  jakllsch 
    639   1.4  jakllsch static void
    640  1.15   reinoud virtio_pci_set_status_09(struct virtio_softc *sc, int status)
    641   1.4  jakllsch {
    642   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    643  1.15   reinoud 	int old = 0;
    644   1.4  jakllsch 
    645  1.15   reinoud 	if (status != 0) {
    646  1.15   reinoud 	    old = bus_space_read_1(psc->sc_iot, psc->sc_ioh,
    647  1.15   reinoud 		VIRTIO_CONFIG_DEVICE_STATUS);
    648  1.15   reinoud 	}
    649  1.15   reinoud 	bus_space_write_1(psc->sc_iot, psc->sc_ioh,
    650  1.15   reinoud 	    VIRTIO_CONFIG_DEVICE_STATUS, status|old);
    651   1.4  jakllsch }
    652   1.4  jakllsch 
    653   1.4  jakllsch static void
    654  1.15   reinoud virtio_pci_negotiate_features_09(struct virtio_softc *sc, uint64_t guest_features)
    655   1.4  jakllsch {
    656   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    657  1.15   reinoud 	uint32_t r;
    658  1.15   reinoud 
    659  1.15   reinoud 	r = bus_space_read_4(psc->sc_iot, psc->sc_ioh,
    660  1.15   reinoud 	    VIRTIO_CONFIG_DEVICE_FEATURES);
    661  1.15   reinoud 
    662  1.15   reinoud 	r &= guest_features;
    663  1.15   reinoud 
    664  1.15   reinoud 	bus_space_write_4(psc->sc_iot, psc->sc_ioh,
    665  1.15   reinoud 	    VIRTIO_CONFIG_GUEST_FEATURES, r);
    666   1.4  jakllsch 
    667  1.15   reinoud 	sc->sc_active_features = r;
    668   1.4  jakllsch }
    669   1.4  jakllsch 
    670  1.15   reinoud /* -------------------------------------
    671  1.15   reinoud  * Version 1.0 support
    672  1.15   reinoud  * -------------------------------------*/
    673  1.15   reinoud 
    674   1.4  jakllsch static void
    675  1.15   reinoud virtio_pci_kick_10(struct virtio_softc *sc, uint16_t idx)
    676   1.4  jakllsch {
    677   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    678  1.15   reinoud 	unsigned offset = sc->sc_vqs[idx].vq_notify_off *
    679  1.15   reinoud 		psc->sc_notify_off_multiplier;
    680   1.4  jakllsch 
    681  1.15   reinoud 	bus_space_write_2(psc->sc_notify_iot, psc->sc_notify_ioh, offset, idx);
    682   1.4  jakllsch }
    683   1.4  jakllsch 
    684  1.15   reinoud 
    685   1.4  jakllsch static uint16_t
    686  1.15   reinoud virtio_pci_read_queue_size_10(struct virtio_softc *sc, uint16_t idx)
    687   1.4  jakllsch {
    688   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    689  1.15   reinoud 	bus_space_tag_t	   iot = psc->sc_iot;
    690  1.15   reinoud 	bus_space_handle_t ioh = psc->sc_ioh;
    691   1.4  jakllsch 
    692  1.15   reinoud 	bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, idx);
    693  1.15   reinoud 	return bus_space_read_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SIZE);
    694   1.4  jakllsch }
    695   1.4  jakllsch 
    696  1.18   reinoud /*
    697  1.18   reinoud  * By definition little endian only in v1.0 and 8 byters are allowed to be
    698  1.18   reinoud  * written as two 4 byters
    699  1.24   thorpej  *
    700  1.20  christos  * This is not a general purpose function that can be used in any
    701  1.20  christos  * driver. Virtio specifically allows the 8 byte bus transaction
    702  1.20  christos  * to be split into two 4 byte transactions. Do not copy/use it
    703  1.20  christos  * in other device drivers unless you know that the device accepts it.
    704  1.20  christos  */
    705  1.19  christos static __inline void
    706  1.24   thorpej virtio_pci_bus_space_write_8(bus_space_tag_t iot, bus_space_handle_t ioh,
    707  1.19  christos      bus_size_t offset, uint64_t value)
    708  1.19  christos {
    709  1.24   thorpej #if defined(__HAVE_BUS_SPACE_8)
    710  1.24   thorpej 	bus_space_write_8(iot, ioh, offset, value);
    711  1.24   thorpej #elif _QUAD_HIGHWORD
    712  1.19  christos 	bus_space_write_4(iot, ioh, offset, BUS_ADDR_LO32(value));
    713  1.19  christos 	bus_space_write_4(iot, ioh, offset + 4, BUS_ADDR_HI32(value));
    714  1.19  christos #else
    715  1.19  christos 	bus_space_write_4(iot, ioh, offset, BUS_ADDR_HI32(value));
    716  1.19  christos 	bus_space_write_4(iot, ioh, offset + 4, BUS_ADDR_LO32(value));
    717  1.19  christos #endif
    718  1.19  christos }
    719  1.18   reinoud 
    720   1.4  jakllsch static void
    721  1.15   reinoud virtio_pci_setup_queue_10(struct virtio_softc *sc, uint16_t idx, uint64_t addr)
    722   1.4  jakllsch {
    723   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    724  1.15   reinoud 	struct virtqueue *vq = &sc->sc_vqs[idx];
    725  1.15   reinoud 	bus_space_tag_t	   iot = psc->sc_iot;
    726  1.15   reinoud 	bus_space_handle_t ioh = psc->sc_ioh;
    727  1.15   reinoud 	KASSERT(vq->vq_index == idx);
    728  1.15   reinoud 
    729  1.15   reinoud 	bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, vq->vq_index);
    730  1.15   reinoud 	if (addr == 0) {
    731  1.15   reinoud 		bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_ENABLE, 0);
    732  1.24   thorpej 		virtio_pci_bus_space_write_8(iot, ioh,
    733  1.24   thorpej 		    VIRTIO_CONFIG1_QUEUE_DESC,   0);
    734  1.24   thorpej 		virtio_pci_bus_space_write_8(iot, ioh,
    735  1.24   thorpej 		    VIRTIO_CONFIG1_QUEUE_AVAIL,  0);
    736  1.24   thorpej 		virtio_pci_bus_space_write_8(iot, ioh,
    737  1.24   thorpej 		    VIRTIO_CONFIG1_QUEUE_USED,   0);
    738  1.15   reinoud 	} else {
    739  1.24   thorpej 		virtio_pci_bus_space_write_8(iot, ioh,
    740  1.15   reinoud 			VIRTIO_CONFIG1_QUEUE_DESC, addr);
    741  1.24   thorpej 		virtio_pci_bus_space_write_8(iot, ioh,
    742  1.15   reinoud 			VIRTIO_CONFIG1_QUEUE_AVAIL, addr + vq->vq_availoffset);
    743  1.24   thorpej 		virtio_pci_bus_space_write_8(iot, ioh,
    744  1.15   reinoud 			VIRTIO_CONFIG1_QUEUE_USED, addr + vq->vq_usedoffset);
    745  1.15   reinoud 		bus_space_write_2(iot, ioh,
    746  1.15   reinoud 			VIRTIO_CONFIG1_QUEUE_ENABLE, 1);
    747  1.15   reinoud 		vq->vq_notify_off = bus_space_read_2(iot, ioh,
    748  1.15   reinoud 			VIRTIO_CONFIG1_QUEUE_NOTIFY_OFF);
    749  1.15   reinoud 	}
    750   1.4  jakllsch 
    751   1.4  jakllsch 	if (psc->sc_ihs_num > 1) {
    752   1.4  jakllsch 		int vec = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
    753   1.6  yamaguch 		if (sc->sc_child_mq)
    754   1.4  jakllsch 			vec += idx;
    755  1.15   reinoud 		bus_space_write_2(iot, ioh,
    756  1.15   reinoud 			VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR, vec);
    757   1.4  jakllsch 	}
    758   1.4  jakllsch }
    759   1.4  jakllsch 
    760   1.4  jakllsch static void
    761  1.15   reinoud virtio_pci_set_status_10(struct virtio_softc *sc, int status)
    762   1.4  jakllsch {
    763   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    764  1.15   reinoud 	bus_space_tag_t	   iot = psc->sc_iot;
    765  1.15   reinoud 	bus_space_handle_t ioh = psc->sc_ioh;
    766   1.4  jakllsch 	int old = 0;
    767   1.4  jakllsch 
    768  1.15   reinoud 	if (status)
    769  1.15   reinoud 		old = bus_space_read_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS);
    770  1.15   reinoud 	bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS, status | old);
    771  1.15   reinoud }
    772  1.15   reinoud 
    773  1.15   reinoud void
    774  1.15   reinoud virtio_pci_negotiate_features_10(struct virtio_softc *sc, uint64_t guest_features)
    775  1.15   reinoud {
    776  1.15   reinoud 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    777  1.15   reinoud 	device_t self          =  sc->sc_dev;
    778  1.15   reinoud 	bus_space_tag_t	   iot = psc->sc_iot;
    779  1.15   reinoud 	bus_space_handle_t ioh = psc->sc_ioh;
    780  1.15   reinoud 	uint64_t host, negotiated, device_status;
    781  1.15   reinoud 
    782  1.15   reinoud 	guest_features |= VIRTIO_F_VERSION_1;
    783  1.15   reinoud 	/* notify on empty is 0.9 only */
    784  1.15   reinoud 	guest_features &= ~VIRTIO_F_NOTIFY_ON_EMPTY;
    785  1.15   reinoud 	sc->sc_active_features = 0;
    786  1.15   reinoud 
    787  1.15   reinoud 	bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE_SELECT, 0);
    788  1.15   reinoud 	host = bus_space_read_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE);
    789  1.15   reinoud 	bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE_SELECT, 1);
    790  1.15   reinoud 	host |= (uint64_t)
    791  1.15   reinoud 		bus_space_read_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE) << 32;
    792  1.15   reinoud 
    793  1.15   reinoud 	negotiated = host & guest_features;
    794  1.15   reinoud 
    795  1.15   reinoud 	bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE_SELECT, 0);
    796  1.15   reinoud 	bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE,
    797  1.15   reinoud 			negotiated & 0xffffffff);
    798  1.15   reinoud 	bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE_SELECT, 1);
    799  1.15   reinoud 	bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE,
    800  1.15   reinoud 			negotiated >> 32);
    801  1.15   reinoud 	virtio_pci_set_status_10(sc, VIRTIO_CONFIG_DEVICE_STATUS_FEATURES_OK);
    802  1.15   reinoud 
    803  1.15   reinoud 	device_status = bus_space_read_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS);
    804  1.15   reinoud 	if ((device_status & VIRTIO_CONFIG_DEVICE_STATUS_FEATURES_OK) == 0) {
    805  1.15   reinoud 		aprint_error_dev(self, "feature negotiation failed\n");
    806  1.15   reinoud 		bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS,
    807  1.15   reinoud 				VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
    808  1.15   reinoud 		return;
    809  1.15   reinoud 	}
    810  1.15   reinoud 
    811  1.15   reinoud 	if ((negotiated & VIRTIO_F_VERSION_1) == 0) {
    812  1.15   reinoud 		aprint_error_dev(self, "host rejected version 1\n");
    813  1.15   reinoud 		bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS,
    814  1.15   reinoud 				VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
    815  1.15   reinoud 		return;
    816   1.4  jakllsch 	}
    817  1.15   reinoud 
    818  1.15   reinoud 	sc->sc_active_features = negotiated;
    819  1.15   reinoud 	return;
    820  1.15   reinoud }
    821  1.15   reinoud 
    822  1.15   reinoud 
    823  1.15   reinoud /* -------------------------------------
    824  1.15   reinoud  * Generic PCI interrupt code
    825  1.15   reinoud  * -------------------------------------*/
    826  1.15   reinoud 
    827  1.15   reinoud static int
    828  1.32  yamaguch virtio_pci_setup_interrupts_10(struct virtio_softc *sc, int reinit)
    829   1.4  jakllsch {
    830   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    831  1.15   reinoud 	bus_space_tag_t	   iot = psc->sc_iot;
    832  1.15   reinoud 	bus_space_handle_t ioh = psc->sc_ioh;
    833  1.15   reinoud 	int vector, ret, qid;
    834  1.15   reinoud 
    835  1.31  yamaguch 	if (!virtio_pci_msix_enabled(psc))
    836  1.31  yamaguch 		return 0;
    837  1.31  yamaguch 
    838  1.15   reinoud 	vector = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
    839  1.15   reinoud 	bus_space_write_2(iot, ioh,
    840  1.15   reinoud 		VIRTIO_CONFIG1_CONFIG_MSIX_VECTOR, vector);
    841  1.15   reinoud 	ret = bus_space_read_2(iot, ioh, VIRTIO_CONFIG1_CONFIG_MSIX_VECTOR);
    842  1.15   reinoud 	if (ret != vector) {
    843  1.33  yamaguch 		VIRTIO_PCI_LOG(sc, reinit,
    844  1.33  yamaguch 		    "can't set config msix vector\n");
    845  1.15   reinoud 		return -1;
    846  1.15   reinoud 	}
    847  1.15   reinoud 
    848  1.15   reinoud 	for (qid = 0; qid < sc->sc_nvqs; qid++) {
    849  1.15   reinoud 		vector = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
    850   1.4  jakllsch 
    851  1.15   reinoud 		if (sc->sc_child_mq)
    852  1.15   reinoud 			vector += qid;
    853  1.15   reinoud 		bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, qid);
    854  1.15   reinoud 		bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR,
    855  1.15   reinoud 			vector);
    856  1.15   reinoud 		ret = bus_space_read_2(iot, ioh,
    857  1.15   reinoud 			VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR);
    858  1.15   reinoud 		if (ret != vector) {
    859  1.33  yamaguch 			VIRTIO_PCI_LOG(sc, reinit, "can't set queue %d "
    860  1.33  yamaguch 			    "msix vector\n", qid);
    861  1.15   reinoud 			return -1;
    862  1.15   reinoud 		}
    863  1.15   reinoud 	}
    864   1.4  jakllsch 
    865  1.15   reinoud 	return 0;
    866   1.4  jakllsch }
    867   1.4  jakllsch 
    868   1.4  jakllsch static int
    869  1.32  yamaguch virtio_pci_setup_interrupts_09(struct virtio_softc *sc, int reinit)
    870   1.4  jakllsch {
    871   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    872   1.4  jakllsch 	int offset, vector, ret, qid;
    873   1.4  jakllsch 
    874  1.31  yamaguch 	if (!virtio_pci_msix_enabled(psc))
    875  1.31  yamaguch 		return 0;
    876  1.31  yamaguch 
    877   1.4  jakllsch 	offset = VIRTIO_CONFIG_MSI_CONFIG_VECTOR;
    878   1.4  jakllsch 	vector = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
    879   1.4  jakllsch 
    880  1.15   reinoud 	bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, vector);
    881  1.15   reinoud 	ret = bus_space_read_2(psc->sc_iot, psc->sc_ioh, offset);
    882   1.4  jakllsch 	aprint_debug_dev(sc->sc_dev, "expected=%d, actual=%d\n",
    883   1.4  jakllsch 	    vector, ret);
    884  1.15   reinoud 	if (ret != vector) {
    885  1.33  yamaguch 		VIRTIO_PCI_LOG(sc, reinit,
    886  1.33  yamaguch 		    "can't set config msix vector\n");
    887   1.4  jakllsch 		return -1;
    888  1.15   reinoud 	}
    889   1.4  jakllsch 
    890   1.4  jakllsch 	for (qid = 0; qid < sc->sc_nvqs; qid++) {
    891   1.4  jakllsch 		offset = VIRTIO_CONFIG_QUEUE_SELECT;
    892  1.15   reinoud 		bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, qid);
    893   1.4  jakllsch 
    894   1.4  jakllsch 		offset = VIRTIO_CONFIG_MSI_QUEUE_VECTOR;
    895   1.4  jakllsch 		vector = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
    896   1.4  jakllsch 
    897   1.6  yamaguch 		if (sc->sc_child_mq)
    898   1.6  yamaguch 			vector += qid;
    899   1.6  yamaguch 
    900  1.15   reinoud 		bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, vector);
    901  1.15   reinoud 		ret = bus_space_read_2(psc->sc_iot, psc->sc_ioh, offset);
    902   1.4  jakllsch 		aprint_debug_dev(sc->sc_dev, "expected=%d, actual=%d\n",
    903   1.4  jakllsch 		    vector, ret);
    904  1.15   reinoud 		if (ret != vector) {
    905  1.33  yamaguch 			VIRTIO_PCI_LOG(sc, reinit, "can't set queue %d "
    906  1.33  yamaguch 			    "msix vector\n", qid);
    907   1.4  jakllsch 			return -1;
    908  1.15   reinoud 		}
    909   1.4  jakllsch 	}
    910   1.4  jakllsch 
    911   1.4  jakllsch 	return 0;
    912   1.4  jakllsch }
    913   1.4  jakllsch 
    914   1.4  jakllsch static int
    915  1.31  yamaguch virtio_pci_establish_msix_interrupts(struct virtio_softc *sc,
    916   1.4  jakllsch     struct pci_attach_args *pa)
    917   1.4  jakllsch {
    918   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
    919   1.4  jakllsch 	device_t self = sc->sc_dev;
    920   1.4  jakllsch 	pci_chipset_tag_t pc = pa->pa_pc;
    921   1.9  yamaguch 	struct virtqueue *vq;
    922   1.4  jakllsch 	char intrbuf[PCI_INTRSTR_LEN];
    923   1.6  yamaguch 	char intr_xname[INTRDEVNAMEBUF];
    924   1.4  jakllsch 	char const *intrstr;
    925   1.6  yamaguch 	int idx, qid, n;
    926   1.4  jakllsch 
    927   1.4  jakllsch 	idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
    928  1.15   reinoud 	if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
    929   1.4  jakllsch 		pci_intr_setattr(pc, &psc->sc_ihp[idx], PCI_INTR_MPSAFE, true);
    930   1.4  jakllsch 
    931   1.6  yamaguch 	snprintf(intr_xname, sizeof(intr_xname), "%s config",
    932   1.6  yamaguch 	    device_xname(sc->sc_dev));
    933   1.6  yamaguch 
    934   1.4  jakllsch 	psc->sc_ihs[idx] = pci_intr_establish_xname(pc, psc->sc_ihp[idx],
    935   1.6  yamaguch 	    sc->sc_ipl, virtio_pci_msix_config_intr, sc, intr_xname);
    936   1.4  jakllsch 	if (psc->sc_ihs[idx] == NULL) {
    937   1.4  jakllsch 		aprint_error_dev(self, "couldn't establish MSI-X for config\n");
    938   1.4  jakllsch 		goto error;
    939   1.4  jakllsch 	}
    940   1.4  jakllsch 
    941   1.4  jakllsch 	idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
    942   1.6  yamaguch 	if (sc->sc_child_mq) {
    943   1.6  yamaguch 		for (qid = 0; qid < sc->sc_nvqs; qid++) {
    944   1.6  yamaguch 			n = idx + qid;
    945   1.9  yamaguch 			vq = &sc->sc_vqs[qid];
    946   1.6  yamaguch 
    947   1.6  yamaguch 			snprintf(intr_xname, sizeof(intr_xname), "%s vq#%d",
    948   1.6  yamaguch 			    device_xname(sc->sc_dev), qid);
    949   1.6  yamaguch 
    950  1.15   reinoud 			if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE) {
    951   1.6  yamaguch 				pci_intr_setattr(pc, &psc->sc_ihp[n],
    952   1.6  yamaguch 				    PCI_INTR_MPSAFE, true);
    953   1.6  yamaguch 			}
    954   1.6  yamaguch 
    955   1.6  yamaguch 			psc->sc_ihs[n] = pci_intr_establish_xname(pc, psc->sc_ihp[n],
    956  1.10  yamaguch 			    sc->sc_ipl, vq->vq_intrhand, vq->vq_intrhand_arg, intr_xname);
    957   1.6  yamaguch 			if (psc->sc_ihs[n] == NULL) {
    958   1.6  yamaguch 				aprint_error_dev(self, "couldn't establish MSI-X for a vq\n");
    959   1.6  yamaguch 				goto error;
    960   1.6  yamaguch 			}
    961   1.6  yamaguch 		}
    962   1.6  yamaguch 	} else {
    963  1.15   reinoud 		if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
    964   1.6  yamaguch 			pci_intr_setattr(pc, &psc->sc_ihp[idx], PCI_INTR_MPSAFE, true);
    965   1.4  jakllsch 
    966   1.6  yamaguch 		snprintf(intr_xname, sizeof(intr_xname), "%s queues",
    967   1.6  yamaguch 		    device_xname(sc->sc_dev));
    968   1.6  yamaguch 		psc->sc_ihs[idx] = pci_intr_establish_xname(pc, psc->sc_ihp[idx],
    969   1.6  yamaguch 		    sc->sc_ipl, virtio_pci_msix_queue_intr, sc, intr_xname);
    970   1.6  yamaguch 		if (psc->sc_ihs[idx] == NULL) {
    971   1.6  yamaguch 			aprint_error_dev(self, "couldn't establish MSI-X for queues\n");
    972   1.6  yamaguch 			goto error;
    973   1.6  yamaguch 		}
    974   1.4  jakllsch 	}
    975   1.4  jakllsch 
    976   1.4  jakllsch 	idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
    977   1.4  jakllsch 	intrstr = pci_intr_string(pc, psc->sc_ihp[idx], intrbuf, sizeof(intrbuf));
    978   1.4  jakllsch 	aprint_normal_dev(self, "config interrupting at %s\n", intrstr);
    979   1.4  jakllsch 	idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
    980   1.6  yamaguch 	if (sc->sc_child_mq) {
    981   1.6  yamaguch 		kcpuset_t *affinity;
    982   1.6  yamaguch 		int affinity_to, r;
    983   1.6  yamaguch 
    984   1.6  yamaguch 		kcpuset_create(&affinity, false);
    985   1.6  yamaguch 
    986   1.6  yamaguch 		for (qid = 0; qid < sc->sc_nvqs; qid++) {
    987   1.6  yamaguch 			n = idx + qid;
    988   1.6  yamaguch 			affinity_to = (qid / 2) % ncpu;
    989   1.6  yamaguch 
    990   1.6  yamaguch 			intrstr = pci_intr_string(pc, psc->sc_ihp[n],
    991   1.6  yamaguch 			    intrbuf, sizeof(intrbuf));
    992   1.6  yamaguch 
    993   1.6  yamaguch 			kcpuset_zero(affinity);
    994   1.6  yamaguch 			kcpuset_set(affinity, affinity_to);
    995   1.6  yamaguch 			r = interrupt_distribute(psc->sc_ihs[n], affinity, NULL);
    996   1.6  yamaguch 			if (r == 0) {
    997   1.6  yamaguch 				aprint_normal_dev(self,
    998   1.6  yamaguch 				    "for vq #%d interrupting at %s affinity to %u\n",
    999   1.6  yamaguch 				    qid, intrstr, affinity_to);
   1000   1.6  yamaguch 			} else {
   1001   1.6  yamaguch 				aprint_normal_dev(self,
   1002   1.6  yamaguch 				    "for vq #%d interrupting at %s\n",
   1003   1.6  yamaguch 				    qid, intrstr);
   1004   1.6  yamaguch 			}
   1005   1.6  yamaguch 		}
   1006   1.6  yamaguch 
   1007   1.6  yamaguch 		kcpuset_destroy(affinity);
   1008   1.6  yamaguch 	} else {
   1009   1.6  yamaguch 		intrstr = pci_intr_string(pc, psc->sc_ihp[idx], intrbuf, sizeof(intrbuf));
   1010   1.6  yamaguch 		aprint_normal_dev(self, "queues interrupting at %s\n", intrstr);
   1011   1.6  yamaguch 	}
   1012   1.4  jakllsch 
   1013   1.4  jakllsch 	return 0;
   1014   1.4  jakllsch 
   1015   1.4  jakllsch error:
   1016   1.4  jakllsch 	idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
   1017   1.4  jakllsch 	if (psc->sc_ihs[idx] != NULL)
   1018   1.4  jakllsch 		pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[idx]);
   1019   1.4  jakllsch 	idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
   1020   1.6  yamaguch 	if (sc->sc_child_mq) {
   1021   1.6  yamaguch 		for (qid = 0; qid < sc->sc_nvqs; qid++) {
   1022   1.6  yamaguch 			n = idx + qid;
   1023   1.6  yamaguch 			if (psc->sc_ihs[n] == NULL)
   1024   1.6  yamaguch 				continue;
   1025   1.6  yamaguch 			pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[n]);
   1026   1.6  yamaguch 		}
   1027   1.6  yamaguch 
   1028   1.6  yamaguch 	} else {
   1029   1.6  yamaguch 		if (psc->sc_ihs[idx] != NULL)
   1030   1.6  yamaguch 			pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[idx]);
   1031   1.6  yamaguch 	}
   1032   1.4  jakllsch 
   1033   1.4  jakllsch 	return -1;
   1034   1.4  jakllsch }
   1035   1.4  jakllsch 
   1036   1.4  jakllsch static int
   1037  1.31  yamaguch virtio_pci_establish_intx_interrupt(struct virtio_softc *sc,
   1038   1.4  jakllsch     struct pci_attach_args *pa)
   1039   1.4  jakllsch {
   1040   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
   1041   1.4  jakllsch 	device_t self = sc->sc_dev;
   1042   1.4  jakllsch 	pci_chipset_tag_t pc = pa->pa_pc;
   1043   1.4  jakllsch 	char intrbuf[PCI_INTRSTR_LEN];
   1044   1.4  jakllsch 	char const *intrstr;
   1045   1.4  jakllsch 
   1046  1.15   reinoud 	if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
   1047   1.4  jakllsch 		pci_intr_setattr(pc, &psc->sc_ihp[0], PCI_INTR_MPSAFE, true);
   1048   1.4  jakllsch 
   1049   1.4  jakllsch 	psc->sc_ihs[0] = pci_intr_establish_xname(pc, psc->sc_ihp[0],
   1050   1.4  jakllsch 	    sc->sc_ipl, virtio_pci_intr, sc, device_xname(sc->sc_dev));
   1051   1.4  jakllsch 	if (psc->sc_ihs[0] == NULL) {
   1052   1.4  jakllsch 		aprint_error_dev(self, "couldn't establish INTx\n");
   1053   1.4  jakllsch 		return -1;
   1054   1.4  jakllsch 	}
   1055   1.4  jakllsch 
   1056   1.4  jakllsch 	intrstr = pci_intr_string(pc, psc->sc_ihp[0], intrbuf, sizeof(intrbuf));
   1057   1.4  jakllsch 	aprint_normal_dev(self, "interrupting at %s\n", intrstr);
   1058   1.4  jakllsch 
   1059   1.4  jakllsch 	return 0;
   1060   1.4  jakllsch }
   1061   1.4  jakllsch 
   1062   1.4  jakllsch static int
   1063  1.31  yamaguch virtio_pci_alloc_interrupts(struct virtio_softc *sc)
   1064   1.4  jakllsch {
   1065   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
   1066   1.4  jakllsch 	device_t self = sc->sc_dev;
   1067   1.4  jakllsch 	pci_chipset_tag_t pc = psc->sc_pa.pa_pc;
   1068  1.13  jakllsch 	pcitag_t tag = psc->sc_pa.pa_tag;
   1069   1.4  jakllsch 	int error;
   1070   1.4  jakllsch 	int nmsix;
   1071  1.13  jakllsch 	int off;
   1072   1.4  jakllsch 	int counts[PCI_INTR_TYPE_SIZE];
   1073   1.4  jakllsch 	pci_intr_type_t max_type;
   1074  1.13  jakllsch 	pcireg_t ctl;
   1075   1.4  jakllsch 
   1076   1.4  jakllsch 	nmsix = pci_msix_count(psc->sc_pa.pa_pc, psc->sc_pa.pa_tag);
   1077   1.4  jakllsch 	aprint_debug_dev(self, "pci_msix_count=%d\n", nmsix);
   1078   1.4  jakllsch 
   1079   1.4  jakllsch 	/* We need at least two: one for config and the other for queues */
   1080  1.15   reinoud 	if ((sc->sc_flags & VIRTIO_F_INTR_MSIX) == 0 || nmsix < 2) {
   1081   1.4  jakllsch 		/* Try INTx only */
   1082   1.4  jakllsch 		max_type = PCI_INTR_TYPE_INTX;
   1083   1.4  jakllsch 		counts[PCI_INTR_TYPE_INTX] = 1;
   1084   1.4  jakllsch 	} else {
   1085   1.4  jakllsch 		/* Try MSI-X first and INTx second */
   1086  1.11  yamaguch 		if (sc->sc_nvqs + VIRTIO_MSIX_QUEUE_VECTOR_INDEX <= nmsix) {
   1087  1.11  yamaguch 			nmsix = sc->sc_nvqs + VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
   1088  1.11  yamaguch 		} else {
   1089  1.11  yamaguch 			sc->sc_child_mq = false;
   1090  1.11  yamaguch 		}
   1091  1.11  yamaguch 
   1092  1.11  yamaguch 		if (sc->sc_child_mq == false) {
   1093   1.6  yamaguch 			nmsix = 2;
   1094   1.6  yamaguch 		}
   1095   1.6  yamaguch 
   1096   1.4  jakllsch 		max_type = PCI_INTR_TYPE_MSIX;
   1097   1.6  yamaguch 		counts[PCI_INTR_TYPE_MSIX] = nmsix;
   1098   1.4  jakllsch 		counts[PCI_INTR_TYPE_MSI] = 0;
   1099   1.4  jakllsch 		counts[PCI_INTR_TYPE_INTX] = 1;
   1100   1.4  jakllsch 	}
   1101   1.4  jakllsch 
   1102   1.4  jakllsch retry:
   1103   1.4  jakllsch 	error = pci_intr_alloc(&psc->sc_pa, &psc->sc_ihp, counts, max_type);
   1104   1.4  jakllsch 	if (error != 0) {
   1105   1.4  jakllsch 		aprint_error_dev(self, "couldn't map interrupt\n");
   1106   1.4  jakllsch 		return -1;
   1107   1.4  jakllsch 	}
   1108   1.4  jakllsch 
   1109   1.4  jakllsch 	if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_MSIX) {
   1110  1.12  jakllsch 		psc->sc_ihs = kmem_zalloc(sizeof(*psc->sc_ihs) * nmsix,
   1111   1.4  jakllsch 		    KM_SLEEP);
   1112   1.4  jakllsch 
   1113  1.31  yamaguch 		error = virtio_pci_establish_msix_interrupts(sc, &psc->sc_pa);
   1114   1.4  jakllsch 		if (error != 0) {
   1115   1.6  yamaguch 			kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * nmsix);
   1116   1.6  yamaguch 			pci_intr_release(pc, psc->sc_ihp, nmsix);
   1117   1.4  jakllsch 
   1118   1.4  jakllsch 			/* Retry INTx */
   1119   1.4  jakllsch 			max_type = PCI_INTR_TYPE_INTX;
   1120   1.4  jakllsch 			counts[PCI_INTR_TYPE_INTX] = 1;
   1121   1.4  jakllsch 			goto retry;
   1122   1.4  jakllsch 		}
   1123   1.4  jakllsch 
   1124   1.6  yamaguch 		psc->sc_ihs_num = nmsix;
   1125  1.15   reinoud 		psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_MSI;
   1126  1.15   reinoud 		virtio_pci_adjust_config_region(psc);
   1127   1.4  jakllsch 	} else if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_INTX) {
   1128  1.12  jakllsch 		psc->sc_ihs = kmem_zalloc(sizeof(*psc->sc_ihs) * 1,
   1129   1.4  jakllsch 		    KM_SLEEP);
   1130   1.4  jakllsch 
   1131  1.31  yamaguch 		error = virtio_pci_establish_intx_interrupt(sc, &psc->sc_pa);
   1132   1.4  jakllsch 		if (error != 0) {
   1133   1.4  jakllsch 			kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * 1);
   1134   1.4  jakllsch 			pci_intr_release(pc, psc->sc_ihp, 1);
   1135   1.4  jakllsch 			return -1;
   1136   1.4  jakllsch 		}
   1137   1.4  jakllsch 
   1138   1.4  jakllsch 		psc->sc_ihs_num = 1;
   1139  1.15   reinoud 		psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_NOMSI;
   1140  1.15   reinoud 		virtio_pci_adjust_config_region(psc);
   1141  1.13  jakllsch 
   1142  1.14  jakllsch 		error = pci_get_capability(pc, tag, PCI_CAP_MSIX, &off, NULL);
   1143  1.13  jakllsch 		if (error != 0) {
   1144  1.13  jakllsch 			ctl = pci_conf_read(pc, tag, off + PCI_MSIX_CTL);
   1145  1.13  jakllsch 			ctl &= ~PCI_MSIX_CTL_ENABLE;
   1146  1.13  jakllsch 			pci_conf_write(pc, tag, off + PCI_MSIX_CTL, ctl);
   1147  1.13  jakllsch 		}
   1148   1.4  jakllsch 	}
   1149   1.4  jakllsch 
   1150   1.4  jakllsch 	return 0;
   1151   1.4  jakllsch }
   1152   1.4  jakllsch 
   1153   1.4  jakllsch static void
   1154   1.4  jakllsch virtio_pci_free_interrupts(struct virtio_softc *sc)
   1155   1.4  jakllsch {
   1156   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
   1157   1.4  jakllsch 
   1158   1.4  jakllsch 	for (int i = 0; i < psc->sc_ihs_num; i++) {
   1159   1.4  jakllsch 		if (psc->sc_ihs[i] == NULL)
   1160   1.4  jakllsch 			continue;
   1161   1.4  jakllsch 		pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[i]);
   1162   1.4  jakllsch 		psc->sc_ihs[i] = NULL;
   1163   1.4  jakllsch 	}
   1164   1.4  jakllsch 
   1165   1.4  jakllsch 	if (psc->sc_ihs_num > 0)
   1166   1.4  jakllsch 		pci_intr_release(psc->sc_pa.pa_pc, psc->sc_ihp, psc->sc_ihs_num);
   1167   1.4  jakllsch 
   1168   1.4  jakllsch 	if (psc->sc_ihs != NULL) {
   1169   1.4  jakllsch 		kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * psc->sc_ihs_num);
   1170   1.4  jakllsch 		psc->sc_ihs = NULL;
   1171   1.4  jakllsch 	}
   1172   1.4  jakllsch 	psc->sc_ihs_num = 0;
   1173   1.4  jakllsch }
   1174   1.4  jakllsch 
   1175  1.31  yamaguch static bool
   1176  1.31  yamaguch virtio_pci_msix_enabled(struct virtio_pci_softc *psc)
   1177  1.31  yamaguch {
   1178  1.31  yamaguch 	pci_chipset_tag_t pc = psc->sc_pa.pa_pc;
   1179  1.31  yamaguch 
   1180  1.31  yamaguch 	if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_MSIX)
   1181  1.31  yamaguch 		return true;
   1182  1.31  yamaguch 
   1183  1.31  yamaguch 	return false;
   1184  1.31  yamaguch }
   1185  1.31  yamaguch 
   1186   1.4  jakllsch /*
   1187   1.4  jakllsch  * Interrupt handler.
   1188   1.4  jakllsch  */
   1189   1.4  jakllsch static int
   1190   1.4  jakllsch virtio_pci_intr(void *arg)
   1191   1.4  jakllsch {
   1192   1.4  jakllsch 	struct virtio_softc *sc = arg;
   1193   1.4  jakllsch 	struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
   1194   1.4  jakllsch 	int isr, r = 0;
   1195   1.4  jakllsch 
   1196   1.4  jakllsch 	/* check and ack the interrupt */
   1197  1.15   reinoud 	isr = bus_space_read_1(psc->sc_isr_iot, psc->sc_isr_ioh, 0);
   1198   1.4  jakllsch 	if (isr == 0)
   1199   1.4  jakllsch 		return 0;
   1200   1.4  jakllsch 	if ((isr & VIRTIO_CONFIG_ISR_CONFIG_CHANGE) &&
   1201   1.4  jakllsch 	    (sc->sc_config_change != NULL))
   1202   1.4  jakllsch 		r = (sc->sc_config_change)(sc);
   1203   1.4  jakllsch 	if (sc->sc_intrhand != NULL) {
   1204   1.4  jakllsch 		if (sc->sc_soft_ih != NULL)
   1205   1.4  jakllsch 			softint_schedule(sc->sc_soft_ih);
   1206   1.4  jakllsch 		else
   1207   1.4  jakllsch 			r |= (sc->sc_intrhand)(sc);
   1208   1.4  jakllsch 	}
   1209   1.4  jakllsch 
   1210   1.4  jakllsch 	return r;
   1211   1.4  jakllsch }
   1212   1.4  jakllsch 
   1213   1.4  jakllsch static int
   1214   1.4  jakllsch virtio_pci_msix_queue_intr(void *arg)
   1215   1.4  jakllsch {
   1216   1.4  jakllsch 	struct virtio_softc *sc = arg;
   1217   1.4  jakllsch 	int r = 0;
   1218   1.4  jakllsch 
   1219   1.4  jakllsch 	if (sc->sc_intrhand != NULL) {
   1220   1.4  jakllsch 		if (sc->sc_soft_ih != NULL)
   1221   1.4  jakllsch 			softint_schedule(sc->sc_soft_ih);
   1222   1.4  jakllsch 		else
   1223   1.4  jakllsch 			r |= (sc->sc_intrhand)(sc);
   1224   1.4  jakllsch 	}
   1225   1.4  jakllsch 
   1226   1.4  jakllsch 	return r;
   1227   1.4  jakllsch }
   1228   1.4  jakllsch 
   1229   1.4  jakllsch static int
   1230   1.4  jakllsch virtio_pci_msix_config_intr(void *arg)
   1231   1.4  jakllsch {
   1232   1.4  jakllsch 	struct virtio_softc *sc = arg;
   1233   1.4  jakllsch 	int r = 0;
   1234   1.4  jakllsch 
   1235   1.4  jakllsch 	if (sc->sc_config_change != NULL)
   1236   1.4  jakllsch 		r = (sc->sc_config_change)(sc);
   1237   1.4  jakllsch 	return r;
   1238   1.4  jakllsch }
   1239   1.5  jakllsch 
   1240   1.5  jakllsch MODULE(MODULE_CLASS_DRIVER, virtio_pci, "pci,virtio");
   1241   1.5  jakllsch 
   1242   1.5  jakllsch #ifdef _MODULE
   1243   1.5  jakllsch #include "ioconf.c"
   1244   1.5  jakllsch #endif
   1245   1.5  jakllsch 
   1246   1.5  jakllsch static int
   1247   1.5  jakllsch virtio_pci_modcmd(modcmd_t cmd, void *opaque)
   1248   1.5  jakllsch {
   1249   1.5  jakllsch 	int error = 0;
   1250   1.5  jakllsch 
   1251   1.5  jakllsch #ifdef _MODULE
   1252   1.5  jakllsch 	switch (cmd) {
   1253   1.5  jakllsch 	case MODULE_CMD_INIT:
   1254   1.5  jakllsch 		error = config_init_component(cfdriver_ioconf_virtio_pci,
   1255   1.5  jakllsch 		    cfattach_ioconf_virtio_pci, cfdata_ioconf_virtio_pci);
   1256   1.5  jakllsch 		break;
   1257   1.5  jakllsch 	case MODULE_CMD_FINI:
   1258   1.5  jakllsch 		error = config_fini_component(cfdriver_ioconf_virtio_pci,
   1259   1.5  jakllsch 		    cfattach_ioconf_virtio_pci, cfdata_ioconf_virtio_pci);
   1260   1.5  jakllsch 		break;
   1261   1.5  jakllsch 	default:
   1262   1.5  jakllsch 		error = ENOTTY;
   1263   1.5  jakllsch 		break;
   1264   1.5  jakllsch 	}
   1265   1.5  jakllsch #endif
   1266   1.5  jakllsch 
   1267   1.5  jakllsch 	return error;
   1268   1.5  jakllsch }
   1269