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