Home | History | Annotate | Line # | Download | only in dev
vnet.c revision 1.2
      1  1.2  palle /*	$NetBSD: vnet.c,v 1.2 2021/03/04 20:59:39 palle Exp $	*/
      2  1.1  palle /*	$OpenBSD: vnet.c,v 1.62 2020/07/10 13:26:36 patrick Exp $	*/
      3  1.1  palle /*
      4  1.1  palle  * Copyright (c) 2009, 2015 Mark Kettenis
      5  1.1  palle  *
      6  1.1  palle  * Permission to use, copy, modify, and distribute this software for any
      7  1.1  palle  * purpose with or without fee is hereby granted, provided that the above
      8  1.1  palle  * copyright notice and this permission notice appear in all copies.
      9  1.1  palle  *
     10  1.1  palle  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     11  1.1  palle  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     12  1.1  palle  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     13  1.1  palle  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     14  1.1  palle  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     15  1.1  palle  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     16  1.1  palle  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     17  1.1  palle  */
     18  1.1  palle 
     19  1.1  palle #if 0
     20  1.1  palle FIXME openbsd
     21  1.1  palle #include "bpfilter.h"
     22  1.1  palle #endif
     23  1.1  palle 
     24  1.1  palle #include <sys/kmem.h>
     25  1.1  palle #include <sys/param.h>
     26  1.1  palle #include <sys/atomic.h>
     27  1.1  palle #include <sys/device.h>
     28  1.1  palle #include <sys/malloc.h>
     29  1.1  palle #include <sys/pool.h>
     30  1.1  palle #include <sys/mbuf.h>
     31  1.1  palle #include <sys/socket.h>
     32  1.1  palle #include <sys/sockio.h>
     33  1.1  palle #include <sys/systm.h>
     34  1.1  palle #if 0
     35  1.1  palle FIXME openbsd
     36  1.1  palle #include <sys/timeout.h>
     37  1.1  palle #endif
     38  1.1  palle 
     39  1.1  palle #include <machine/autoconf.h>
     40  1.1  palle #include <machine/hypervisor.h>
     41  1.1  palle #include <machine/openfirm.h>
     42  1.1  palle 
     43  1.1  palle #include <net/if.h>
     44  1.1  palle #include <net/if_media.h>
     45  1.1  palle 
     46  1.1  palle #include <netinet/in.h>
     47  1.1  palle #include <net/if_ether.h>
     48  1.1  palle 
     49  1.1  palle #if NBPFILTER > 0
     50  1.1  palle #include <net/bpf.h>
     51  1.1  palle #endif
     52  1.1  palle 
     53  1.1  palle #include <uvm/uvm_extern.h>
     54  1.1  palle 
     55  1.1  palle #include <sparc64/dev/cbusvar.h>
     56  1.1  palle #include <sparc64/dev/ldcvar.h>
     57  1.1  palle #include <sparc64/dev/viovar.h>
     58  1.1  palle 
     59  1.1  palle #ifdef VNET_DEBUG
     60  1.1  palle #define DPRINTF(x)	printf x
     61  1.1  palle #else
     62  1.1  palle #define DPRINTF(x)
     63  1.1  palle #endif
     64  1.1  palle 
     65  1.1  palle #define VNET_TX_ENTRIES		32
     66  1.1  palle #define VNET_RX_ENTRIES		32
     67  1.1  palle 
     68  1.1  palle struct vnet_attr_info {
     69  1.1  palle 	struct vio_msg_tag	tag;
     70  1.1  palle 	uint8_t			xfer_mode;
     71  1.1  palle 	uint8_t			addr_type;
     72  1.1  palle 	uint16_t		ack_freq;
     73  1.1  palle 	uint32_t		_reserved1;
     74  1.1  palle 	uint64_t		addr;
     75  1.1  palle 	uint64_t		mtu;
     76  1.1  palle 	uint64_t		_reserved2[3];
     77  1.1  palle };
     78  1.1  palle 
     79  1.1  palle /* Address types. */
     80  1.1  palle #define VNET_ADDR_ETHERMAC	0x01
     81  1.1  palle 
     82  1.1  palle /* Sub-Type envelopes. */
     83  1.1  palle #define VNET_MCAST_INFO		0x0101
     84  1.1  palle 
     85  1.1  palle #define VNET_NUM_MCAST		7
     86  1.1  palle 
     87  1.1  palle struct vnet_mcast_info {
     88  1.1  palle 	struct vio_msg_tag	tag;
     89  1.1  palle 	uint8_t			set;
     90  1.1  palle 	uint8_t			count;
     91  1.1  palle 	uint8_t			mcast_addr[VNET_NUM_MCAST][ETHER_ADDR_LEN];
     92  1.1  palle 	uint32_t		_reserved;
     93  1.1  palle };
     94  1.1  palle 
     95  1.1  palle struct vnet_desc {
     96  1.1  palle 	struct vio_dring_hdr	hdr;
     97  1.1  palle 	uint32_t		nbytes;
     98  1.1  palle 	uint32_t		ncookies;
     99  1.1  palle 	struct ldc_cookie	cookie[2];
    100  1.1  palle };
    101  1.1  palle 
    102  1.1  palle struct vnet_desc_msg {
    103  1.1  palle 	struct vio_msg_tag	tag;
    104  1.1  palle 	uint64_t		seq_no;
    105  1.1  palle 	uint64_t		desc_handle;
    106  1.1  palle 	uint32_t		nbytes;
    107  1.1  palle 	uint32_t		ncookies;
    108  1.1  palle 	struct ldc_cookie	cookie[1];
    109  1.1  palle };
    110  1.1  palle 
    111  1.1  palle struct vnet_dring {
    112  1.1  palle 	bus_dmamap_t		vd_map;
    113  1.1  palle 	bus_dma_segment_t	vd_seg;
    114  1.1  palle 	struct vnet_desc	*vd_desc;
    115  1.1  palle 	int			vd_nentries;
    116  1.1  palle };
    117  1.1  palle 
    118  1.1  palle struct vnet_dring *vnet_dring_alloc(bus_dma_tag_t, int);
    119  1.1  palle void	vnet_dring_free(bus_dma_tag_t, struct vnet_dring *);
    120  1.1  palle 
    121  1.1  palle /*
    122  1.1  palle  * For now, we only support vNet 1.0.
    123  1.1  palle  */
    124  1.1  palle #define VNET_MAJOR	1
    125  1.1  palle #define VNET_MINOR	0
    126  1.1  palle 
    127  1.1  palle /*
    128  1.1  palle  * The vNet protocol wants the IP header to be 64-bit aligned, so
    129  1.1  palle  * define out own variant of ETHER_ALIGN.
    130  1.1  palle  */
    131  1.1  palle #define VNET_ETHER_ALIGN	6
    132  1.1  palle 
    133  1.1  palle struct vnet_soft_desc {
    134  1.1  palle 	int		vsd_map_idx;
    135  1.1  palle #if 0
    136  1.1  palle FIXME openbsd
    137  1.1  palle 	caddr_t		vsd_buf;
    138  1.1  palle #else
    139  1.1  palle 	unsigned char *vsd_buf;
    140  1.1  palle #endif
    141  1.1  palle };
    142  1.1  palle 
    143  1.1  palle struct vnet_softc {
    144  1.1  palle 	struct device	sc_dv;
    145  1.1  palle 	bus_space_tag_t	sc_bustag;
    146  1.1  palle 	bus_dma_tag_t	sc_dmatag;
    147  1.1  palle 
    148  1.1  palle 	uint64_t	sc_tx_ino;
    149  1.1  palle 	uint64_t	sc_rx_ino;
    150  1.1  palle 	void		*sc_tx_ih;
    151  1.1  palle 	void		*sc_rx_ih;
    152  1.1  palle 
    153  1.1  palle 	struct ldc_conn	sc_lc;
    154  1.1  palle 
    155  1.1  palle 	uint16_t	sc_vio_state;
    156  1.1  palle #define VIO_SND_VER_INFO	0x0001
    157  1.1  palle #define VIO_ACK_VER_INFO	0x0002
    158  1.1  palle #define VIO_RCV_VER_INFO	0x0004
    159  1.1  palle #define VIO_SND_ATTR_INFO	0x0008
    160  1.1  palle #define VIO_ACK_ATTR_INFO	0x0010
    161  1.1  palle #define VIO_RCV_ATTR_INFO	0x0020
    162  1.1  palle #define VIO_SND_DRING_REG	0x0040
    163  1.1  palle #define VIO_ACK_DRING_REG	0x0080
    164  1.1  palle #define VIO_RCV_DRING_REG	0x0100
    165  1.1  palle #define VIO_SND_RDX		0x0200
    166  1.1  palle #define VIO_ACK_RDX		0x0400
    167  1.1  palle #define VIO_RCV_RDX		0x0800
    168  1.1  palle 
    169  1.1  palle #if 0
    170  1.1  palle FIXME openbsd
    171  1.1  palle 	struct timeout	sc_handshake_to;
    172  1.1  palle #endif
    173  1.1  palle 
    174  1.1  palle 	uint8_t		sc_xfer_mode;
    175  1.1  palle 
    176  1.1  palle 	uint32_t	sc_local_sid;
    177  1.1  palle 	uint64_t	sc_dring_ident;
    178  1.1  palle 	uint64_t	sc_seq_no;
    179  1.1  palle 
    180  1.1  palle 	u_int		sc_tx_prod;
    181  1.1  palle 	u_int		sc_tx_cons;
    182  1.1  palle 
    183  1.1  palle 	u_int		sc_peer_state;
    184  1.1  palle 
    185  1.1  palle 	struct ldc_map	*sc_lm;
    186  1.1  palle 	struct vnet_dring *sc_vd;
    187  1.1  palle 	struct vnet_soft_desc *sc_vsd;
    188  1.1  palle #define VNET_NUM_SOFT_DESC	128
    189  1.1  palle 
    190  1.1  palle 	size_t		sc_peer_desc_size;
    191  1.1  palle 	struct ldc_cookie sc_peer_dring_cookie;
    192  1.1  palle 	int		sc_peer_dring_nentries;
    193  1.1  palle 
    194  1.1  palle 	struct pool	sc_pool;
    195  1.1  palle 
    196  1.1  palle 	struct ethercom	sc_ethercom;
    197  1.1  palle 	struct ifmedia	sc_media;
    198  1.1  palle 	u_int8_t sc_macaddr[ETHER_ADDR_LEN];
    199  1.1  palle };
    200  1.1  palle 
    201  1.1  palle int vnet_match (device_t, cfdata_t, void *);
    202  1.1  palle void vnet_attach (device_t, device_t, void *);
    203  1.1  palle 
    204  1.1  palle CFATTACH_DECL_NEW(vnet, sizeof(struct vnet_softc),
    205  1.1  palle     vnet_match, vnet_attach, NULL, NULL);
    206  1.1  palle 
    207  1.1  palle int	vnet_tx_intr(void *);
    208  1.1  palle int	vnet_rx_intr(void *);
    209  1.1  palle void	vnet_handshake(void *);
    210  1.1  palle 
    211  1.1  palle void	vio_rx_data(struct ldc_conn *, struct ldc_pkt *);
    212  1.1  palle void	vnet_rx_vio_ctrl(struct vnet_softc *, struct vio_msg *);
    213  1.1  palle void	vnet_rx_vio_ver_info(struct vnet_softc *, struct vio_msg_tag *);
    214  1.1  palle void	vnet_rx_vio_attr_info(struct vnet_softc *, struct vio_msg_tag *);
    215  1.1  palle void	vnet_rx_vio_dring_reg(struct vnet_softc *, struct vio_msg_tag *);
    216  1.1  palle void	vnet_rx_vio_rdx(struct vnet_softc *sc, struct vio_msg_tag *);
    217  1.1  palle void	vnet_rx_vio_data(struct vnet_softc *sc, struct vio_msg *);
    218  1.1  palle void	vnet_rx_vio_desc_data(struct vnet_softc *sc, struct vio_msg_tag *);
    219  1.1  palle void	vnet_rx_vio_dring_data(struct vnet_softc *sc, struct vio_msg_tag *);
    220  1.1  palle 
    221  1.1  palle void	vnet_ldc_reset(struct ldc_conn *);
    222  1.1  palle void	vnet_ldc_start(struct ldc_conn *);
    223  1.1  palle 
    224  1.1  palle void	vnet_sendmsg(struct vnet_softc *, void *, size_t);
    225  1.1  palle void	vnet_send_ver_info(struct vnet_softc *, uint16_t, uint16_t);
    226  1.1  palle void	vnet_send_attr_info(struct vnet_softc *);
    227  1.1  palle void	vnet_send_dring_reg(struct vnet_softc *);
    228  1.1  palle void	vio_send_rdx(struct vnet_softc *);
    229  1.1  palle void	vnet_send_dring_data(struct vnet_softc *, uint32_t);
    230  1.1  palle 
    231  1.1  palle void	vnet_start(struct ifnet *);
    232  1.1  palle void	vnet_start_desc(struct ifnet *);
    233  1.1  palle int		vnet_ioctl (struct ifnet *, u_long, void *);
    234  1.1  palle void	vnet_watchdog(struct ifnet *);
    235  1.1  palle 
    236  1.1  palle int		vnet_media_change(struct ifnet *);
    237  1.1  palle void	vnet_media_status(struct ifnet *, struct ifmediareq *);
    238  1.1  palle 
    239  1.1  palle void	vnet_link_state(struct vnet_softc *sc);
    240  1.1  palle 
    241  1.1  palle void	vnet_setmulti(struct vnet_softc *, int);
    242  1.1  palle 
    243  1.1  palle void	vnet_init(struct ifnet *);
    244  1.1  palle void	vnet_stop(struct ifnet *);
    245  1.1  palle 
    246  1.1  palle int vnet_match(device_t parent, cfdata_t match, void *aux)
    247  1.1  palle {
    248  1.1  palle 
    249  1.1  palle 	struct cbus_attach_args *ca = aux;
    250  1.1  palle 	if (strcmp(ca->ca_name, "network") == 0)
    251  1.1  palle 		return (1);
    252  1.1  palle 
    253  1.1  palle 	return (0);
    254  1.1  palle }
    255  1.1  palle 
    256  1.1  palle void
    257  1.1  palle vnet_attach(struct device *parent, struct device *self, void *aux)
    258  1.1  palle {
    259  1.1  palle 	struct vnet_softc *sc = device_private(self);
    260  1.1  palle 	struct cbus_attach_args *ca = aux;
    261  1.1  palle 	struct ldc_conn *lc;
    262  1.1  palle 	struct ifnet *ifp;
    263  1.1  palle 
    264  1.1  palle 	sc->sc_bustag = ca->ca_bustag;
    265  1.1  palle 	sc->sc_dmatag = ca->ca_dmatag;
    266  1.1  palle 	sc->sc_tx_ino = ca->ca_tx_ino;
    267  1.1  palle 	sc->sc_rx_ino = ca->ca_rx_ino;
    268  1.1  palle 
    269  1.2  palle 	printf(": ivec 0x%" PRIx64 ", 0x%" PRIx64, sc->sc_tx_ino, sc->sc_rx_ino);
    270  1.1  palle 
    271  1.1  palle 	/*
    272  1.1  palle 	 * Un-configure queues before registering interrupt handlers,
    273  1.1  palle 	 * such that we dont get any stale LDC packets or events.
    274  1.1  palle 	 */
    275  1.1  palle 	hv_ldc_tx_qconf(ca->ca_id, 0, 0);
    276  1.1  palle 	hv_ldc_rx_qconf(ca->ca_id, 0, 0);
    277  1.1  palle 
    278  1.1  palle #if 0
    279  1.1  palle FIXME openbsd
    280  1.1  palle 	sc->sc_tx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_tx_ino,
    281  1.1  palle 	    IPL_NET, BUS_INTR_ESTABLISH_MPSAFE, vnet_tx_intr,
    282  1.1  palle 	    sc, sc->sc_dv.dv_xname);
    283  1.1  palle 	sc->sc_rx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_rx_ino,
    284  1.1  palle 	    IPL_NET, BUS_INTR_ESTABLISH_MPSAFE, vnet_rx_intr,
    285  1.1  palle 	    sc, sc->sc_dv.dv_xname);
    286  1.1  palle 	if (sc->sc_tx_ih == NULL || sc->sc_rx_ih == NULL) {
    287  1.1  palle 		printf(", can't establish interrupt\n");
    288  1.1  palle 		return;
    289  1.1  palle 	}
    290  1.1  palle #else
    291  1.1  palle 	sc->sc_tx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_tx_ino,
    292  1.1  palle 	    IPL_NET, vnet_tx_intr, sc);
    293  1.1  palle 	sc->sc_rx_ih = bus_intr_establish(ca->ca_bustag, sc->sc_rx_ino,
    294  1.1  palle 	    IPL_NET, vnet_rx_intr, sc);
    295  1.1  palle 	if (sc->sc_tx_ih == NULL || sc->sc_rx_ih == NULL) {
    296  1.1  palle 		printf(", can't establish interrupts\n");
    297  1.1  palle 		return;
    298  1.1  palle 	}
    299  1.1  palle #endif
    300  1.1  palle 
    301  1.1  palle 	lc = &sc->sc_lc;
    302  1.1  palle 	lc->lc_id = ca->ca_id;
    303  1.1  palle 	lc->lc_sc = sc;
    304  1.1  palle 	lc->lc_reset = vnet_ldc_reset;
    305  1.1  palle 	lc->lc_start = vnet_ldc_start;
    306  1.1  palle 	lc->lc_rx_data = vio_rx_data;
    307  1.1  palle 
    308  1.1  palle #if 0
    309  1.1  palle FIXME openbsd
    310  1.1  palle 	timeout_set(&sc->sc_handshake_to, vnet_handshake, sc);
    311  1.1  palle #endif
    312  1.1  palle 	sc->sc_peer_state = VIO_DP_STOPPED;
    313  1.1  palle 
    314  1.1  palle #if OPENBSD_BUSDMA
    315  1.1  palle 	lc->lc_txq = ldc_queue_alloc(sc->sc_dmatag, VNET_TX_ENTRIES);
    316  1.1  palle 	if (lc->lc_txq == NULL) {
    317  1.1  palle 		printf(", can't allocate tx queue\n");
    318  1.1  palle 		return;
    319  1.1  palle 	}
    320  1.1  palle 
    321  1.1  palle 	lc->lc_rxq = ldc_queue_alloc(sc->sc_dmatag, VNET_RX_ENTRIES);
    322  1.1  palle 	if (lc->lc_rxq == NULL) {
    323  1.1  palle 		printf(", can't allocate rx queue\n");
    324  1.1  palle 		goto free_txqueue;
    325  1.1  palle 	}
    326  1.1  palle #else
    327  1.1  palle 	lc->lc_txq = ldc_queue_alloc(VNET_TX_ENTRIES);
    328  1.1  palle 	if (lc->lc_txq == NULL) {
    329  1.1  palle 		printf(", can't allocate tx queue\n");
    330  1.1  palle 		return;
    331  1.1  palle 	}
    332  1.1  palle 
    333  1.1  palle 	lc->lc_rxq = ldc_queue_alloc(VNET_RX_ENTRIES);
    334  1.1  palle 	if (lc->lc_rxq == NULL) {
    335  1.1  palle 		printf(", can't allocate rx queue\n");
    336  1.1  palle 		goto free_txqueue;
    337  1.1  palle 	}
    338  1.1  palle #endif
    339  1.1  palle 
    340  1.1  palle 	if (OF_getprop(ca->ca_node, "local-mac-address",
    341  1.1  palle 				   sc->sc_macaddr, ETHER_ADDR_LEN) > 0) {
    342  1.1  palle 		printf(", address %s", ether_sprintf(sc->sc_macaddr));
    343  1.1  palle 	} else {
    344  1.1  palle 		printf(", cannot retrieve local mac address\n");
    345  1.1  palle 		return;
    346  1.1  palle 	}
    347  1.1  palle 
    348  1.1  palle 	/*
    349  1.1  palle 	 * Each interface gets its own pool.
    350  1.1  palle 	 */
    351  1.1  palle #if 0
    352  1.1  palle FIXME openbsd
    353  1.1  palle 	pool_init(&sc->sc_pool, 2048, 0, IPL_NET, 0, sc->sc_dv.dv_xname, NULL);
    354  1.1  palle #else
    355  1.1  palle 	pool_init(&sc->sc_pool, 2048, 0, 0, 0, sc->sc_dv.dv_xname, NULL, IPL_NET);
    356  1.1  palle #endif
    357  1.1  palle 
    358  1.1  palle 	ifp = &sc->sc_ethercom.ec_if;
    359  1.1  palle 	ifp->if_softc = sc;
    360  1.1  palle 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    361  1.1  palle 	ifp->if_link_state = LINK_STATE_DOWN;
    362  1.1  palle 	ifp->if_ioctl = vnet_ioctl;
    363  1.1  palle 	ifp->if_start = vnet_start;
    364  1.1  palle 	ifp->if_watchdog = vnet_watchdog;
    365  1.1  palle 	strlcpy(ifp->if_xname, device_xname(self), IFNAMSIZ);
    366  1.1  palle #if 0
    367  1.1  palle FIXME openbsd
    368  1.1  palle 	ifq_set_maxlen(&ifp->if_snd, 31); /* XXX */
    369  1.1  palle #else
    370  1.1  palle  IFQ_SET_MAXLEN(&ifp->if_snd, 31); /* XXX */
    371  1.1  palle #endif
    372  1.1  palle 
    373  1.1  palle 	ifmedia_init(&sc->sc_media, 0, vnet_media_change, vnet_media_status);
    374  1.1  palle 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_AUTO, 0, NULL);
    375  1.1  palle 	ifmedia_set(&sc->sc_media, IFM_ETHER | IFM_AUTO);
    376  1.1  palle 
    377  1.1  palle 	int error = if_initialize(ifp);
    378  1.1  palle 	if (error != 0) {
    379  1.1  palle 		printf(", if_initialize() failed\n");
    380  1.1  palle 		return;
    381  1.1  palle 	}
    382  1.1  palle 	ether_ifattach(ifp, sc->sc_macaddr);
    383  1.1  palle 	if_register(ifp);
    384  1.1  palle 
    385  1.1  palle 	printf("\n");
    386  1.1  palle 	return;
    387  1.1  palle free_txqueue:
    388  1.1  palle #if OPENBSD_BUSDMA
    389  1.1  palle 	ldc_queue_free(sc->sc_dmatag, lc->lc_txq);
    390  1.1  palle #else
    391  1.1  palle 	ldc_queue_free(lc->lc_txq);
    392  1.1  palle #endif
    393  1.1  palle }
    394  1.1  palle 
    395  1.1  palle int
    396  1.1  palle vnet_tx_intr(void *arg)
    397  1.1  palle {
    398  1.1  palle 	DPRINTF(("%s: entry\n", __func__));
    399  1.1  palle 
    400  1.1  palle 	struct vnet_softc *sc = arg;
    401  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
    402  1.1  palle 	uint64_t tx_head, tx_tail, tx_state;
    403  1.1  palle 
    404  1.1  palle 	hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
    405  1.1  palle 	if (tx_state != lc->lc_tx_state) {
    406  1.1  palle 		switch (tx_state) {
    407  1.1  palle 		case LDC_CHANNEL_DOWN:
    408  1.1  palle 			DPRINTF(("%s: Tx link down\n", __func__));
    409  1.1  palle 			break;
    410  1.1  palle 		case LDC_CHANNEL_UP:
    411  1.1  palle 			DPRINTF(("%s: Tx link up\n", __func__));
    412  1.1  palle 			break;
    413  1.1  palle 		case LDC_CHANNEL_RESET:
    414  1.1  palle 			DPRINTF(("%s: Tx link reset\n", __func__));
    415  1.1  palle 			break;
    416  1.1  palle 		}
    417  1.1  palle 		lc->lc_tx_state = tx_state;
    418  1.1  palle 	}
    419  1.1  palle 
    420  1.1  palle 	DPRINTF(("%s: exit\n", __func__));
    421  1.1  palle 	return (1);
    422  1.1  palle }
    423  1.1  palle 
    424  1.1  palle int
    425  1.1  palle vnet_rx_intr(void *arg)
    426  1.1  palle {
    427  1.1  palle 	DPRINTF(("%s: entry\n", __func__));
    428  1.1  palle 
    429  1.1  palle 	struct vnet_softc *sc = arg;
    430  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
    431  1.1  palle 	uint64_t rx_head, rx_tail, rx_state;
    432  1.1  palle 	struct ldc_pkt *lp;
    433  1.1  palle 	int err;
    434  1.1  palle 
    435  1.1  palle 	err = hv_ldc_rx_get_state(lc->lc_id, &rx_head, &rx_tail, &rx_state);
    436  1.1  palle 	if (err == H_EINVAL)
    437  1.1  palle 		return (0);
    438  1.1  palle 	if (err != H_EOK) {
    439  1.1  palle 		printf("hv_ldc_rx_get_state %d\n", err);
    440  1.1  palle 		return (0);
    441  1.1  palle 	}
    442  1.1  palle 
    443  1.1  palle 	if (rx_state != lc->lc_rx_state) {
    444  1.1  palle 		switch (rx_state) {
    445  1.1  palle 		case LDC_CHANNEL_DOWN:
    446  1.1  palle 			DPRINTF(("%s: Rx link down\n", __func__));
    447  1.1  palle 			lc->lc_tx_seqid = 0;
    448  1.1  palle 			lc->lc_state = 0;
    449  1.1  palle 			lc->lc_reset(lc);
    450  1.1  palle 			if (rx_head == rx_tail)
    451  1.1  palle 				break;
    452  1.1  palle 			/* Discard and ack pending I/O. */
    453  1.1  palle 			DPRINTF(("setting rx qhead to %lld\n", rx_tail));
    454  1.1  palle 			err = hv_ldc_rx_set_qhead(lc->lc_id, rx_tail);
    455  1.1  palle 			if (err == H_EOK)
    456  1.1  palle 				break;
    457  1.1  palle 			printf("%s: hv_ldc_rx_set_qhead %d\n", __func__, err);
    458  1.1  palle 			break;
    459  1.1  palle 		case LDC_CHANNEL_UP:
    460  1.1  palle 			DPRINTF(("%s: Rx link up\n", __func__));
    461  1.1  palle #if 0
    462  1.1  palle FIXME openbsd
    463  1.1  palle 			timeout_add_msec(&sc->sc_handshake_to, 500);
    464  1.1  palle #endif
    465  1.1  palle 			break;
    466  1.1  palle 		case LDC_CHANNEL_RESET:
    467  1.1  palle 			DPRINTF(("%s: Rx link reset\n", __func__));
    468  1.1  palle 			lc->lc_tx_seqid = 0;
    469  1.1  palle 			lc->lc_state = 0;
    470  1.1  palle 			lc->lc_reset(lc);
    471  1.1  palle #if 0
    472  1.1  palle FIXME openbsd
    473  1.1  palle 			timeout_add_msec(&sc->sc_handshake_to, 500);
    474  1.1  palle #endif
    475  1.1  palle 			if (rx_head == rx_tail)
    476  1.1  palle 				break;
    477  1.1  palle 			/* Discard and ack pending I/O. */
    478  1.1  palle 			DPRINTF(("setting rx qhead to %lld\n", rx_tail));
    479  1.1  palle 			err = hv_ldc_rx_set_qhead(lc->lc_id, rx_tail);
    480  1.1  palle 			if (err == H_EOK)
    481  1.1  palle 				break;
    482  1.1  palle 			printf("%s: hv_ldc_rx_set_qhead %d\n", __func__, err);
    483  1.1  palle 			break;
    484  1.1  palle 		}
    485  1.1  palle 		lc->lc_rx_state = rx_state;
    486  1.1  palle 		return (1);
    487  1.1  palle 	}
    488  1.1  palle 
    489  1.1  palle 	if (rx_head == rx_tail)
    490  1.1  palle 		return (0);
    491  1.1  palle 
    492  1.2  palle 	lp = (struct ldc_pkt *)(uintptr_t)(lc->lc_rxq->lq_va + rx_head);
    493  1.1  palle 	switch (lp->type) {
    494  1.1  palle 	case LDC_CTRL:
    495  1.1  palle 		ldc_rx_ctrl(lc, lp);
    496  1.1  palle 		break;
    497  1.1  palle 
    498  1.1  palle 	case LDC_DATA:
    499  1.1  palle 		ldc_rx_data(lc, lp);
    500  1.1  palle 		break;
    501  1.1  palle 
    502  1.1  palle 	default:
    503  1.1  palle 		DPRINTF(("%0x02/%0x02/%0x02\n", lp->type, lp->stype,
    504  1.1  palle 		    lp->ctrl));
    505  1.1  palle 		ldc_reset(lc);
    506  1.1  palle 		break;
    507  1.1  palle 	}
    508  1.1  palle 
    509  1.1  palle 	if (lc->lc_state == 0)
    510  1.1  palle 		return (1);
    511  1.1  palle 
    512  1.1  palle 	rx_head += sizeof(*lp);
    513  1.1  palle 	rx_head &= ((lc->lc_rxq->lq_nentries * sizeof(*lp)) - 1);
    514  1.1  palle 	err = hv_ldc_rx_set_qhead(lc->lc_id, rx_head);
    515  1.1  palle 	if (err != H_EOK)
    516  1.1  palle 		printf("%s: hv_ldc_rx_set_qhead %d\n", __func__, err);
    517  1.1  palle 
    518  1.1  palle 	DPRINTF(("%s: exit\n", __func__));
    519  1.1  palle 	return (1);
    520  1.1  palle }
    521  1.1  palle 
    522  1.1  palle void
    523  1.1  palle vnet_handshake(void *arg)
    524  1.1  palle {
    525  1.1  palle 	struct vnet_softc *sc = arg;
    526  1.1  palle 
    527  1.1  palle 	ldc_send_vers(&sc->sc_lc);
    528  1.1  palle }
    529  1.1  palle 
    530  1.1  palle void
    531  1.1  palle vio_rx_data(struct ldc_conn *lc, struct ldc_pkt *lp)
    532  1.1  palle {
    533  1.1  palle 	struct vio_msg *vm = (struct vio_msg *)lp;
    534  1.1  palle 
    535  1.1  palle 	switch (vm->type) {
    536  1.1  palle 	case VIO_TYPE_CTRL:
    537  1.1  palle 		if ((lp->env & LDC_FRAG_START) == 0 &&
    538  1.1  palle 		    (lp->env & LDC_FRAG_STOP) == 0)
    539  1.1  palle 			return;
    540  1.1  palle 		vnet_rx_vio_ctrl(lc->lc_sc, vm);
    541  1.1  palle 		break;
    542  1.1  palle 
    543  1.1  palle 	case VIO_TYPE_DATA:
    544  1.1  palle 		if((lp->env & LDC_FRAG_START) == 0)
    545  1.1  palle 			return;
    546  1.1  palle 		vnet_rx_vio_data(lc->lc_sc, vm);
    547  1.1  palle 		break;
    548  1.1  palle 
    549  1.1  palle 	default:
    550  1.1  palle 		DPRINTF(("Unhandled packet type 0x%02x\n", vm->type));
    551  1.1  palle 		ldc_reset(lc);
    552  1.1  palle 		break;
    553  1.1  palle 	}
    554  1.1  palle }
    555  1.1  palle 
    556  1.1  palle void
    557  1.1  palle vnet_rx_vio_ctrl(struct vnet_softc *sc, struct vio_msg *vm)
    558  1.1  palle {
    559  1.1  palle 	struct vio_msg_tag *tag = (struct vio_msg_tag *)&vm->type;
    560  1.1  palle 
    561  1.1  palle 	switch (tag->stype_env) {
    562  1.1  palle 	case VIO_VER_INFO:
    563  1.1  palle 		vnet_rx_vio_ver_info(sc, tag);
    564  1.1  palle 		break;
    565  1.1  palle 	case VIO_ATTR_INFO:
    566  1.1  palle 		vnet_rx_vio_attr_info(sc, tag);
    567  1.1  palle 		break;
    568  1.1  palle 	case VIO_DRING_REG:
    569  1.1  palle 		vnet_rx_vio_dring_reg(sc, tag);
    570  1.1  palle 		break;
    571  1.1  palle 	case VIO_RDX:
    572  1.1  palle 		vnet_rx_vio_rdx(sc, tag);
    573  1.1  palle 		break;
    574  1.1  palle 	default:
    575  1.1  palle 		DPRINTF(("CTRL/0x%02x/0x%04x\n", tag->stype, tag->stype_env));
    576  1.1  palle 		break;
    577  1.1  palle 	}
    578  1.1  palle }
    579  1.1  palle 
    580  1.1  palle void
    581  1.1  palle vnet_rx_vio_ver_info(struct vnet_softc *sc, struct vio_msg_tag *tag)
    582  1.1  palle {
    583  1.1  palle 	struct vio_ver_info *vi = (struct vio_ver_info *)tag;
    584  1.1  palle 
    585  1.1  palle 	switch (vi->tag.stype) {
    586  1.1  palle 	case VIO_SUBTYPE_INFO:
    587  1.1  palle 		DPRINTF(("CTRL/INFO/VER_INFO\n"));
    588  1.1  palle 
    589  1.1  palle 		/* Make sure we're talking to a virtual network device. */
    590  1.1  palle 		if (vi->dev_class != VDEV_NETWORK &&
    591  1.1  palle 		    vi->dev_class != VDEV_NETWORK_SWITCH) {
    592  1.1  palle 			/* Huh, we're not talking to a network device? */
    593  1.1  palle 			printf("Not a network device\n");
    594  1.1  palle 			vi->tag.stype = VIO_SUBTYPE_NACK;
    595  1.1  palle 			vnet_sendmsg(sc, vi, sizeof(*vi));
    596  1.1  palle 			return;
    597  1.1  palle 		}
    598  1.1  palle 
    599  1.1  palle 		if (vi->major != VNET_MAJOR) {
    600  1.1  palle 			vi->tag.stype = VIO_SUBTYPE_NACK;
    601  1.1  palle 			vi->major = VNET_MAJOR;
    602  1.1  palle 			vi->minor = VNET_MINOR;
    603  1.1  palle 			vnet_sendmsg(sc, vi, sizeof(*vi));
    604  1.1  palle 			return;
    605  1.1  palle 		}
    606  1.1  palle 
    607  1.1  palle 		vi->tag.stype = VIO_SUBTYPE_ACK;
    608  1.1  palle 		vi->tag.sid = sc->sc_local_sid;
    609  1.1  palle 		vi->minor = VNET_MINOR;
    610  1.1  palle 		vnet_sendmsg(sc, vi, sizeof(*vi));
    611  1.1  palle 		sc->sc_vio_state |= VIO_RCV_VER_INFO;
    612  1.1  palle 		break;
    613  1.1  palle 
    614  1.1  palle 	case VIO_SUBTYPE_ACK:
    615  1.1  palle 		DPRINTF(("CTRL/ACK/VER_INFO\n"));
    616  1.1  palle 		if (!ISSET(sc->sc_vio_state, VIO_SND_VER_INFO)) {
    617  1.1  palle 			ldc_reset(&sc->sc_lc);
    618  1.1  palle 			break;
    619  1.1  palle 		}
    620  1.1  palle 		sc->sc_vio_state |= VIO_ACK_VER_INFO;
    621  1.1  palle 		break;
    622  1.1  palle 
    623  1.1  palle 	default:
    624  1.1  palle 		DPRINTF(("CTRL/0x%02x/VER_INFO\n", vi->tag.stype));
    625  1.1  palle 		break;
    626  1.1  palle 	}
    627  1.1  palle 
    628  1.1  palle 	if (ISSET(sc->sc_vio_state, VIO_RCV_VER_INFO) &&
    629  1.1  palle 	    ISSET(sc->sc_vio_state, VIO_ACK_VER_INFO))
    630  1.1  palle 		vnet_send_attr_info(sc);
    631  1.1  palle }
    632  1.1  palle 
    633  1.1  palle void
    634  1.1  palle vnet_rx_vio_attr_info(struct vnet_softc *sc, struct vio_msg_tag *tag)
    635  1.1  palle {
    636  1.1  palle 	struct vnet_attr_info *ai = (struct vnet_attr_info *)tag;
    637  1.1  palle 
    638  1.1  palle 	switch (ai->tag.stype) {
    639  1.1  palle 	case VIO_SUBTYPE_INFO:
    640  1.1  palle 		DPRINTF(("CTRL/INFO/ATTR_INFO\n"));
    641  1.1  palle 		sc->sc_xfer_mode = ai->xfer_mode;
    642  1.1  palle 
    643  1.1  palle 		ai->tag.stype = VIO_SUBTYPE_ACK;
    644  1.1  palle 		ai->tag.sid = sc->sc_local_sid;
    645  1.1  palle 		vnet_sendmsg(sc, ai, sizeof(*ai));
    646  1.1  palle 		sc->sc_vio_state |= VIO_RCV_ATTR_INFO;
    647  1.1  palle 		break;
    648  1.1  palle 
    649  1.1  palle 	case VIO_SUBTYPE_ACK:
    650  1.1  palle 		DPRINTF(("CTRL/ACK/ATTR_INFO\n"));
    651  1.1  palle 		if (!ISSET(sc->sc_vio_state, VIO_SND_ATTR_INFO)) {
    652  1.1  palle 			ldc_reset(&sc->sc_lc);
    653  1.1  palle 			break;
    654  1.1  palle 		}
    655  1.1  palle 		sc->sc_vio_state |= VIO_ACK_ATTR_INFO;
    656  1.1  palle 		break;
    657  1.1  palle 
    658  1.1  palle 	default:
    659  1.1  palle 		DPRINTF(("CTRL/0x%02x/ATTR_INFO\n", ai->tag.stype));
    660  1.1  palle 		break;
    661  1.1  palle 	}
    662  1.1  palle 
    663  1.1  palle 	if (ISSET(sc->sc_vio_state, VIO_RCV_ATTR_INFO) &&
    664  1.1  palle 	    ISSET(sc->sc_vio_state, VIO_ACK_ATTR_INFO)) {
    665  1.1  palle 		if (sc->sc_xfer_mode == VIO_DRING_MODE)
    666  1.1  palle 			vnet_send_dring_reg(sc);
    667  1.1  palle 		else
    668  1.1  palle 			vio_send_rdx(sc);
    669  1.1  palle 	}
    670  1.1  palle }
    671  1.1  palle 
    672  1.1  palle void
    673  1.1  palle vnet_rx_vio_dring_reg(struct vnet_softc *sc, struct vio_msg_tag *tag)
    674  1.1  palle {
    675  1.1  palle 	struct vio_dring_reg *dr = (struct vio_dring_reg *)tag;
    676  1.1  palle 
    677  1.1  palle 	switch (dr->tag.stype) {
    678  1.1  palle 	case VIO_SUBTYPE_INFO:
    679  1.1  palle 		DPRINTF(("CTRL/INFO/DRING_REG\n"));
    680  1.1  palle 
    681  1.1  palle 		sc->sc_peer_dring_nentries = dr->num_descriptors;
    682  1.1  palle 		sc->sc_peer_desc_size = dr->descriptor_size;
    683  1.1  palle 		sc->sc_peer_dring_cookie = dr->cookie[0];
    684  1.1  palle 
    685  1.1  palle 		dr->tag.stype = VIO_SUBTYPE_ACK;
    686  1.1  palle 		dr->tag.sid = sc->sc_local_sid;
    687  1.1  palle 		vnet_sendmsg(sc, dr, sizeof(*dr));
    688  1.1  palle 		sc->sc_vio_state |= VIO_RCV_DRING_REG;
    689  1.1  palle 		break;
    690  1.1  palle 
    691  1.1  palle 	case VIO_SUBTYPE_ACK:
    692  1.1  palle 		DPRINTF(("CTRL/ACK/DRING_REG\n"));
    693  1.1  palle 		if (!ISSET(sc->sc_vio_state, VIO_SND_DRING_REG)) {
    694  1.1  palle 			ldc_reset(&sc->sc_lc);
    695  1.1  palle 			break;
    696  1.1  palle 		}
    697  1.1  palle 
    698  1.1  palle 		sc->sc_dring_ident = dr->dring_ident;
    699  1.1  palle 		sc->sc_seq_no = 1;
    700  1.1  palle 
    701  1.1  palle 		sc->sc_vio_state |= VIO_ACK_DRING_REG;
    702  1.1  palle 		break;
    703  1.1  palle 
    704  1.1  palle 	default:
    705  1.1  palle 		DPRINTF(("CTRL/0x%02x/DRING_REG\n", dr->tag.stype));
    706  1.1  palle 		break;
    707  1.1  palle 	}
    708  1.1  palle 
    709  1.1  palle 	if (ISSET(sc->sc_vio_state, VIO_RCV_DRING_REG) &&
    710  1.1  palle 	    ISSET(sc->sc_vio_state, VIO_ACK_DRING_REG))
    711  1.1  palle 		vio_send_rdx(sc);
    712  1.1  palle }
    713  1.1  palle 
    714  1.1  palle void
    715  1.1  palle vnet_rx_vio_rdx(struct vnet_softc *sc, struct vio_msg_tag *tag)
    716  1.1  palle {
    717  1.1  palle #if 0
    718  1.1  palle FIXME openbsd
    719  1.1  palle 	struct ifnet *ifp = &sc->sc_ac.ac_if;
    720  1.1  palle #else
    721  1.1  palle 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
    722  1.1  palle #endif
    723  1.1  palle 
    724  1.1  palle 	switch(tag->stype) {
    725  1.1  palle 	case VIO_SUBTYPE_INFO:
    726  1.1  palle 		DPRINTF(("CTRL/INFO/RDX\n"));
    727  1.1  palle 
    728  1.1  palle 		tag->stype = VIO_SUBTYPE_ACK;
    729  1.1  palle 		tag->sid = sc->sc_local_sid;
    730  1.1  palle 		vnet_sendmsg(sc, tag, sizeof(*tag));
    731  1.1  palle 		sc->sc_vio_state |= VIO_RCV_RDX;
    732  1.1  palle 		break;
    733  1.1  palle 
    734  1.1  palle 	case VIO_SUBTYPE_ACK:
    735  1.1  palle 		DPRINTF(("CTRL/ACK/RDX\n"));
    736  1.1  palle 		if (!ISSET(sc->sc_vio_state, VIO_SND_RDX)) {
    737  1.1  palle 			ldc_reset(&sc->sc_lc);
    738  1.1  palle 			break;
    739  1.1  palle 		}
    740  1.1  palle 		sc->sc_vio_state |= VIO_ACK_RDX;
    741  1.1  palle 		break;
    742  1.1  palle 
    743  1.1  palle 	default:
    744  1.1  palle 		DPRINTF(("CTRL/0x%02x/RDX (VIO)\n", tag->stype));
    745  1.1  palle 		break;
    746  1.1  palle 	}
    747  1.1  palle 
    748  1.1  palle 	if (ISSET(sc->sc_vio_state, VIO_RCV_RDX) &&
    749  1.1  palle 	    ISSET(sc->sc_vio_state, VIO_ACK_RDX)) {
    750  1.1  palle 		/* Link is up! */
    751  1.1  palle 		vnet_link_state(sc);
    752  1.1  palle 
    753  1.1  palle 		/* Configure multicast now that we can. */
    754  1.1  palle 		vnet_setmulti(sc, 1);
    755  1.1  palle 
    756  1.1  palle #if 0
    757  1.1  palle FIXME openbsd
    758  1.1  palle 		KERNEL_LOCK();
    759  1.1  palle #else
    760  1.1  palle 	KERNEL_LOCK(1, curlwp);
    761  1.1  palle #endif
    762  1.1  palle #if 0
    763  1.1  palle FIXME openbsd
    764  1.1  palle 		ifq_clr_oactive(&ifp->if_snd);
    765  1.1  palle #else
    766  1.1  palle 	ifp->if_flags &= ~IFF_OACTIVE;
    767  1.1  palle #endif
    768  1.1  palle 		vnet_start(ifp);
    769  1.1  palle #if 0
    770  1.1  palle FIXME openbsd
    771  1.1  palle 		KERNEL_UNLOCK();
    772  1.1  palle #else
    773  1.1  palle 	KERNEL_UNLOCK_ONE(curlwp);
    774  1.1  palle #endif
    775  1.1  palle 	}
    776  1.1  palle }
    777  1.1  palle 
    778  1.1  palle void
    779  1.1  palle vnet_rx_vio_data(struct vnet_softc *sc, struct vio_msg *vm)
    780  1.1  palle {
    781  1.1  palle 	struct vio_msg_tag *tag = (struct vio_msg_tag *)&vm->type;
    782  1.1  palle 
    783  1.1  palle 	if (!ISSET(sc->sc_vio_state, VIO_RCV_RDX) ||
    784  1.1  palle 	    !ISSET(sc->sc_vio_state, VIO_ACK_RDX)) {
    785  1.1  palle 		DPRINTF(("Spurious DATA/0x%02x/0x%04x\n", tag->stype,
    786  1.1  palle 		    tag->stype_env));
    787  1.1  palle 		return;
    788  1.1  palle 	}
    789  1.1  palle 
    790  1.1  palle 	switch(tag->stype_env) {
    791  1.1  palle 	case VIO_DESC_DATA:
    792  1.1  palle 		vnet_rx_vio_desc_data(sc, tag);
    793  1.1  palle 		break;
    794  1.1  palle 
    795  1.1  palle 	case VIO_DRING_DATA:
    796  1.1  palle 		vnet_rx_vio_dring_data(sc, tag);
    797  1.1  palle 		break;
    798  1.1  palle 
    799  1.1  palle 	default:
    800  1.1  palle 		DPRINTF(("DATA/0x%02x/0x%04x\n", tag->stype, tag->stype_env));
    801  1.1  palle 		break;
    802  1.1  palle 	}
    803  1.1  palle }
    804  1.1  palle 
    805  1.1  palle void
    806  1.1  palle vnet_rx_vio_desc_data(struct vnet_softc *sc, struct vio_msg_tag *tag)
    807  1.1  palle {
    808  1.1  palle 	struct vnet_desc_msg *dm = (struct vnet_desc_msg *)tag;
    809  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
    810  1.1  palle 	struct ldc_map *map = sc->sc_lm;
    811  1.1  palle #if 0
    812  1.1  palle FIXME openbsd
    813  1.1  palle 	struct ifnet *ifp = &sc->sc_ac.ac_if;
    814  1.1  palle #else
    815  1.1  palle 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
    816  1.1  palle #endif
    817  1.1  palle #if 0
    818  1.1  palle FIXME openbsd
    819  1.1  palle 	struct mbuf_list ml = MBUF_LIST_INITIALIZER();
    820  1.1  palle #endif
    821  1.1  palle 	struct mbuf *m;
    822  1.1  palle 	unsigned char *buf;
    823  1.1  palle 	paddr_t pa;
    824  1.1  palle 	psize_t nbytes;
    825  1.1  palle 	u_int cons;
    826  1.1  palle 	int err;
    827  1.1  palle 
    828  1.1  palle 	switch(tag->stype) {
    829  1.1  palle 	case VIO_SUBTYPE_INFO:
    830  1.1  palle 		buf = pool_get(&sc->sc_pool, PR_NOWAIT|PR_ZERO);
    831  1.1  palle 		if (buf == NULL) {
    832  1.1  palle #if 0
    833  1.1  palle FIXME openbsd
    834  1.1  palle 			ifp->if_ierrors++;
    835  1.1  palle #else
    836  1.1  palle 			if_statinc(ifp, if_ierrors);
    837  1.1  palle #endif
    838  1.1  palle 			goto skip;
    839  1.1  palle 		}
    840  1.1  palle 		nbytes = roundup(dm->nbytes, 8);
    841  1.1  palle 
    842  1.1  palle 		if (dm->nbytes > (ETHER_MAX_LEN - ETHER_CRC_LEN)) {
    843  1.1  palle #if 0
    844  1.1  palle FIXME openbsd
    845  1.1  palle 			ifp->if_ierrors++;
    846  1.1  palle #else
    847  1.1  palle 			if_statinc(ifp, if_ierrors);
    848  1.1  palle #endif
    849  1.1  palle 			goto skip;
    850  1.1  palle 		}
    851  1.1  palle 
    852  1.1  palle 		pmap_extract(pmap_kernel(), (vaddr_t)buf, &pa);
    853  1.1  palle 		err = hv_ldc_copy(lc->lc_id, LDC_COPY_IN,
    854  1.1  palle 		    dm->cookie[0].addr, pa, nbytes, &nbytes);
    855  1.1  palle 		if (err != H_EOK) {
    856  1.1  palle 			pool_put(&sc->sc_pool, buf);
    857  1.1  palle #if 0
    858  1.1  palle FIXME openbsd
    859  1.1  palle 			ifp->if_ierrors++;
    860  1.1  palle #else
    861  1.1  palle 			if_statinc(ifp, if_ierrors);
    862  1.1  palle #endif
    863  1.1  palle 			goto skip;
    864  1.1  palle 		}
    865  1.1  palle 
    866  1.1  palle 		/* Stupid OBP doesn't align properly. */
    867  1.1  palle #if 0
    868  1.1  palle FIXME openbsd
    869  1.1  palle                 m = m_devget(buf, dm->nbytes, ETHER_ALIGN);
    870  1.1  palle #else
    871  1.1  palle 		m = m_devget(buf, dm->nbytes, 0, ifp);
    872  1.1  palle #endif
    873  1.1  palle 		pool_put(&sc->sc_pool, buf);
    874  1.1  palle 		if (m == NULL) {
    875  1.1  palle #if 0
    876  1.1  palle FIXME openbsd
    877  1.1  palle 			ifp->if_ierrors++;
    878  1.1  palle #else
    879  1.1  palle 			if_statinc(ifp, if_ierrors);
    880  1.1  palle #endif
    881  1.1  palle 			goto skip;
    882  1.1  palle 		}
    883  1.1  palle 
    884  1.1  palle 		/* Pass it on. */
    885  1.1  palle #if 0
    886  1.1  palle FIXME openbsd
    887  1.1  palle 		ml_enqueue(&ml, m);
    888  1.1  palle 		if_input(ifp, &ml);
    889  1.1  palle #else
    890  1.1  palle 	if_percpuq_enqueue(ifp->if_percpuq, m);
    891  1.1  palle #endif
    892  1.1  palle 	skip:
    893  1.1  palle 		dm->tag.stype = VIO_SUBTYPE_ACK;
    894  1.1  palle 		dm->tag.sid = sc->sc_local_sid;
    895  1.1  palle 		vnet_sendmsg(sc, dm, sizeof(*dm));
    896  1.1  palle 		break;
    897  1.1  palle 
    898  1.1  palle 	case VIO_SUBTYPE_ACK:
    899  1.1  palle 		DPRINTF(("DATA/ACK/DESC_DATA\n"));
    900  1.1  palle 
    901  1.1  palle 		if (dm->desc_handle != sc->sc_tx_cons) {
    902  1.1  palle 			printf("out of order\n");
    903  1.1  palle 			return;
    904  1.1  palle 		}
    905  1.1  palle 
    906  1.1  palle 		cons = sc->sc_tx_cons & (sc->sc_vd->vd_nentries - 1);
    907  1.1  palle 
    908  1.1  palle 		map->lm_slot[sc->sc_vsd[cons].vsd_map_idx].entry = 0;
    909  1.1  palle #if 0
    910  1.1  palle FIXME openbsd
    911  1.1  palle 		atomic_dec_int(&map->lm_count);
    912  1.1  palle #else
    913  1.1  palle 		map->lm_count--;
    914  1.1  palle #endif
    915  1.1  palle 
    916  1.1  palle 		pool_put(&sc->sc_pool, sc->sc_vsd[cons].vsd_buf);
    917  1.1  palle 		sc->sc_vsd[cons].vsd_buf = NULL;
    918  1.1  palle 
    919  1.1  palle 		sc->sc_tx_cons++;
    920  1.1  palle 		break;
    921  1.1  palle 
    922  1.1  palle 	case VIO_SUBTYPE_NACK:
    923  1.1  palle 		DPRINTF(("DATA/NACK/DESC_DATA\n"));
    924  1.1  palle 		break;
    925  1.1  palle 
    926  1.1  palle 	default:
    927  1.1  palle 		DPRINTF(("DATA/0x%02x/DESC_DATA\n", tag->stype));
    928  1.1  palle 		break;
    929  1.1  palle 	}
    930  1.1  palle }
    931  1.1  palle 
    932  1.1  palle void
    933  1.1  palle vnet_rx_vio_dring_data(struct vnet_softc *sc, struct vio_msg_tag *tag)
    934  1.1  palle {
    935  1.1  palle 	struct vio_dring_msg *dm = (struct vio_dring_msg *)tag;
    936  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
    937  1.1  palle #if 0
    938  1.1  palle FIXME openbsd
    939  1.1  palle 	struct ifnet *ifp = &sc->sc_ac.ac_if;
    940  1.1  palle #else
    941  1.1  palle 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
    942  1.1  palle #endif
    943  1.1  palle 	struct mbuf *m = NULL;
    944  1.1  palle 	paddr_t pa;
    945  1.1  palle 	psize_t nbytes;
    946  1.1  palle 	int err;
    947  1.1  palle 
    948  1.1  palle 	switch(tag->stype) {
    949  1.1  palle 	case VIO_SUBTYPE_INFO:
    950  1.1  palle 	{
    951  1.1  palle 		struct vnet_desc desc;
    952  1.1  palle 		uint64_t cookie;
    953  1.1  palle 		paddr_t desc_pa;
    954  1.1  palle 		int idx, ack_end_idx = -1;
    955  1.1  palle #if 0
    956  1.1  palle FIXME openbsd
    957  1.1  palle 		struct mbuf_list ml = MBUF_LIST_INITIALIZER();
    958  1.1  palle #endif
    959  1.1  palle 
    960  1.1  palle 		idx = dm->start_idx;
    961  1.1  palle 		for (;;) {
    962  1.1  palle 			cookie = sc->sc_peer_dring_cookie.addr;
    963  1.1  palle 			cookie += idx * sc->sc_peer_desc_size;
    964  1.1  palle 			nbytes = sc->sc_peer_desc_size;
    965  1.1  palle 			pmap_extract(pmap_kernel(), (vaddr_t)&desc, &desc_pa);
    966  1.1  palle 			err = hv_ldc_copy(lc->lc_id, LDC_COPY_IN, cookie,
    967  1.1  palle 			    desc_pa, nbytes, &nbytes);
    968  1.1  palle 			if (err != H_EOK) {
    969  1.1  palle 				printf("hv_ldc_copy_in %d\n", err);
    970  1.1  palle 				break;
    971  1.1  palle 			}
    972  1.1  palle 
    973  1.1  palle 			if (desc.hdr.dstate != VIO_DESC_READY)
    974  1.1  palle 				break;
    975  1.1  palle 
    976  1.1  palle 			if (desc.nbytes > (ETHER_MAX_LEN - ETHER_CRC_LEN)) {
    977  1.1  palle #if 0
    978  1.1  palle FIXME openbsd
    979  1.1  palle 				ifp->if_ierrors++;
    980  1.1  palle #else
    981  1.1  palle 				if_statinc(ifp, if_ierrors);
    982  1.1  palle #endif
    983  1.1  palle 				goto skip;
    984  1.1  palle 			}
    985  1.1  palle #if 0
    986  1.1  palle FIXME openbsd
    987  1.1  palle 			m = MCLGETI(NULL, M_DONTWAIT, NULL, desc.nbytes);
    988  1.1  palle 			if (!m)
    989  1.1  palle 				break;
    990  1.1  palle #else
    991  1.1  palle 			MCLGET(NULL, M_DONTWAIT);
    992  1.1  palle 			if ((m->m_flags & M_EXT) == 0)
    993  1.1  palle 				break;
    994  1.1  palle #endif
    995  1.1  palle 			m->m_len = m->m_pkthdr.len = desc.nbytes;
    996  1.1  palle 			nbytes = roundup(desc.nbytes + VNET_ETHER_ALIGN, 8);
    997  1.1  palle 
    998  1.1  palle 			pmap_extract(pmap_kernel(), (vaddr_t)m->m_data, &pa);
    999  1.1  palle 			err = hv_ldc_copy(lc->lc_id, LDC_COPY_IN,
   1000  1.1  palle 			    desc.cookie[0].addr, pa, nbytes, &nbytes);
   1001  1.1  palle 			if (err != H_EOK) {
   1002  1.1  palle 				m_freem(m);
   1003  1.1  palle 				goto skip;
   1004  1.1  palle 			}
   1005  1.1  palle 			m->m_data += VNET_ETHER_ALIGN;
   1006  1.1  palle 
   1007  1.1  palle #if 0
   1008  1.1  palle FIXME openbsd
   1009  1.1  palle 			ml_enqueue(&ml, m);
   1010  1.1  palle #else
   1011  1.1  palle 			if_percpuq_enqueue(ifp->if_percpuq, m);
   1012  1.1  palle #endif
   1013  1.1  palle 
   1014  1.1  palle 		skip:
   1015  1.1  palle 			desc.hdr.dstate = VIO_DESC_DONE;
   1016  1.1  palle 			nbytes = sc->sc_peer_desc_size;
   1017  1.1  palle 			err = hv_ldc_copy(lc->lc_id, LDC_COPY_OUT, cookie,
   1018  1.1  palle 			    desc_pa, nbytes, &nbytes);
   1019  1.1  palle 			if (err != H_EOK)
   1020  1.1  palle 				printf("hv_ldc_copy_out %d\n", err);
   1021  1.1  palle 
   1022  1.1  palle 			ack_end_idx = idx;
   1023  1.1  palle 			if (++idx == sc->sc_peer_dring_nentries)
   1024  1.1  palle 				idx = 0;
   1025  1.1  palle 		}
   1026  1.1  palle #if 0
   1027  1.1  palle FIXME openbd
   1028  1.1  palle 		if_input(ifp, &ml);
   1029  1.1  palle #else
   1030  1.1  palle 		printf("vnet_rx_vio_dring_data() ignoring if_input - FIXME\n");
   1031  1.1  palle #endif
   1032  1.1  palle 
   1033  1.1  palle 		if (ack_end_idx == -1) {
   1034  1.1  palle 			dm->tag.stype = VIO_SUBTYPE_NACK;
   1035  1.1  palle 		} else {
   1036  1.1  palle 			dm->tag.stype = VIO_SUBTYPE_ACK;
   1037  1.1  palle 			dm->end_idx = ack_end_idx;
   1038  1.1  palle 		}
   1039  1.1  palle 		dm->tag.sid = sc->sc_local_sid;
   1040  1.1  palle 		dm->proc_state = VIO_DP_STOPPED;
   1041  1.1  palle 		vnet_sendmsg(sc, dm, sizeof(*dm));
   1042  1.1  palle 		break;
   1043  1.1  palle 	}
   1044  1.1  palle 
   1045  1.1  palle 	case VIO_SUBTYPE_ACK:
   1046  1.1  palle 	{
   1047  1.1  palle 		struct ldc_map *map = sc->sc_lm;
   1048  1.1  palle 		u_int cons, count;
   1049  1.1  palle 
   1050  1.1  palle 		sc->sc_peer_state = dm->proc_state;
   1051  1.1  palle 
   1052  1.1  palle 		cons = sc->sc_tx_cons & (sc->sc_vd->vd_nentries - 1);
   1053  1.1  palle 		while (sc->sc_vd->vd_desc[cons].hdr.dstate == VIO_DESC_DONE) {
   1054  1.1  palle 			map->lm_slot[sc->sc_vsd[cons].vsd_map_idx].entry = 0;
   1055  1.1  palle #if 0
   1056  1.1  palle FIXME openbsd
   1057  1.1  palle 			atomic_dec_int(&map->lm_count);
   1058  1.1  palle #else
   1059  1.1  palle 			map->lm_count--;
   1060  1.1  palle #endif
   1061  1.1  palle 
   1062  1.1  palle 			pool_put(&sc->sc_pool, sc->sc_vsd[cons].vsd_buf);
   1063  1.1  palle 			sc->sc_vsd[cons].vsd_buf = NULL;
   1064  1.1  palle 
   1065  1.1  palle 			sc->sc_vd->vd_desc[cons].hdr.dstate = VIO_DESC_FREE;
   1066  1.1  palle 			sc->sc_tx_cons++;
   1067  1.1  palle 			cons = sc->sc_tx_cons & (sc->sc_vd->vd_nentries - 1);
   1068  1.1  palle 		}
   1069  1.1  palle 
   1070  1.1  palle 		count = sc->sc_tx_prod - sc->sc_tx_cons;
   1071  1.1  palle 		if (count > 0 && sc->sc_peer_state != VIO_DP_ACTIVE)
   1072  1.1  palle 			vnet_send_dring_data(sc, cons);
   1073  1.1  palle 
   1074  1.1  palle #if 0
   1075  1.1  palle FIXME openbsd
   1076  1.1  palle 		KERNEL_LOCK();
   1077  1.1  palle #else
   1078  1.1  palle 		KERNEL_LOCK(1, curlwp);
   1079  1.1  palle #endif
   1080  1.1  palle 		if (count < (sc->sc_vd->vd_nentries - 1))
   1081  1.1  palle #if 0
   1082  1.1  palle FIXME openbsd
   1083  1.1  palle 			ifq_clr_oactive(&ifp->if_snd);
   1084  1.1  palle #else
   1085  1.1  palle 			ifp->if_flags &= ~IFF_OACTIVE;
   1086  1.1  palle #endif
   1087  1.1  palle 		if (count == 0)
   1088  1.1  palle 			ifp->if_timer = 0;
   1089  1.1  palle 
   1090  1.1  palle 		vnet_start(ifp);
   1091  1.1  palle #if 0
   1092  1.1  palle FIXME openbsd
   1093  1.1  palle 		KERNEL_UNLOCK();
   1094  1.1  palle #else
   1095  1.1  palle 		KERNEL_UNLOCK_ONE(curlwp);
   1096  1.1  palle #endif
   1097  1.1  palle 		break;
   1098  1.1  palle 	}
   1099  1.1  palle 
   1100  1.1  palle 	case VIO_SUBTYPE_NACK:
   1101  1.1  palle 		DPRINTF(("DATA/NACK/DRING_DATA\n"));
   1102  1.1  palle 		sc->sc_peer_state = VIO_DP_STOPPED;
   1103  1.1  palle 		break;
   1104  1.1  palle 
   1105  1.1  palle 	default:
   1106  1.1  palle 		DPRINTF(("DATA/0x%02x/DRING_DATA\n", tag->stype));
   1107  1.1  palle 		break;
   1108  1.1  palle 	}
   1109  1.1  palle }
   1110  1.1  palle 
   1111  1.1  palle void
   1112  1.1  palle vnet_ldc_reset(struct ldc_conn *lc)
   1113  1.1  palle {
   1114  1.1  palle 	struct vnet_softc *sc = lc->lc_sc;
   1115  1.1  palle 	int i;
   1116  1.1  palle #if 0
   1117  1.1  palle FIXME openbsd
   1118  1.1  palle 	timeout_del(&sc->sc_handshake_to);
   1119  1.1  palle #endif
   1120  1.1  palle 	sc->sc_tx_prod = sc->sc_tx_cons = 0;
   1121  1.1  palle 	sc->sc_peer_state = VIO_DP_STOPPED;
   1122  1.1  palle 	sc->sc_vio_state = 0;
   1123  1.1  palle 	vnet_link_state(sc);
   1124  1.1  palle 
   1125  1.1  palle 	sc->sc_lm->lm_next = 1;
   1126  1.1  palle 	sc->sc_lm->lm_count = 1;
   1127  1.1  palle 	for (i = 1; i < sc->sc_lm->lm_nentries; i++)
   1128  1.1  palle 		sc->sc_lm->lm_slot[i].entry = 0;
   1129  1.1  palle 
   1130  1.1  palle 	for (i = 0; i < sc->sc_vd->vd_nentries; i++) {
   1131  1.1  palle 		if (sc->sc_vsd[i].vsd_buf) {
   1132  1.1  palle 			pool_put(&sc->sc_pool, sc->sc_vsd[i].vsd_buf);
   1133  1.1  palle 			sc->sc_vsd[i].vsd_buf = NULL;
   1134  1.1  palle 		}
   1135  1.1  palle 		sc->sc_vd->vd_desc[i].hdr.dstate = VIO_DESC_FREE;
   1136  1.1  palle 	}
   1137  1.1  palle }
   1138  1.1  palle 
   1139  1.1  palle void
   1140  1.1  palle vnet_ldc_start(struct ldc_conn *lc)
   1141  1.1  palle {
   1142  1.1  palle 	struct vnet_softc *sc = lc->lc_sc;
   1143  1.1  palle #if 0
   1144  1.1  palle FIXME openbsd
   1145  1.1  palle 	timeout_del(&sc->sc_handshake_to);
   1146  1.1  palle #endif
   1147  1.1  palle 	vnet_send_ver_info(sc, VNET_MAJOR, VNET_MINOR);
   1148  1.1  palle }
   1149  1.1  palle 
   1150  1.1  palle void
   1151  1.1  palle vnet_sendmsg(struct vnet_softc *sc, void *msg, size_t len)
   1152  1.1  palle {
   1153  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
   1154  1.1  palle 	int err;
   1155  1.1  palle 
   1156  1.1  palle 	err = ldc_send_unreliable(lc, msg, len);
   1157  1.1  palle 	if (err)
   1158  1.1  palle 		printf("%s: ldc_send_unreliable: %d\n", __func__, err);
   1159  1.1  palle }
   1160  1.1  palle 
   1161  1.1  palle void
   1162  1.1  palle vnet_send_ver_info(struct vnet_softc *sc, uint16_t major, uint16_t minor)
   1163  1.1  palle {
   1164  1.1  palle 	struct vio_ver_info vi;
   1165  1.1  palle 
   1166  1.1  palle 	bzero(&vi, sizeof(vi));
   1167  1.1  palle 	vi.tag.type = VIO_TYPE_CTRL;
   1168  1.1  palle 	vi.tag.stype = VIO_SUBTYPE_INFO;
   1169  1.1  palle 	vi.tag.stype_env = VIO_VER_INFO;
   1170  1.1  palle 	vi.tag.sid = sc->sc_local_sid;
   1171  1.1  palle 	vi.major = major;
   1172  1.1  palle 	vi.minor = minor;
   1173  1.1  palle 	vi.dev_class = VDEV_NETWORK;
   1174  1.1  palle 	vnet_sendmsg(sc, &vi, sizeof(vi));
   1175  1.1  palle 
   1176  1.1  palle 	sc->sc_vio_state |= VIO_SND_VER_INFO;
   1177  1.1  palle }
   1178  1.1  palle 
   1179  1.1  palle void
   1180  1.1  palle vnet_send_attr_info(struct vnet_softc *sc)
   1181  1.1  palle {
   1182  1.1  palle 	struct vnet_attr_info ai;
   1183  1.1  palle 	int i;
   1184  1.1  palle 
   1185  1.1  palle 	bzero(&ai, sizeof(ai));
   1186  1.1  palle 	ai.tag.type = VIO_TYPE_CTRL;
   1187  1.1  palle 	ai.tag.stype = VIO_SUBTYPE_INFO;
   1188  1.1  palle 	ai.tag.stype_env = VIO_ATTR_INFO;
   1189  1.1  palle 	ai.tag.sid = sc->sc_local_sid;
   1190  1.1  palle 	ai.xfer_mode = VIO_DRING_MODE;
   1191  1.1  palle 	ai.addr_type = VNET_ADDR_ETHERMAC;
   1192  1.1  palle 	ai.ack_freq = 0;
   1193  1.1  palle 	ai.addr = 0;
   1194  1.1  palle 	for (i = 0; i < ETHER_ADDR_LEN; i++) {
   1195  1.1  palle 		ai.addr <<= 8;
   1196  1.1  palle 		ai.addr |= sc->sc_macaddr[i];
   1197  1.1  palle 	}
   1198  1.1  palle 	ai.mtu = ETHER_MAX_LEN - ETHER_CRC_LEN;
   1199  1.1  palle 	vnet_sendmsg(sc, &ai, sizeof(ai));
   1200  1.1  palle 
   1201  1.1  palle 	sc->sc_vio_state |= VIO_SND_ATTR_INFO;
   1202  1.1  palle }
   1203  1.1  palle 
   1204  1.1  palle void
   1205  1.1  palle vnet_send_dring_reg(struct vnet_softc *sc)
   1206  1.1  palle {
   1207  1.1  palle 	struct vio_dring_reg dr;
   1208  1.1  palle 
   1209  1.1  palle 	bzero(&dr, sizeof(dr));
   1210  1.1  palle 	dr.tag.type = VIO_TYPE_CTRL;
   1211  1.1  palle 	dr.tag.stype = VIO_SUBTYPE_INFO;
   1212  1.1  palle 	dr.tag.stype_env = VIO_DRING_REG;
   1213  1.1  palle 	dr.tag.sid = sc->sc_local_sid;
   1214  1.1  palle 	dr.dring_ident = 0;
   1215  1.1  palle 	dr.num_descriptors = sc->sc_vd->vd_nentries;
   1216  1.1  palle 	dr.descriptor_size = sizeof(struct vnet_desc);
   1217  1.1  palle 	dr.options = VIO_TX_RING;
   1218  1.1  palle 	dr.ncookies = 1;
   1219  1.1  palle 	dr.cookie[0].addr = 0;
   1220  1.1  palle 	dr.cookie[0].size = PAGE_SIZE;
   1221  1.1  palle 	vnet_sendmsg(sc, &dr, sizeof(dr));
   1222  1.1  palle 
   1223  1.1  palle 	sc->sc_vio_state |= VIO_SND_DRING_REG;
   1224  1.1  palle };
   1225  1.1  palle 
   1226  1.1  palle void
   1227  1.1  palle vio_send_rdx(struct vnet_softc *sc)
   1228  1.1  palle {
   1229  1.1  palle 	struct vio_msg_tag tag;
   1230  1.1  palle 
   1231  1.1  palle 	tag.type = VIO_TYPE_CTRL;
   1232  1.1  palle 	tag.stype = VIO_SUBTYPE_INFO;
   1233  1.1  palle 	tag.stype_env = VIO_RDX;
   1234  1.1  palle 	tag.sid = sc->sc_local_sid;
   1235  1.1  palle 	vnet_sendmsg(sc, &tag, sizeof(tag));
   1236  1.1  palle 
   1237  1.1  palle 	sc->sc_vio_state |= VIO_SND_RDX;
   1238  1.1  palle }
   1239  1.1  palle 
   1240  1.1  palle void
   1241  1.1  palle vnet_send_dring_data(struct vnet_softc *sc, uint32_t start_idx)
   1242  1.1  palle {
   1243  1.1  palle 	struct vio_dring_msg dm;
   1244  1.1  palle 	u_int peer_state;
   1245  1.1  palle 
   1246  1.1  palle 	peer_state = atomic_swap_uint(&sc->sc_peer_state, VIO_DP_ACTIVE);
   1247  1.1  palle 	if (peer_state == VIO_DP_ACTIVE)
   1248  1.1  palle 		return;
   1249  1.1  palle 
   1250  1.1  palle 	bzero(&dm, sizeof(dm));
   1251  1.1  palle 	dm.tag.type = VIO_TYPE_DATA;
   1252  1.1  palle 	dm.tag.stype = VIO_SUBTYPE_INFO;
   1253  1.1  palle 	dm.tag.stype_env = VIO_DRING_DATA;
   1254  1.1  palle 	dm.tag.sid = sc->sc_local_sid;
   1255  1.1  palle 	dm.seq_no = sc->sc_seq_no++;
   1256  1.1  palle 	dm.dring_ident = sc->sc_dring_ident;
   1257  1.1  palle 	dm.start_idx = start_idx;
   1258  1.1  palle 	dm.end_idx = -1;
   1259  1.1  palle 	vnet_sendmsg(sc, &dm, sizeof(dm));
   1260  1.1  palle }
   1261  1.1  palle 
   1262  1.1  palle void
   1263  1.1  palle vnet_start(struct ifnet *ifp)
   1264  1.1  palle {
   1265  1.1  palle 	struct vnet_softc *sc = ifp->if_softc;
   1266  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
   1267  1.1  palle 	struct ldc_map *map = sc->sc_lm;
   1268  1.1  palle 	struct mbuf *m;
   1269  1.1  palle 	paddr_t pa;
   1270  1.1  palle 	unsigned char *buf;
   1271  1.1  palle 	uint64_t tx_head, tx_tail, tx_state;
   1272  1.1  palle 	u_int start, prod, count;
   1273  1.1  palle 	int err;
   1274  1.1  palle 
   1275  1.1  palle #if 0
   1276  1.1  palle FIXME openbsd
   1277  1.1  palle 	if (!(ifp->if_flags & IFF_RUNNING) || ifq_is_oactive(&ifp->if_snd))
   1278  1.1  palle #else
   1279  1.1  palle 	if (!(ifp->if_flags & IFF_RUNNING) || (ifp->if_flags & IFF_OACTIVE))
   1280  1.1  palle #endif
   1281  1.1  palle 		return;
   1282  1.1  palle 
   1283  1.1  palle #if 0
   1284  1.1  palle FIXME openbsd
   1285  1.1  palle 	if (ifq_empty(&ifp->if_snd))
   1286  1.1  palle #else
   1287  1.1  palle 	if (IFQ_IS_EMPTY(&ifp->if_snd))
   1288  1.1  palle #endif
   1289  1.1  palle 		return;
   1290  1.1  palle 
   1291  1.1  palle 	/*
   1292  1.1  palle 	 * We cannot transmit packets until a VIO connection has been
   1293  1.1  palle 	 * established.
   1294  1.1  palle 	 */
   1295  1.1  palle 	if (!ISSET(sc->sc_vio_state, VIO_RCV_RDX) ||
   1296  1.1  palle 	    !ISSET(sc->sc_vio_state, VIO_ACK_RDX))
   1297  1.1  palle 		return;
   1298  1.1  palle 
   1299  1.1  palle 	/*
   1300  1.1  palle 	 * Make sure there is room in the LDC transmit queue to send a
   1301  1.1  palle 	 * DRING_DATA message.
   1302  1.1  palle 	 */
   1303  1.1  palle 	err = hv_ldc_tx_get_state(lc->lc_id, &tx_head, &tx_tail, &tx_state);
   1304  1.1  palle 	if (err != H_EOK)
   1305  1.1  palle 		return;
   1306  1.1  palle 	tx_tail += sizeof(struct ldc_pkt);
   1307  1.1  palle 	tx_tail &= ((lc->lc_txq->lq_nentries * sizeof(struct ldc_pkt)) - 1);
   1308  1.1  palle 	if (tx_tail == tx_head) {
   1309  1.1  palle #if 0
   1310  1.1  palle FIXME openbsd
   1311  1.1  palle 		ifq_set_oactive(&ifp->if_snd);
   1312  1.1  palle #else
   1313  1.1  palle 		ifp->if_flags |= IFF_OACTIVE;
   1314  1.1  palle #endif
   1315  1.1  palle 		return;
   1316  1.1  palle 	}
   1317  1.1  palle 
   1318  1.1  palle 	if (sc->sc_xfer_mode == VIO_DESC_MODE) {
   1319  1.1  palle 		vnet_start_desc(ifp);
   1320  1.1  palle 		return;
   1321  1.1  palle 	}
   1322  1.1  palle 
   1323  1.1  palle 	start = prod = sc->sc_tx_prod & (sc->sc_vd->vd_nentries - 1);
   1324  1.1  palle 	while (sc->sc_vd->vd_desc[prod].hdr.dstate == VIO_DESC_FREE) {
   1325  1.1  palle 		count = sc->sc_tx_prod - sc->sc_tx_cons;
   1326  1.1  palle 		if (count >= (sc->sc_vd->vd_nentries - 1) ||
   1327  1.1  palle 		    map->lm_count >= map->lm_nentries) {
   1328  1.1  palle #if 0
   1329  1.1  palle FIXME openbsd
   1330  1.1  palle 			ifq_set_oactive(&ifp->if_snd);
   1331  1.1  palle #else
   1332  1.1  palle 			ifp->if_flags |= IFF_OACTIVE;
   1333  1.1  palle #endif
   1334  1.1  palle 			break;
   1335  1.1  palle 		}
   1336  1.1  palle 
   1337  1.1  palle 		buf = pool_get(&sc->sc_pool, PR_NOWAIT|PR_ZERO);
   1338  1.1  palle 		if (buf == NULL) {
   1339  1.1  palle #if 0
   1340  1.1  palle FIXME openbsd
   1341  1.1  palle 			ifq_set_oactive(&ifp->if_snd);
   1342  1.1  palle #else
   1343  1.1  palle 			ifp->if_flags |= IFF_OACTIVE;
   1344  1.1  palle #endif
   1345  1.1  palle 			break;
   1346  1.1  palle 		}
   1347  1.1  palle #if 0
   1348  1.1  palle FIXME openbsd
   1349  1.1  palle 		m = ifq_dequeue(&ifp->if_snd);
   1350  1.1  palle #else
   1351  1.1  palle 		IFQ_DEQUEUE(&ifp->if_snd, m);
   1352  1.1  palle #endif
   1353  1.1  palle 		if (m == NULL) {
   1354  1.1  palle 			pool_put(&sc->sc_pool, buf);
   1355  1.1  palle 			break;
   1356  1.1  palle 		}
   1357  1.1  palle 
   1358  1.1  palle 		m_copydata(m, 0, m->m_pkthdr.len, buf + VNET_ETHER_ALIGN);
   1359  1.1  palle 
   1360  1.1  palle #if NBPFILTER > 0
   1361  1.1  palle 		/*
   1362  1.1  palle 		 * If BPF is listening on this interface, let it see the
   1363  1.1  palle 		 * packet before we commit it to the wire.
   1364  1.1  palle 		 */
   1365  1.1  palle 		if (ifp->if_bpf)
   1366  1.1  palle 			bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_OUT);
   1367  1.1  palle #endif
   1368  1.1  palle 
   1369  1.1  palle 		pmap_extract(pmap_kernel(), (vaddr_t)buf, &pa);
   1370  1.1  palle 		KASSERT((pa & ~PAGE_MASK) == (pa & LDC_MTE_RA_MASK));
   1371  1.1  palle 		while (map->lm_slot[map->lm_next].entry != 0) {
   1372  1.1  palle 			map->lm_next++;
   1373  1.1  palle 			map->lm_next &= (map->lm_nentries - 1);
   1374  1.1  palle 		}
   1375  1.1  palle 		map->lm_slot[map->lm_next].entry = (pa & LDC_MTE_RA_MASK);
   1376  1.1  palle 		map->lm_slot[map->lm_next].entry |= LDC_MTE_CPR;
   1377  1.1  palle #if 0
   1378  1.1  palle FIXME openbsd
   1379  1.1  palle 		atomic_inc_int(&map->lm_count);
   1380  1.1  palle #else
   1381  1.1  palle 		map->lm_count++;
   1382  1.1  palle #endif
   1383  1.1  palle #if 0
   1384  1.1  palle FIXME openbsd
   1385  1.1  palle 		sc->sc_vd->vd_desc[prod].nbytes = max(m->m_pkthdr.len, 60);
   1386  1.1  palle #else
   1387  1.1  palle 		sc->sc_vd->vd_desc[prod].nbytes = MAX(m->m_pkthdr.len, 60);
   1388  1.1  palle #endif
   1389  1.1  palle 		sc->sc_vd->vd_desc[prod].ncookies = 1;
   1390  1.1  palle 		sc->sc_vd->vd_desc[prod].cookie[0].addr =
   1391  1.1  palle 		    map->lm_next << PAGE_SHIFT | (pa & PAGE_MASK);
   1392  1.1  palle 		sc->sc_vd->vd_desc[prod].cookie[0].size = 2048;
   1393  1.1  palle 		membar_producer();
   1394  1.1  palle 		sc->sc_vd->vd_desc[prod].hdr.dstate = VIO_DESC_READY;
   1395  1.1  palle 
   1396  1.1  palle 		sc->sc_vsd[prod].vsd_map_idx = map->lm_next;
   1397  1.1  palle 		sc->sc_vsd[prod].vsd_buf = buf;
   1398  1.1  palle 
   1399  1.1  palle 		sc->sc_tx_prod++;
   1400  1.1  palle 		prod = sc->sc_tx_prod & (sc->sc_vd->vd_nentries - 1);
   1401  1.1  palle 
   1402  1.1  palle 		m_freem(m);
   1403  1.1  palle 	}
   1404  1.1  palle 
   1405  1.1  palle 	membar_producer();
   1406  1.1  palle 
   1407  1.1  palle 	if (start != prod && sc->sc_peer_state != VIO_DP_ACTIVE) {
   1408  1.1  palle 		vnet_send_dring_data(sc, start);
   1409  1.1  palle 		ifp->if_timer = 5;
   1410  1.1  palle 	}
   1411  1.1  palle }
   1412  1.1  palle 
   1413  1.1  palle void
   1414  1.1  palle vnet_start_desc(struct ifnet *ifp)
   1415  1.1  palle {
   1416  1.1  palle 	struct vnet_softc *sc = ifp->if_softc;
   1417  1.1  palle 	struct ldc_map *map = sc->sc_lm;
   1418  1.1  palle 	struct vnet_desc_msg dm;
   1419  1.1  palle 	struct mbuf *m;
   1420  1.1  palle 	paddr_t pa;
   1421  1.1  palle 	unsigned char *buf;
   1422  1.1  palle 	u_int prod, count;
   1423  1.1  palle 
   1424  1.1  palle 	for (;;) {
   1425  1.1  palle 		count = sc->sc_tx_prod - sc->sc_tx_cons;
   1426  1.1  palle 		if (count >= (sc->sc_vd->vd_nentries - 1) ||
   1427  1.1  palle 		    map->lm_count >= map->lm_nentries) {
   1428  1.1  palle #if 0
   1429  1.1  palle FIXME openbsd
   1430  1.1  palle 			ifq_set_oactive(&ifp->if_snd);
   1431  1.1  palle #else
   1432  1.1  palle 			ifp->if_flags |= IFF_OACTIVE;
   1433  1.1  palle #endif
   1434  1.1  palle 			return;
   1435  1.1  palle 		}
   1436  1.1  palle 
   1437  1.1  palle 		buf = pool_get(&sc->sc_pool, PR_NOWAIT|PR_ZERO);
   1438  1.1  palle 		if (buf == NULL) {
   1439  1.1  palle #if 0
   1440  1.1  palle FIXME openbsd
   1441  1.1  palle 			ifq_set_oactive(&ifp->if_snd);
   1442  1.1  palle #else
   1443  1.1  palle 			ifp->if_flags |= IFF_OACTIVE;
   1444  1.1  palle #endif
   1445  1.1  palle 			return;
   1446  1.1  palle 		}
   1447  1.1  palle 
   1448  1.1  palle #if 0
   1449  1.1  palle FIXME openbsd
   1450  1.1  palle 		m = ifq_dequeue(&ifp->if_snd);
   1451  1.1  palle #else
   1452  1.1  palle 		IFQ_DEQUEUE(&ifp->if_snd, m);
   1453  1.1  palle #endif
   1454  1.1  palle 
   1455  1.1  palle 		if (m == NULL) {
   1456  1.1  palle 			pool_put(&sc->sc_pool, buf);
   1457  1.1  palle 			return;
   1458  1.1  palle 		}
   1459  1.1  palle 
   1460  1.1  palle 		m_copydata(m, 0, m->m_pkthdr.len, buf);
   1461  1.1  palle 
   1462  1.1  palle #if NBPFILTER > 0
   1463  1.1  palle 		/*
   1464  1.1  palle 		 * If BPF is listening on this interface, let it see the
   1465  1.1  palle 		 * packet before we commit it to the wire.
   1466  1.1  palle 		 */
   1467  1.1  palle 		if (ifp->if_bpf)
   1468  1.1  palle 			bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_OUT);
   1469  1.1  palle #endif
   1470  1.1  palle 
   1471  1.1  palle 		pmap_extract(pmap_kernel(), (vaddr_t)buf, &pa);
   1472  1.1  palle 		KASSERT((pa & ~PAGE_MASK) == (pa & LDC_MTE_RA_MASK));
   1473  1.1  palle 		while (map->lm_slot[map->lm_next].entry != 0) {
   1474  1.1  palle 			map->lm_next++;
   1475  1.1  palle 			map->lm_next &= (map->lm_nentries - 1);
   1476  1.1  palle 		}
   1477  1.1  palle 		map->lm_slot[map->lm_next].entry = (pa & LDC_MTE_RA_MASK);
   1478  1.1  palle 		map->lm_slot[map->lm_next].entry |= LDC_MTE_CPR;
   1479  1.1  palle #if 0
   1480  1.1  palle FIXME openbsd
   1481  1.1  palle 		atomic_inc_int(&map->lm_count);
   1482  1.1  palle #else
   1483  1.1  palle 		map->lm_count++;
   1484  1.1  palle #endif
   1485  1.1  palle 
   1486  1.1  palle 		prod = sc->sc_tx_prod & (sc->sc_vd->vd_nentries - 1);
   1487  1.1  palle 		sc->sc_vsd[prod].vsd_map_idx = map->lm_next;
   1488  1.1  palle 		sc->sc_vsd[prod].vsd_buf = buf;
   1489  1.1  palle 
   1490  1.1  palle 		bzero(&dm, sizeof(dm));
   1491  1.1  palle 		dm.tag.type = VIO_TYPE_DATA;
   1492  1.1  palle 		dm.tag.stype = VIO_SUBTYPE_INFO;
   1493  1.1  palle 		dm.tag.stype_env = VIO_DESC_DATA;
   1494  1.1  palle 		dm.tag.sid = sc->sc_local_sid;
   1495  1.1  palle 		dm.seq_no = sc->sc_seq_no++;
   1496  1.1  palle 		dm.desc_handle = sc->sc_tx_prod;
   1497  1.1  palle #if 0
   1498  1.1  palle FIXME openbsd
   1499  1.1  palle 		dm.nbytes = max(m->m_pkthdr.len, 60);
   1500  1.1  palle #else
   1501  1.1  palle 		dm.nbytes = MAX(m->m_pkthdr.len, 60);
   1502  1.1  palle #endif
   1503  1.1  palle 		dm.ncookies = 1;
   1504  1.1  palle 		dm.cookie[0].addr =
   1505  1.1  palle 			map->lm_next << PAGE_SHIFT | (pa & PAGE_MASK);
   1506  1.1  palle 		dm.cookie[0].size = 2048;
   1507  1.1  palle 		vnet_sendmsg(sc, &dm, sizeof(dm));
   1508  1.1  palle 
   1509  1.1  palle 		sc->sc_tx_prod++;
   1510  1.1  palle 		sc->sc_tx_prod &= (sc->sc_vd->vd_nentries - 1);
   1511  1.1  palle 
   1512  1.1  palle 		m_freem(m);
   1513  1.1  palle 	}
   1514  1.1  palle }
   1515  1.1  palle 
   1516  1.1  palle int
   1517  1.1  palle vnet_ioctl(struct ifnet *ifp, u_long cmd, void* data)
   1518  1.1  palle {
   1519  1.1  palle 
   1520  1.1  palle 	struct vnet_softc *sc = ifp->if_softc;
   1521  1.1  palle 	struct ifreq *ifr = (struct ifreq *)data;
   1522  1.1  palle 	int s, error = 0;
   1523  1.1  palle 
   1524  1.1  palle 	s = splnet();
   1525  1.1  palle 
   1526  1.1  palle 	switch (cmd) {
   1527  1.1  palle 
   1528  1.1  palle 		case SIOCSIFADDR:
   1529  1.1  palle 			ifp->if_flags |= IFF_UP;
   1530  1.1  palle 			/* FALLTHROUGH */
   1531  1.1  palle 		case SIOCSIFFLAGS:
   1532  1.1  palle 			if (ifp->if_flags & IFF_UP) {
   1533  1.1  palle 				if ((ifp->if_flags & IFF_RUNNING) == 0)
   1534  1.1  palle 					vnet_init(ifp);
   1535  1.1  palle 			} else {
   1536  1.1  palle 				if (ifp->if_flags & IFF_RUNNING)
   1537  1.1  palle 					vnet_stop(ifp);
   1538  1.1  palle 			}
   1539  1.1  palle 		break;
   1540  1.1  palle 
   1541  1.1  palle 		case SIOCGIFMEDIA:
   1542  1.1  palle 		case SIOCSIFMEDIA:
   1543  1.1  palle 			error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
   1544  1.1  palle 			break;
   1545  1.1  palle 
   1546  1.1  palle 		case SIOCADDMULTI:
   1547  1.1  palle 		case SIOCDELMULTI:
   1548  1.1  palle 			/*
   1549  1.1  palle 			 * XXX Removing all multicast addresses and adding
   1550  1.1  palle 			 * most of them back, is somewhat retarded.
   1551  1.1  palle 			 */
   1552  1.1  palle 			vnet_setmulti(sc, 0);
   1553  1.1  palle 			error = ether_ioctl(ifp, cmd, data);
   1554  1.1  palle 			vnet_setmulti(sc, 1);
   1555  1.1  palle 			if (error == ENETRESET)
   1556  1.1  palle 				error = 0;
   1557  1.1  palle 			break;
   1558  1.1  palle 
   1559  1.1  palle 		default:
   1560  1.1  palle 			error = ether_ioctl(ifp, cmd, data);
   1561  1.1  palle 	}
   1562  1.1  palle 
   1563  1.1  palle 	splx(s);
   1564  1.1  palle 
   1565  1.1  palle 	return (error);
   1566  1.1  palle }
   1567  1.1  palle 
   1568  1.1  palle void
   1569  1.1  palle vnet_watchdog(struct ifnet *ifp)
   1570  1.1  palle {
   1571  1.1  palle 	struct vnet_softc *sc = ifp->if_softc;
   1572  1.1  palle 
   1573  1.1  palle 	printf("%s: watchdog timeout\n", sc->sc_dv.dv_xname);
   1574  1.1  palle }
   1575  1.1  palle 
   1576  1.1  palle int
   1577  1.1  palle vnet_media_change(struct ifnet *ifp)
   1578  1.1  palle {
   1579  1.1  palle 	printf("vnet_media_change()\n");
   1580  1.1  palle 	return (0);
   1581  1.1  palle }
   1582  1.1  palle 
   1583  1.1  palle void
   1584  1.1  palle vnet_media_status(struct ifnet *ifp, struct ifmediareq *imr)
   1585  1.1  palle {
   1586  1.1  palle 	imr->ifm_active = IFM_ETHER | IFM_AUTO;
   1587  1.1  palle 	imr->ifm_status = IFM_AVALID;
   1588  1.1  palle #if 0
   1589  1.1  palle FIXME openbsd
   1590  1.1  palle 	if (LINK_STATE_IS_UP(ifp->if_link_state) &&
   1591  1.1  palle #else
   1592  1.1  palle 	if (ifp->if_link_state == LINK_STATE_UP &&
   1593  1.1  palle #endif
   1594  1.1  palle 	    ifp->if_flags & IFF_UP)
   1595  1.1  palle 		imr->ifm_status |= IFM_ACTIVE;
   1596  1.1  palle }
   1597  1.1  palle 
   1598  1.1  palle void
   1599  1.1  palle vnet_link_state(struct vnet_softc *sc)
   1600  1.1  palle {
   1601  1.1  palle #if 0
   1602  1.1  palle FIXME openbsd
   1603  1.1  palle 	struct ifnet *ifp = &sc->sc_ac.ac_if;
   1604  1.1  palle #else
   1605  1.1  palle 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
   1606  1.1  palle #endif
   1607  1.1  palle 	int link_state = LINK_STATE_DOWN;
   1608  1.1  palle 
   1609  1.1  palle #if 0
   1610  1.1  palle FIXME openbsd
   1611  1.1  palle 	KERNEL_LOCK();
   1612  1.1  palle #else
   1613  1.1  palle 	KERNEL_LOCK(1, curlwp);
   1614  1.1  palle #endif
   1615  1.1  palle 	if (ISSET(sc->sc_vio_state, VIO_RCV_RDX) &&
   1616  1.1  palle 	    ISSET(sc->sc_vio_state, VIO_ACK_RDX))
   1617  1.1  palle #if 0
   1618  1.1  palle FIXME openbsd
   1619  1.1  palle 		link_state = LINK_STATE_FULL_DUPLEX;
   1620  1.1  palle #else
   1621  1.1  palle 		link_state = LINK_STATE_UP;
   1622  1.1  palle #endif
   1623  1.1  palle 	if (ifp->if_link_state != link_state) {
   1624  1.1  palle #if 0
   1625  1.1  palle FIXME openbsd
   1626  1.1  palle 		ifp->if_link_state = link_state;
   1627  1.1  palle 		if_link_state_change(ifp);
   1628  1.1  palle #else
   1629  1.1  palle 		if_link_state_change(ifp, link_state);
   1630  1.1  palle #endif
   1631  1.1  palle 	}
   1632  1.1  palle #if 0
   1633  1.1  palle FIXME openbsd
   1634  1.1  palle 	KERNEL_UNLOCK();
   1635  1.1  palle #else
   1636  1.1  palle 	KERNEL_UNLOCK_ONE(curlwp);
   1637  1.1  palle #endif
   1638  1.1  palle }
   1639  1.1  palle 
   1640  1.1  palle void
   1641  1.1  palle vnet_setmulti(struct vnet_softc *sc, int set)
   1642  1.1  palle {
   1643  1.1  palle 	struct ethercom *ec = &sc->sc_ethercom;
   1644  1.1  palle 	struct ether_multi *enm;
   1645  1.1  palle 	struct ether_multistep step;
   1646  1.1  palle 	struct vnet_mcast_info mi;
   1647  1.1  palle 	int count = 0;
   1648  1.1  palle 
   1649  1.1  palle 	if (!ISSET(sc->sc_vio_state, VIO_RCV_RDX) ||
   1650  1.1  palle 	    !ISSET(sc->sc_vio_state, VIO_ACK_RDX))
   1651  1.1  palle 		return;
   1652  1.1  palle 
   1653  1.1  palle 	bzero(&mi, sizeof(mi));
   1654  1.1  palle 	mi.tag.type = VIO_TYPE_CTRL;
   1655  1.1  palle 	mi.tag.stype = VIO_SUBTYPE_INFO;
   1656  1.1  palle 	mi.tag.stype_env = VNET_MCAST_INFO;
   1657  1.1  palle 	mi.tag.sid = sc->sc_local_sid;
   1658  1.1  palle 	mi.set = set ? 1 : 0;
   1659  1.1  palle #if 0
   1660  1.1  palle FIXME openbsd
   1661  1.1  palle 	KERNEL_LOCK();
   1662  1.1  palle #else
   1663  1.1  palle 	KERNEL_LOCK(1, curlwp);
   1664  1.1  palle #endif
   1665  1.1  palle 	ETHER_FIRST_MULTI(step, ec, enm);
   1666  1.1  palle 	while (enm != NULL) {
   1667  1.1  palle 		/* XXX What about multicast ranges? */
   1668  1.1  palle 		bcopy(enm->enm_addrlo, mi.mcast_addr[count], ETHER_ADDR_LEN);
   1669  1.1  palle 		ETHER_NEXT_MULTI(step, enm);
   1670  1.1  palle 
   1671  1.1  palle 		count++;
   1672  1.1  palle 		if (count < VNET_NUM_MCAST)
   1673  1.1  palle 			continue;
   1674  1.1  palle 
   1675  1.1  palle 		mi.count = VNET_NUM_MCAST;
   1676  1.1  palle 		vnet_sendmsg(sc, &mi, sizeof(mi));
   1677  1.1  palle 		count = 0;
   1678  1.1  palle 	}
   1679  1.1  palle 
   1680  1.1  palle 	if (count > 0) {
   1681  1.1  palle 		mi.count = count;
   1682  1.1  palle 		vnet_sendmsg(sc, &mi, sizeof(mi));
   1683  1.1  palle 	}
   1684  1.1  palle #if 0
   1685  1.1  palle FIXME openbsd
   1686  1.1  palle 	KERNEL_UNLOCK();
   1687  1.1  palle #else
   1688  1.1  palle 	KERNEL_UNLOCK_ONE(curlwp);
   1689  1.1  palle #endif
   1690  1.1  palle }
   1691  1.1  palle 
   1692  1.1  palle 
   1693  1.1  palle void
   1694  1.1  palle vnet_init(struct ifnet *ifp)
   1695  1.1  palle {
   1696  1.1  palle 
   1697  1.1  palle 	struct vnet_softc *sc = ifp->if_softc;
   1698  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
   1699  1.1  palle 	int err;
   1700  1.1  palle 	vaddr_t va;
   1701  1.1  palle 	paddr_t pa;
   1702  1.1  palle 
   1703  1.1  palle #if OPENBSD_BUSDMA
   1704  1.1  palle 	sc->sc_lm = ldc_map_alloc(sc->sc_dmatag, 2048);
   1705  1.1  palle #else
   1706  1.1  palle 	sc->sc_lm = ldc_map_alloc(2048);
   1707  1.1  palle #endif
   1708  1.1  palle 	if (sc->sc_lm == NULL)
   1709  1.1  palle 		return;
   1710  1.1  palle 
   1711  1.1  palle #if OPENBSD_BUSDMA
   1712  1.1  palle 	err = hv_ldc_set_map_table(lc->lc_id,
   1713  1.1  palle 							   sc->sc_lm->lm_map->dm_segs[0].ds_addr, sc->sc_lm->lm_nentries);
   1714  1.1  palle #else
   1715  1.1  palle 	va = (vaddr_t)sc->sc_lm->lm_slot;
   1716  1.1  palle 	pa = 0;
   1717  1.1  palle 	if (pmap_extract(pmap_kernel(), va, &pa) == FALSE)
   1718  1.1  palle 		panic("pmap_extract failed %lx\n", va);
   1719  1.1  palle 	err = hv_ldc_set_map_table(lc->lc_id, pa, 2048);
   1720  1.1  palle #endif
   1721  1.1  palle 	if (err != H_EOK) {
   1722  1.1  palle 		printf("hv_ldc_set_map_table %d\n", err);
   1723  1.1  palle 		return;
   1724  1.1  palle 	}
   1725  1.1  palle 
   1726  1.1  palle 	sc->sc_vd = vnet_dring_alloc(sc->sc_dmatag, VNET_NUM_SOFT_DESC);
   1727  1.1  palle 	if (sc->sc_vd == NULL)
   1728  1.1  palle 		return;
   1729  1.1  palle 	sc->sc_vsd = malloc(VNET_NUM_SOFT_DESC * sizeof(*sc->sc_vsd), M_DEVBUF,
   1730  1.1  palle 	    M_NOWAIT|M_ZERO);
   1731  1.1  palle 	if (sc->sc_vsd == NULL)
   1732  1.1  palle 		return;
   1733  1.1  palle 
   1734  1.1  palle 	sc->sc_lm->lm_slot[0].entry = sc->sc_vd->vd_map->dm_segs[0].ds_addr;
   1735  1.1  palle 	sc->sc_lm->lm_slot[0].entry &= LDC_MTE_RA_MASK;
   1736  1.1  palle 	sc->sc_lm->lm_slot[0].entry |= LDC_MTE_CPR | LDC_MTE_CPW;
   1737  1.1  palle 	sc->sc_lm->lm_next = 1;
   1738  1.1  palle 	sc->sc_lm->lm_count = 1;
   1739  1.1  palle 
   1740  1.1  palle #if OPENBSD_BUSDMA
   1741  1.1  palle 	err = hv_ldc_tx_qconf(lc->lc_id,
   1742  1.1  palle 						  lc->lc_txq->lq_map->dm_segs[0].ds_addr, lc->lc_txq->lq_nentries);
   1743  1.1  palle #else
   1744  1.1  palle 	err = hv_ldc_tx_qconf(lc->lc_id, pa, lc->lc_txq->lq_nentries);
   1745  1.1  palle #endif
   1746  1.1  palle 	if (err != H_EOK)
   1747  1.1  palle 		printf("hv_ldc_tx_qconf %d\n", err);
   1748  1.1  palle 
   1749  1.1  palle #if OPENBSD_BUSDMA
   1750  1.1  palle 	err = hv_ldc_rx_qconf(lc->lc_id,
   1751  1.1  palle 						  lc->lc_rxq->lq_map->dm_segs[0].ds_addr, lc->lc_rxq->lq_nentries);
   1752  1.1  palle #else
   1753  1.1  palle 	err = hv_ldc_rx_qconf(lc->lc_id, pa, lc->lc_rxq->lq_nentries);
   1754  1.1  palle #endif
   1755  1.1  palle 	if (err != H_EOK)
   1756  1.1  palle 		printf("hv_ldc_rx_qconf %d\n", err);
   1757  1.1  palle 
   1758  1.1  palle 	cbus_intr_setenabled(sc->sc_bustag, sc->sc_tx_ino, INTR_ENABLED);
   1759  1.1  palle 	cbus_intr_setenabled(sc->sc_bustag, sc->sc_rx_ino, INTR_ENABLED);
   1760  1.1  palle 
   1761  1.1  palle 	ldc_send_vers(lc);
   1762  1.1  palle 
   1763  1.1  palle 	ifp->if_flags |= IFF_RUNNING;
   1764  1.1  palle 
   1765  1.1  palle }
   1766  1.1  palle 
   1767  1.1  palle void
   1768  1.1  palle vnet_stop(struct ifnet *ifp)
   1769  1.1  palle 
   1770  1.1  palle {
   1771  1.1  palle 	struct vnet_softc *sc = ifp->if_softc;
   1772  1.1  palle 	struct ldc_conn *lc = &sc->sc_lc;
   1773  1.1  palle 
   1774  1.1  palle 	ifp->if_flags &= ~IFF_RUNNING;
   1775  1.1  palle #if 0
   1776  1.1  palle FIXME openbsd
   1777  1.1  palle 	ifq_clr_oactive(&ifp->if_snd);
   1778  1.1  palle #else
   1779  1.1  palle 	ifp->if_flags &= ~IFF_OACTIVE;
   1780  1.1  palle #endif
   1781  1.1  palle 	ifp->if_timer = 0;
   1782  1.1  palle 
   1783  1.1  palle 	cbus_intr_setenabled(sc->sc_bustag, sc->sc_tx_ino, INTR_DISABLED);
   1784  1.1  palle 	cbus_intr_setenabled(sc->sc_bustag, sc->sc_rx_ino, INTR_DISABLED);
   1785  1.1  palle 
   1786  1.1  palle #if 0
   1787  1.1  palle FIXME openbsd
   1788  1.1  palle 	intr_barrier(sc->sc_tx_ih);
   1789  1.1  palle 	intr_barrier(sc->sc_rx_ih);
   1790  1.1  palle #else
   1791  1.1  palle 	printf("vnet_stop() intr_barrier() FIXME\n");
   1792  1.1  palle #endif
   1793  1.1  palle 
   1794  1.1  palle 	hv_ldc_tx_qconf(lc->lc_id, 0, 0);
   1795  1.1  palle 	hv_ldc_rx_qconf(lc->lc_id, 0, 0);
   1796  1.1  palle 	lc->lc_tx_seqid = 0;
   1797  1.1  palle 	lc->lc_state = 0;
   1798  1.1  palle 	lc->lc_tx_state = lc->lc_rx_state = LDC_CHANNEL_DOWN;
   1799  1.1  palle 	vnet_ldc_reset(lc);
   1800  1.1  palle 
   1801  1.1  palle #if 0
   1802  1.1  palle FIXME openbsd
   1803  1.1  palle 	free(sc->sc_vsd, M_DEVBUF, VNET_NUM_SOFT_DESC * sizeof(*sc->sc_vsd));
   1804  1.1  palle #else
   1805  1.1  palle 	free(sc->sc_vsd, M_DEVBUF);
   1806  1.1  palle #endif
   1807  1.1  palle 
   1808  1.1  palle 	vnet_dring_free(sc->sc_dmatag, sc->sc_vd);
   1809  1.1  palle 
   1810  1.1  palle 	hv_ldc_set_map_table(lc->lc_id, 0, 0);
   1811  1.1  palle #if OPENBSD_BUSDMA
   1812  1.1  palle 	ldc_map_free(sc->sc_dmatag, sc->sc_lm);
   1813  1.1  palle #else
   1814  1.1  palle 	ldc_map_free(sc->sc_lm);
   1815  1.1  palle #endif
   1816  1.1  palle }
   1817  1.1  palle 
   1818  1.1  palle struct vnet_dring *
   1819  1.1  palle vnet_dring_alloc(bus_dma_tag_t t, int nentries)
   1820  1.1  palle {
   1821  1.1  palle 	struct vnet_dring *vd;
   1822  1.1  palle 	bus_size_t size;
   1823  1.1  palle 	vaddr_t va;
   1824  1.1  palle #if OPENBSD_BUSDMA
   1825  1.1  palle 	int nsegs;
   1826  1.1  palle #endif
   1827  1.1  palle 	int i;
   1828  1.1  palle 
   1829  1.1  palle 	vd = kmem_zalloc(sizeof(struct vnet_dring), KM_SLEEP);
   1830  1.1  palle 	if (vd == NULL)
   1831  1.1  palle 		return NULL;
   1832  1.1  palle 
   1833  1.1  palle 	size = roundup(nentries * sizeof(struct vnet_desc), PAGE_SIZE);
   1834  1.1  palle 
   1835  1.1  palle #if OPENBSD_BUSDMA
   1836  1.1  palle 	if (bus_dmamap_create(t, size, 1, size, 0,
   1837  1.1  palle 	    BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &vd->vd_map) != 0)
   1838  1.1  palle 		return (NULL);
   1839  1.1  palle 
   1840  1.1  palle 	if (bus_dmamem_alloc(t, size, PAGE_SIZE, 0, &vd->vd_seg, 1,
   1841  1.1  palle 	    &nsegs, BUS_DMA_NOWAIT) != 0)
   1842  1.1  palle 		goto destroy;
   1843  1.1  palle 
   1844  1.1  palle 	if (bus_dmamem_map(t, &vd->vd_seg, 1, size, &va,
   1845  1.1  palle 	    BUS_DMA_NOWAIT) != 0)
   1846  1.1  palle 		goto free;
   1847  1.1  palle 
   1848  1.1  palle 	if (bus_dmamap_load(t, vd->vd_map, va, size, NULL,
   1849  1.1  palle 	    BUS_DMA_NOWAIT) != 0)
   1850  1.1  palle 		goto unmap;
   1851  1.1  palle #else
   1852  1.1  palle 	va = (vaddr_t)kmem_zalloc(size, KM_SLEEP);
   1853  1.1  palle #endif
   1854  1.1  palle 	vd->vd_desc = (struct vnet_desc *)va;
   1855  1.1  palle 	vd->vd_nentries = nentries;
   1856  1.1  palle 	bzero(vd->vd_desc, nentries * sizeof(struct vnet_desc));
   1857  1.1  palle 	for (i = 0; i < vd->vd_nentries; i++)
   1858  1.1  palle 		vd->vd_desc[i].hdr.dstate = VIO_DESC_FREE;
   1859  1.1  palle 	return (vd);
   1860  1.1  palle 
   1861  1.1  palle #if OPENBSD_BUSDMA
   1862  1.1  palle unmap:
   1863  1.1  palle 	bus_dmamem_unmap(t, va, size);
   1864  1.1  palle free:
   1865  1.1  palle 	bus_dmamem_free(t, &vd->vd_seg, 1);
   1866  1.1  palle destroy:
   1867  1.1  palle 	bus_dmamap_destroy(t, vd->vd_map);
   1868  1.1  palle #endif
   1869  1.1  palle 	return (NULL);
   1870  1.1  palle }
   1871  1.1  palle 
   1872  1.1  palle void
   1873  1.1  palle vnet_dring_free(bus_dma_tag_t t, struct vnet_dring *vd)
   1874  1.1  palle {
   1875  1.1  palle 	bus_size_t size;
   1876  1.1  palle 
   1877  1.1  palle 	size = vd->vd_nentries * sizeof(struct vnet_desc);
   1878  1.1  palle 	size = roundup(size, PAGE_SIZE);
   1879  1.1  palle 
   1880  1.1  palle #if OPENBSD_BUSDMA
   1881  1.1  palle 	bus_dmamap_unload(t, vd->vd_map);
   1882  1.1  palle 	bus_dmamem_unmap(t, (caddr_t)vd->vd_desc, size);
   1883  1.1  palle 	bus_dmamem_free(t, &vd->vd_seg, 1);
   1884  1.1  palle 	bus_dmamap_destroy(t, vd->vd_map);
   1885  1.1  palle #else
   1886  1.1  palle 	kmem_free(vd->vd_desc, size);
   1887  1.1  palle #endif
   1888  1.1  palle 	kmem_free(vd, size);
   1889  1.1  palle }
   1890  1.1  palle 
   1891