Add a Xen Virtual Network device driver for Xenbus.
This commit is contained in:
bouyer
parent
60d4a96e28
commit
2e3fa7a73a
@ -1,4 +1,4 @@
|
|||||||
# $NetBSD: files.xen,v 1.35 2006/03/06 20:34:09 bouyer Exp $
|
# $NetBSD: files.xen,v 1.36 2006/03/06 20:36:12 bouyer Exp $
|
||||||
# NetBSD: files.x86,v 1.10 2003/10/08 17:30:00 bouyer Exp
|
# NetBSD: files.x86,v 1.10 2003/10/08 17:30:00 bouyer Exp
|
||||||
# NetBSD: files.i386,v 1.254 2004/03/25 23:32:10 jmc Exp
|
# NetBSD: files.i386,v 1.254 2004/03/25 23:32:10 jmc Exp
|
||||||
|
|
||||||
@ -146,8 +146,10 @@ defpseudo xenevt
|
|||||||
|
|
||||||
# Xen Network driver
|
# Xen Network driver
|
||||||
device xennet: arp, ether, ifnet
|
device xennet: arp, ether, ifnet
|
||||||
attach xennet at xendevbus
|
attach xennet at xendevbus with xennet_hypervisor
|
||||||
file arch/xen/xen/if_xennet.c xennet needs-flag
|
attach xennet at xenbus with xennet_xenbus
|
||||||
|
file arch/xen/xen/if_xennet_xenbus.c xennet_xenbus
|
||||||
|
file arch/xen/xen/if_xennet.c xennet_hypervisor needs-flag
|
||||||
|
|
||||||
# Xen Block device driver and wd/sd/cd identities
|
# Xen Block device driver and wd/sd/cd identities
|
||||||
device xbd: disk
|
device xbd: disk
|
||||||
|
|||||||
938
sys/arch/xen/xen/if_xennet_xenbus.c
Normal file
938
sys/arch/xen/xen/if_xennet_xenbus.c
Normal file
@ -0,0 +1,938 @@
|
|||||||
|
/* $NetBSD: if_xennet_xenbus.c,v 1.1 2006/03/06 20:36:12 bouyer Exp $ */
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2006 Manuel Bouyer.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. All advertising materials mentioning features or use of this software
|
||||||
|
* must display the following acknowledgement:
|
||||||
|
* This product includes software developed by Manuel Bouyer.
|
||||||
|
* 4. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2004 Christian Limpach.
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. All advertising materials mentioning features or use of this software
|
||||||
|
* must display the following acknowledgement:
|
||||||
|
* This product includes software developed by Christian Limpach.
|
||||||
|
* 4. The name of the author may not be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||||||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||||||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||||||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||||||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <sys/cdefs.h>
|
||||||
|
__KERNEL_RCSID(0, "$NetBSD: if_xennet_xenbus.c,v 1.1 2006/03/06 20:36:12 bouyer Exp $");
|
||||||
|
|
||||||
|
#include "opt_xen.h"
|
||||||
|
#include "rnd.h"
|
||||||
|
|
||||||
|
#include <sys/param.h>
|
||||||
|
#include <sys/device.h>
|
||||||
|
#include <sys/conf.h>
|
||||||
|
#include <sys/kernel.h>
|
||||||
|
#include <sys/systm.h>
|
||||||
|
#if NRND > 0
|
||||||
|
#include <sys/rnd.h>
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include <net/if.h>
|
||||||
|
#include <net/if_dl.h>
|
||||||
|
#include <net/if_ether.h>
|
||||||
|
|
||||||
|
#include <uvm/uvm.h>
|
||||||
|
|
||||||
|
#include <machine/xen3-public/io/ring.h>
|
||||||
|
|
||||||
|
#include <machine/granttables.h>
|
||||||
|
#include <machine/xenbus.h>
|
||||||
|
#include "locators.h"
|
||||||
|
|
||||||
|
#undef XENNET_DEBUG_DUMP
|
||||||
|
#undef XENNET_DEBUG
|
||||||
|
#ifdef XENNET_DEBUG
|
||||||
|
#define XEDB_FOLLOW 0x01
|
||||||
|
#define XEDB_INIT 0x02
|
||||||
|
#define XEDB_EVENT 0x04
|
||||||
|
#define XEDB_MBUF 0x08
|
||||||
|
#define XEDB_MEM 0x10
|
||||||
|
int xennet_debug = 0xff;
|
||||||
|
#define DPRINTF(x) if (xennet_debug) printf x;
|
||||||
|
#define DPRINTFN(n,x) if (xennet_debug & (n)) printf x;
|
||||||
|
#else
|
||||||
|
#define DPRINTF(x)
|
||||||
|
#define DPRINTFN(n,x)
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#define GRANT_INVALID_REF -1
|
||||||
|
|
||||||
|
#define NET_TX_RING_SIZE __RING_SIZE((netif_tx_sring_t *)0, PAGE_SIZE)
|
||||||
|
#define NET_RX_RING_SIZE __RING_SIZE((netif_rx_sring_t *)0, PAGE_SIZE)
|
||||||
|
|
||||||
|
struct xennet_txreq {
|
||||||
|
SLIST_ENTRY(xennet_txreq) txreq_next;
|
||||||
|
uint16_t txreq_id; /* ID passed to backed */
|
||||||
|
grant_ref_t txreq_gntref; /* grant ref of this request */
|
||||||
|
struct mbuf *txreq_m; /* mbuf being transmitted */
|
||||||
|
};
|
||||||
|
|
||||||
|
struct xennet_rxreq {
|
||||||
|
SLIST_ENTRY(xennet_rxreq) rxreq_next;
|
||||||
|
uint16_t rxreq_id; /* ID passed to backed */
|
||||||
|
grant_ref_t rxreq_gntref; /* grant ref of this request */
|
||||||
|
/* va/pa for this receive buf. ma will be provided by backend */
|
||||||
|
paddr_t rxreq_pa;
|
||||||
|
vaddr_t rxreq_va;
|
||||||
|
struct xennet_xenbus_softc *rxreq_sc; /* pointer to our interface */
|
||||||
|
};
|
||||||
|
|
||||||
|
struct xennet_xenbus_softc {
|
||||||
|
struct device sc_dev;
|
||||||
|
struct ethercom sc_ethercom;
|
||||||
|
uint8_t sc_enaddr[6];
|
||||||
|
struct xenbus_device *sc_xbusd;
|
||||||
|
|
||||||
|
netif_tx_front_ring_t sc_tx_ring;
|
||||||
|
netif_rx_front_ring_t sc_rx_ring;
|
||||||
|
|
||||||
|
unsigned int sc_evtchn;
|
||||||
|
void *sc_softintr;
|
||||||
|
|
||||||
|
grant_ref_t sc_tx_ring_gntref;
|
||||||
|
grant_ref_t sc_rx_ring_gntref;
|
||||||
|
|
||||||
|
struct xennet_txreq sc_txreqs[NET_TX_RING_SIZE];
|
||||||
|
struct xennet_rxreq sc_rxreqs[NET_RX_RING_SIZE];
|
||||||
|
SLIST_HEAD(,xennet_txreq) sc_txreq_head; /* list of free TX requests */
|
||||||
|
SLIST_HEAD(,xennet_rxreq) sc_rxreq_head; /* list of free RX requests */
|
||||||
|
int sc_free_rxreql; /* number of free receive request struct */
|
||||||
|
|
||||||
|
int sc_backend_status; /* our status with backend */
|
||||||
|
#define BEST_CLOSED 0
|
||||||
|
#define BEST_DISCONNECTED 1
|
||||||
|
#define BEST_CONNECTED 2
|
||||||
|
#if NRND > 0
|
||||||
|
rndsource_element_t sc_rnd_source;
|
||||||
|
#endif
|
||||||
|
};
|
||||||
|
|
||||||
|
/* too big to be on stack */
|
||||||
|
static multicall_entry_t rx_mcl[NET_RX_RING_SIZE+1];
|
||||||
|
static paddr_t xennet_pages[NET_RX_RING_SIZE];
|
||||||
|
|
||||||
|
static int xennet_xenbus_match(struct device *, struct cfdata *, void *);
|
||||||
|
static void xennet_xenbus_attach(struct device *, struct device *, void *);
|
||||||
|
|
||||||
|
static int xennet_xenbus_resume(void *);
|
||||||
|
static void xennet_alloc_rx_buffer(struct xennet_xenbus_softc *);
|
||||||
|
static void xennet_tx_complete(struct xennet_xenbus_softc *);
|
||||||
|
static void xennet_rx_mbuf_free(struct mbuf *, caddr_t, size_t, void *);
|
||||||
|
static int xennet_handler(void *);
|
||||||
|
#ifdef XENNET_DEBUG_DUMP
|
||||||
|
static void xennet_hex_dump(const unsigned char *, size_t, const char *, int);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
static int xennet_init(struct ifnet *);
|
||||||
|
static void xennet_stop(struct ifnet *, int);
|
||||||
|
static void xennet_reset(struct xennet_xenbus_softc *);
|
||||||
|
static void xennet_softstart(void *);
|
||||||
|
static void xennet_start(struct ifnet *);
|
||||||
|
static int xennet_ioctl(struct ifnet *, u_long, caddr_t);
|
||||||
|
static void xennet_watchdog(struct ifnet *);
|
||||||
|
|
||||||
|
CFATTACH_DECL(xennet_xenbus, sizeof(struct xennet_xenbus_softc),
|
||||||
|
xennet_xenbus_match, xennet_xenbus_attach, NULL, NULL);
|
||||||
|
|
||||||
|
static int
|
||||||
|
xennet_xenbus_match(struct device *parent, struct cfdata *match, void *aux)
|
||||||
|
{
|
||||||
|
struct xenbusdev_attach_args *xa = aux;
|
||||||
|
|
||||||
|
if (strcmp(xa->xa_type, "vif") != 0)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
if (match->cf_loc[XENBUSCF_ID] != XENBUSCF_ID_DEFAULT &&
|
||||||
|
match->cf_loc[XENBUSCF_ID] != xa->xa_id)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
xennet_xenbus_attach(struct device *parent, struct device *self, void *aux)
|
||||||
|
{
|
||||||
|
struct xennet_xenbus_softc *sc = (void *)self;
|
||||||
|
struct xenbusdev_attach_args *xa = aux;
|
||||||
|
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
|
||||||
|
int err;
|
||||||
|
RING_IDX i;
|
||||||
|
char *val, *e, *p;
|
||||||
|
int s;
|
||||||
|
extern int ifqmaxlen; /* XXX */
|
||||||
|
|
||||||
|
aprint_normal(": Xen Virtual Network Interface\n");
|
||||||
|
sc->sc_xbusd = xa->xa_xbusd;
|
||||||
|
/* initialize free RX and RX request lists */
|
||||||
|
SLIST_INIT(&sc->sc_txreq_head);
|
||||||
|
for (i = 0; i < NET_TX_RING_SIZE; i++) {
|
||||||
|
sc->sc_txreqs[i].txreq_id = i;
|
||||||
|
SLIST_INSERT_HEAD(&sc->sc_txreq_head, &sc->sc_txreqs[i],
|
||||||
|
txreq_next);
|
||||||
|
}
|
||||||
|
SLIST_INIT(&sc->sc_rxreq_head);
|
||||||
|
s = splvm();
|
||||||
|
for (i = 0; i < NET_RX_RING_SIZE; i++) {
|
||||||
|
struct xennet_rxreq *rxreq = &sc->sc_rxreqs[i];
|
||||||
|
rxreq->rxreq_id = i;
|
||||||
|
rxreq->rxreq_sc = sc;
|
||||||
|
rxreq->rxreq_va = uvm_km_alloc(kernel_map,
|
||||||
|
PAGE_SIZE, PAGE_SIZE, UVM_KMF_WIRED | UVM_KMF_ZERO);
|
||||||
|
if (rxreq->rxreq_va == 0)
|
||||||
|
break;
|
||||||
|
if (!pmap_extract(pmap_kernel(), rxreq->rxreq_va,
|
||||||
|
&rxreq->rxreq_pa))
|
||||||
|
panic("xennet: no pa for mapped va ?");
|
||||||
|
|
||||||
|
SLIST_INSERT_HEAD(&sc->sc_rxreq_head, rxreq, rxreq_next);
|
||||||
|
}
|
||||||
|
splx(s);
|
||||||
|
sc->sc_free_rxreql = i;
|
||||||
|
if (sc->sc_free_rxreql == 0) {
|
||||||
|
aprint_error("%s: failed to allocate rx memory\n",
|
||||||
|
sc->sc_dev.dv_xname);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* read mac address */
|
||||||
|
err = xenbus_read(NULL, xa->xa_xbusd->xbusd_path, "mac", NULL, &val);
|
||||||
|
if (err) {
|
||||||
|
aprint_error("%s: can't read mac address, err %d\n",
|
||||||
|
sc->sc_dev.dv_xname, err);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
/* read mac address */
|
||||||
|
for (i = 0, p = val; i < 6; i++) {
|
||||||
|
sc->sc_enaddr[i] = strtoul(p, &e, 16);
|
||||||
|
if ((e[0] == '\0' && i != 5) && e[0] != ':') {
|
||||||
|
aprint_error("%s: %s is not a valid mac address\n",
|
||||||
|
sc->sc_dev.dv_xname, val);
|
||||||
|
free(val, M_DEVBUF);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
p = &e[1];
|
||||||
|
}
|
||||||
|
free(val, M_DEVBUF);
|
||||||
|
aprint_normal("%s: MAC address %s\n", sc->sc_dev.dv_xname,
|
||||||
|
ether_sprintf(sc->sc_enaddr));
|
||||||
|
/* Initialize ifnet structure and attach interface */
|
||||||
|
memcpy(ifp->if_xname, sc->sc_dev.dv_xname, IFNAMSIZ);
|
||||||
|
ifp->if_softc = sc;
|
||||||
|
ifp->if_start = xennet_start;
|
||||||
|
ifp->if_ioctl = xennet_ioctl;
|
||||||
|
ifp->if_watchdog = xennet_watchdog;
|
||||||
|
ifp->if_init = xennet_init;
|
||||||
|
ifp->if_stop = xennet_stop;
|
||||||
|
ifp->if_flags = IFF_BROADCAST|IFF_SIMPLEX|IFF_NOTRAILERS|IFF_MULTICAST;
|
||||||
|
ifp->if_timer = 0;
|
||||||
|
ifp->if_snd.ifq_maxlen = max(ifqmaxlen, NET_TX_RING_SIZE * 2);
|
||||||
|
IFQ_SET_READY(&ifp->if_snd);
|
||||||
|
if_attach(ifp);
|
||||||
|
ether_ifattach(ifp, sc->sc_enaddr);
|
||||||
|
sc->sc_softintr = softintr_establish(IPL_SOFTNET, xennet_softstart, sc);
|
||||||
|
if (sc->sc_softintr == NULL)
|
||||||
|
panic(" xennet: can't establish soft interrupt");
|
||||||
|
|
||||||
|
/* initialise shared structures and tell backend that we are ready */
|
||||||
|
xennet_xenbus_resume(sc);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int
|
||||||
|
xennet_xenbus_resume(void *p)
|
||||||
|
{
|
||||||
|
struct xennet_xenbus_softc *sc = p;
|
||||||
|
struct xenbus_transaction *xbt;
|
||||||
|
int error;
|
||||||
|
netif_tx_sring_t *tx_ring;
|
||||||
|
netif_rx_sring_t *rx_ring;
|
||||||
|
paddr_t ma;
|
||||||
|
const char *errmsg;
|
||||||
|
|
||||||
|
sc->sc_tx_ring_gntref = GRANT_INVALID_REF;
|
||||||
|
sc->sc_rx_ring_gntref = GRANT_INVALID_REF;
|
||||||
|
|
||||||
|
|
||||||
|
/* setup device: alloc event channel and shared rings */
|
||||||
|
tx_ring =
|
||||||
|
(void *)uvm_km_alloc(kernel_map, PAGE_SIZE, 0, UVM_KMF_ZERO);
|
||||||
|
rx_ring =
|
||||||
|
(void *)uvm_km_alloc(kernel_map, PAGE_SIZE, 0, UVM_KMF_ZERO);
|
||||||
|
if (tx_ring == NULL || rx_ring == NULL)
|
||||||
|
panic("xennet_xenbus_resume: can't alloc rings");
|
||||||
|
|
||||||
|
SHARED_RING_INIT(tx_ring);
|
||||||
|
FRONT_RING_INIT(&sc->sc_tx_ring, tx_ring, PAGE_SIZE);
|
||||||
|
SHARED_RING_INIT(rx_ring);
|
||||||
|
FRONT_RING_INIT(&sc->sc_rx_ring, rx_ring, PAGE_SIZE);
|
||||||
|
|
||||||
|
(void)pmap_extract_ma(pmap_kernel(), (vaddr_t)tx_ring, &ma);
|
||||||
|
error = xenbus_grant_ring(sc->sc_xbusd, ma, &sc->sc_tx_ring_gntref);
|
||||||
|
if (error)
|
||||||
|
return error;
|
||||||
|
(void)pmap_extract_ma(pmap_kernel(), (vaddr_t)rx_ring, &ma);
|
||||||
|
error = xenbus_grant_ring(sc->sc_xbusd, ma, &sc->sc_rx_ring_gntref);
|
||||||
|
if (error)
|
||||||
|
return error;
|
||||||
|
error = xenbus_alloc_evtchn(sc->sc_xbusd, &sc->sc_evtchn);
|
||||||
|
if (error)
|
||||||
|
return error;
|
||||||
|
aprint_verbose("%s: using event channel %d\n",
|
||||||
|
sc->sc_dev.dv_xname, sc->sc_evtchn);
|
||||||
|
event_set_handler(sc->sc_evtchn, &xennet_handler, sc,
|
||||||
|
IPL_NET, sc->sc_dev.dv_xname);
|
||||||
|
|
||||||
|
again:
|
||||||
|
xbt = xenbus_transaction_start();
|
||||||
|
if (xbt == NULL)
|
||||||
|
return ENOMEM;
|
||||||
|
error = xenbus_printf(xbt, sc->sc_xbusd->xbusd_path,
|
||||||
|
"tx-ring-ref","%u", sc->sc_tx_ring_gntref);
|
||||||
|
if (error) {
|
||||||
|
errmsg = "writing tx ring-ref";
|
||||||
|
goto abort_transaction;
|
||||||
|
}
|
||||||
|
error = xenbus_printf(xbt, sc->sc_xbusd->xbusd_path,
|
||||||
|
"rx-ring-ref","%u", sc->sc_rx_ring_gntref);
|
||||||
|
if (error) {
|
||||||
|
errmsg = "writing rx ring-ref";
|
||||||
|
goto abort_transaction;
|
||||||
|
}
|
||||||
|
error = xenbus_printf(xbt, sc->sc_xbusd->xbusd_path,
|
||||||
|
"event-channel", "%u", sc->sc_evtchn);
|
||||||
|
if (error) {
|
||||||
|
errmsg = "writing event channel";
|
||||||
|
goto abort_transaction;
|
||||||
|
}
|
||||||
|
error = xenbus_printf(xbt, sc->sc_xbusd->xbusd_path,
|
||||||
|
"state", "%d", XenbusStateConnected);
|
||||||
|
if (error) {
|
||||||
|
errmsg = "writing frontend XenbusStateConnected";
|
||||||
|
goto abort_transaction;
|
||||||
|
}
|
||||||
|
error = xenbus_transaction_end(xbt, 0);
|
||||||
|
if (error == EAGAIN)
|
||||||
|
goto again;
|
||||||
|
if (error) {
|
||||||
|
xenbus_dev_fatal(sc->sc_xbusd, error, "completing transaction");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
sc->sc_backend_status = BEST_CONNECTED;
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
abort_transaction:
|
||||||
|
xenbus_transaction_end(xbt, 1);
|
||||||
|
xenbus_dev_fatal(sc->sc_xbusd, error, "%s", errmsg);
|
||||||
|
return error;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
xennet_alloc_rx_buffer(struct xennet_xenbus_softc *sc)
|
||||||
|
{
|
||||||
|
RING_IDX req_prod = sc->sc_rx_ring.req_prod_pvt;
|
||||||
|
RING_IDX i;
|
||||||
|
struct xennet_rxreq *req;
|
||||||
|
struct xen_memory_reservation reservation;
|
||||||
|
int s1, s2;
|
||||||
|
paddr_t pfn;
|
||||||
|
|
||||||
|
s1 = splnet();
|
||||||
|
for (i = 0; sc->sc_free_rxreql != 0; i++) {
|
||||||
|
req = SLIST_FIRST(&sc->sc_rxreq_head);
|
||||||
|
KASSERT(req != NULL);
|
||||||
|
RING_GET_REQUEST(&sc->sc_rx_ring, req_prod + i)->id =
|
||||||
|
req->rxreq_id;
|
||||||
|
if (xengnt_grant_transfer(sc->sc_xbusd->xbusd_otherend_id,
|
||||||
|
&req->rxreq_gntref) != 0) {
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
RING_GET_REQUEST(&sc->sc_rx_ring, req_prod + i)->gref =
|
||||||
|
req->rxreq_gntref;
|
||||||
|
|
||||||
|
SLIST_REMOVE_HEAD(&sc->sc_rxreq_head, rxreq_next);
|
||||||
|
sc->sc_free_rxreql--;
|
||||||
|
|
||||||
|
/* unmap the page */
|
||||||
|
MULTI_update_va_mapping(&rx_mcl[i], req->rxreq_va, 0, 0);
|
||||||
|
/*
|
||||||
|
* Remove this page from pseudo phys map before
|
||||||
|
* passing back to Xen.
|
||||||
|
*/
|
||||||
|
pfn = (req->rxreq_pa - XPMAP_OFFSET) >> PAGE_SHIFT;
|
||||||
|
xennet_pages[i] = xpmap_phys_to_machine_mapping[pfn];
|
||||||
|
xpmap_phys_to_machine_mapping[pfn] = INVALID_P2M_ENTRY;
|
||||||
|
}
|
||||||
|
if (i == 0) {
|
||||||
|
splx(s1);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
/* also make sure to flush all TLB entries */
|
||||||
|
rx_mcl[i-1].args[MULTI_UVMFLAGS_INDEX] = UVMF_TLB_FLUSH|UVMF_ALL;
|
||||||
|
/*
|
||||||
|
* We may have allocated buffers which have entries
|
||||||
|
* outstanding in the page update queue -- make sure we flush
|
||||||
|
* those first!
|
||||||
|
*/
|
||||||
|
s2 = splvm();
|
||||||
|
xpq_flush_queue();
|
||||||
|
splx(s2);
|
||||||
|
/* now decrease reservation */
|
||||||
|
reservation.extent_start = xennet_pages;
|
||||||
|
reservation.nr_extents = i;
|
||||||
|
reservation.extent_order = 0;
|
||||||
|
reservation.address_bits = 0;
|
||||||
|
reservation.domid = DOMID_SELF;
|
||||||
|
rx_mcl[i].op = __HYPERVISOR_memory_op;
|
||||||
|
rx_mcl[i].args[0] = XENMEM_decrease_reservation;
|
||||||
|
rx_mcl[i].args[1] = (unsigned long)&reservation;
|
||||||
|
HYPERVISOR_multicall(rx_mcl, i+1);
|
||||||
|
if (__predict_false(rx_mcl[i].result != i)) {
|
||||||
|
panic("xennet_alloc_rx_buffer: XENMEM_decrease_reservation");
|
||||||
|
}
|
||||||
|
sc->sc_rx_ring.req_prod_pvt = req_prod + i;
|
||||||
|
RING_PUSH_REQUESTS(&sc->sc_rx_ring);
|
||||||
|
|
||||||
|
splx(s1);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
xennet_rx_mbuf_free(struct mbuf *m, caddr_t buf, size_t size, void *arg)
|
||||||
|
{
|
||||||
|
struct xennet_rxreq *req = arg;
|
||||||
|
struct xennet_xenbus_softc *sc = req->rxreq_sc;
|
||||||
|
|
||||||
|
SLIST_INSERT_HEAD(&sc->sc_rxreq_head, req, rxreq_next);
|
||||||
|
sc->sc_free_rxreql++;
|
||||||
|
|
||||||
|
if (sc->sc_free_rxreql >= NET_RX_RING_SIZE / 2)
|
||||||
|
xennet_alloc_rx_buffer(sc);
|
||||||
|
|
||||||
|
if (m)
|
||||||
|
pool_cache_put(&mbpool_cache, m);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void
|
||||||
|
xennet_tx_complete(struct xennet_xenbus_softc * sc)
|
||||||
|
{
|
||||||
|
struct xennet_txreq *req;
|
||||||
|
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
|
||||||
|
RING_IDX resp_prod, i;
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_EVENT, ("xennet_tx_complete prod %d cons %d\n",
|
||||||
|
sc->sc_tx_ring.sring->rsp_prod, sc->sc_tx_ring.rsp_cons));
|
||||||
|
|
||||||
|
again:
|
||||||
|
resp_prod = sc->sc_tx_ring.sring->rsp_prod;
|
||||||
|
x86_lfence();
|
||||||
|
for (i = sc->sc_tx_ring.rsp_cons; i != resp_prod; i++) {
|
||||||
|
req = &sc->sc_txreqs[RING_GET_RESPONSE(&sc->sc_tx_ring, i)->id];
|
||||||
|
KASSERT(req->txreq_id ==
|
||||||
|
RING_GET_RESPONSE(&sc->sc_tx_ring, i)->id);
|
||||||
|
if (__predict_false(xengnt_status(req->txreq_gntref))) {
|
||||||
|
printf("%s: grant still used by backend\n",
|
||||||
|
sc->sc_dev.dv_xname);
|
||||||
|
sc->sc_tx_ring.rsp_cons = i;
|
||||||
|
goto end;
|
||||||
|
}
|
||||||
|
xengnt_revoke_access(req->txreq_gntref);
|
||||||
|
m_freem(req->txreq_m);
|
||||||
|
SLIST_INSERT_HEAD(&sc->sc_txreq_head, req, txreq_next);
|
||||||
|
}
|
||||||
|
sc->sc_tx_ring.rsp_cons = resp_prod;
|
||||||
|
/* set new event and check fopr race with rsp_cons update */
|
||||||
|
sc->sc_tx_ring.sring->rsp_event =
|
||||||
|
resp_prod + ((sc->sc_tx_ring.sring->req_prod - resp_prod) >> 1) + 1;
|
||||||
|
ifp->if_timer = 0;
|
||||||
|
x86_sfence();
|
||||||
|
if (resp_prod != sc->sc_tx_ring.sring->rsp_prod)
|
||||||
|
goto again;
|
||||||
|
end:
|
||||||
|
if (ifp->if_flags & IFF_OACTIVE) {
|
||||||
|
ifp->if_flags &= ~IFF_OACTIVE;
|
||||||
|
xennet_softstart(sc);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int
|
||||||
|
xennet_handler(void *arg)
|
||||||
|
{
|
||||||
|
struct xennet_xenbus_softc *sc = arg;
|
||||||
|
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
|
||||||
|
RING_IDX resp_prod, i;
|
||||||
|
struct xennet_rxreq *req;
|
||||||
|
paddr_t ma, pa;
|
||||||
|
vaddr_t va;
|
||||||
|
mmu_update_t mmu[1];
|
||||||
|
multicall_entry_t mcl[2];
|
||||||
|
struct mbuf *m;
|
||||||
|
void *pktp;
|
||||||
|
int more_to_do;
|
||||||
|
|
||||||
|
if (sc->sc_backend_status != BEST_CONNECTED)
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
xennet_tx_complete(sc);
|
||||||
|
|
||||||
|
again:
|
||||||
|
DPRINTFN(XEDB_EVENT, ("xennet_handler prod %d cons %d\n",
|
||||||
|
sc->sc_rx_ring.sring->rsp_prod, sc->sc_rx_ring.rsp_cons));
|
||||||
|
|
||||||
|
resp_prod = sc->sc_rx_ring.sring->rsp_prod;
|
||||||
|
x86_lfence(); /* ensure we see replies up to resp_prod */
|
||||||
|
for (i = sc->sc_rx_ring.rsp_cons; i != resp_prod; i++) {
|
||||||
|
netif_rx_response_t *rx = RING_GET_RESPONSE(&sc->sc_rx_ring, i);
|
||||||
|
req = &sc->sc_rxreqs[rx->id];
|
||||||
|
KASSERT(req->xennet_req_gnttref != GRANT_INVALID_REF);
|
||||||
|
ma = xengnt_revoke_transfer(req->rxreq_gntref);
|
||||||
|
if (ma == 0) {
|
||||||
|
/*
|
||||||
|
* the remote could't send us a packet.
|
||||||
|
* we can't free this rxreq as no page will be mapped
|
||||||
|
* here. Instead give it back immediatly to backend.
|
||||||
|
*/
|
||||||
|
ifp->if_ierrors++;
|
||||||
|
RING_GET_REQUEST(&sc->sc_rx_ring,
|
||||||
|
sc->sc_rx_ring.req_prod_pvt)->id = req->rxreq_id;
|
||||||
|
RING_GET_REQUEST(&sc->sc_rx_ring,
|
||||||
|
sc->sc_rx_ring.req_prod_pvt)->gref =
|
||||||
|
req->rxreq_gntref;
|
||||||
|
sc->sc_rx_ring.req_prod_pvt++;
|
||||||
|
RING_PUSH_REQUESTS(&sc->sc_rx_ring);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
MGETHDR(m, M_DONTWAIT, MT_DATA);
|
||||||
|
if (__predict_false(m == NULL)) {
|
||||||
|
printf("xennet: rx no mbuf\n");
|
||||||
|
ifp->if_ierrors++;
|
||||||
|
sc->sc_rx_ring.rsp_cons = i;
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
pa = req->rxreq_pa;
|
||||||
|
va = req->rxreq_va;
|
||||||
|
/* remap the page */
|
||||||
|
mmu[0].ptr = (ma << PAGE_SHIFT) | MMU_MACHPHYS_UPDATE;
|
||||||
|
mmu[0].val = ((pa - XPMAP_OFFSET) >> PAGE_SHIFT);
|
||||||
|
MULTI_update_va_mapping(&mcl[0], va,
|
||||||
|
(ma << PAGE_SHIFT) | PG_V | PG_KW, UVMF_TLB_FLUSH|UVMF_ALL);
|
||||||
|
xpmap_phys_to_machine_mapping[
|
||||||
|
(pa - XPMAP_OFFSET) >> PAGE_SHIFT] = ma;
|
||||||
|
mcl[1].op = __HYPERVISOR_mmu_update;
|
||||||
|
mcl[1].args[0] = (unsigned long)mmu;
|
||||||
|
mcl[1].args[1] = 1;
|
||||||
|
mcl[1].args[2] = 0;
|
||||||
|
mcl[1].args[3] = DOMID_SELF;
|
||||||
|
HYPERVISOR_multicall(mcl, 2);
|
||||||
|
pktp = (void *)(va + rx->offset);
|
||||||
|
#ifdef XENNET_DEBUG_DUMP
|
||||||
|
xennet_hex_dump(pktp, rx->status, "r", rx->id);
|
||||||
|
#endif
|
||||||
|
if ((ifp->if_flags & IFF_PROMISC) == 0) {
|
||||||
|
struct ether_header *eh = pktp;
|
||||||
|
if (ETHER_IS_MULTICAST(eh->ether_dhost) == 0 &&
|
||||||
|
memcmp(LLADDR(ifp->if_sadl), eh->ether_dhost,
|
||||||
|
ETHER_ADDR_LEN) != 0) {
|
||||||
|
/* packet not for us */
|
||||||
|
xennet_rx_mbuf_free(NULL, (void *)va, PAGE_SIZE,
|
||||||
|
req);
|
||||||
|
m_freem(m);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
m->m_pkthdr.rcvif = ifp;
|
||||||
|
if (__predict_true(sc->sc_rx_ring.req_prod_pvt !=
|
||||||
|
sc->sc_rx_ring.sring->rsp_prod)) {
|
||||||
|
m->m_len = m->m_pkthdr.len = rx->status;
|
||||||
|
MEXTADD(m, pktp, rx->status,
|
||||||
|
M_DEVBUF, xennet_rx_mbuf_free, req);
|
||||||
|
} else {
|
||||||
|
/*
|
||||||
|
* This was our last receive buffer, allocate
|
||||||
|
* memory, copy data and push the receive
|
||||||
|
* buffer back to the hypervisor.
|
||||||
|
*/
|
||||||
|
m->m_len = MHLEN;
|
||||||
|
m->m_pkthdr.len = 0;
|
||||||
|
m_copyback(m, 0, rx->status, pktp);
|
||||||
|
xennet_rx_mbuf_free(NULL, (void *)va, PAGE_SIZE, req);
|
||||||
|
if (m->m_pkthdr.len < rx->status) {
|
||||||
|
/* out of memory, just drop packets */
|
||||||
|
ifp->if_ierrors++;
|
||||||
|
m_freem(m);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#if NBPFILTER > 0
|
||||||
|
/*
|
||||||
|
* Pass packet to bpf if there is a listener.
|
||||||
|
*/
|
||||||
|
if (ifp->if_bpf)
|
||||||
|
bpf_mtap(ifp->if_bpf, m);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
ifp->if_ipackets++;
|
||||||
|
|
||||||
|
/* Pass the packet up. */
|
||||||
|
(*ifp->if_input)(ifp, m);
|
||||||
|
}
|
||||||
|
x86_lfence();
|
||||||
|
sc->sc_rx_ring.rsp_cons = i;
|
||||||
|
RING_FINAL_CHECK_FOR_RESPONSES(&sc->sc_rx_ring, more_to_do);
|
||||||
|
if (more_to_do)
|
||||||
|
goto again;
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Called at splnet.
|
||||||
|
*/
|
||||||
|
void
|
||||||
|
xennet_start(struct ifnet *ifp)
|
||||||
|
{
|
||||||
|
struct xennet_xenbus_softc *sc = ifp->if_softc;
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_FOLLOW, ("%s: xennet_start()\n", sc->sc_dev.dv_xname));
|
||||||
|
|
||||||
|
#if NRND > 0
|
||||||
|
rnd_add_uint32(&sc->sc_rnd_source, sc->sc_tx_ring.req_prod_pvt);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
xennet_tx_complete(sc);
|
||||||
|
|
||||||
|
if (__predict_false(
|
||||||
|
(ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING))
|
||||||
|
return;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The Xen communication channel is much more efficient if we can
|
||||||
|
* schedule batch of packets for domain0. To achieve this, we
|
||||||
|
* schedule a soft interrupt, and just return. This way, the network
|
||||||
|
* stack will enqueue all pending mbufs in the interface's send queue
|
||||||
|
* before it is processed by xennet_softstart().
|
||||||
|
*/
|
||||||
|
softintr_schedule(sc->sc_softintr);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* called at splsoftnet
|
||||||
|
*/
|
||||||
|
void
|
||||||
|
xennet_softstart(void *arg)
|
||||||
|
{
|
||||||
|
struct xennet_xenbus_softc *sc = arg;
|
||||||
|
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
|
||||||
|
struct mbuf *m, *new_m;
|
||||||
|
netif_tx_request_t *txreq;
|
||||||
|
RING_IDX req_prod;
|
||||||
|
paddr_t pa, pa2;
|
||||||
|
struct xennet_txreq *req;
|
||||||
|
int notify;
|
||||||
|
int do_notify = 0;
|
||||||
|
int s;
|
||||||
|
|
||||||
|
s = splnet();
|
||||||
|
if (__predict_false(
|
||||||
|
(ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)) {
|
||||||
|
splx(s);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
req_prod = sc->sc_tx_ring.req_prod_pvt;
|
||||||
|
while (/*CONSTCOND*/1) {
|
||||||
|
req = SLIST_FIRST(&sc->sc_txreq_head);
|
||||||
|
if (__predict_false(req == NULL)) {
|
||||||
|
ifp->if_flags |= IFF_OACTIVE;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
IFQ_POLL(&ifp->if_snd, m);
|
||||||
|
if (m == NULL)
|
||||||
|
break;
|
||||||
|
|
||||||
|
switch (m->m_flags & (M_EXT|M_EXT_CLUSTER)) {
|
||||||
|
case M_EXT|M_EXT_CLUSTER:
|
||||||
|
KASSERT(m->m_ext.ext_paddr != M_PADDR_INVALID);
|
||||||
|
pa = m->m_ext.ext_paddr +
|
||||||
|
(m->m_data - m->m_ext.ext_buf);
|
||||||
|
break;
|
||||||
|
case 0:
|
||||||
|
KASSERT(m->m_paddr != M_PADDR_INVALID);
|
||||||
|
pa = m->m_paddr + M_BUFOFFSET(m) +
|
||||||
|
(m->m_data - M_BUFADDR(m));
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
if (__predict_false(
|
||||||
|
!pmap_extract(pmap_kernel(), (vaddr_t)m->m_data,
|
||||||
|
&pa))) {
|
||||||
|
panic("xennet_start: no pa");
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (m->m_pkthdr.len != m->m_len ||
|
||||||
|
(pa ^ (pa + m->m_pkthdr.len - 1)) & PG_FRAME) {
|
||||||
|
|
||||||
|
MGETHDR(new_m, M_DONTWAIT, MT_DATA);
|
||||||
|
if (__predict_false(new_m == NULL)) {
|
||||||
|
printf("xennet: no mbuf\n");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (m->m_pkthdr.len > MHLEN) {
|
||||||
|
MCLGET(new_m, M_DONTWAIT);
|
||||||
|
if (__predict_false(
|
||||||
|
(new_m->m_flags & M_EXT) == 0)) {
|
||||||
|
DPRINTF(("xennet: no mbuf cluster\n"));
|
||||||
|
m_freem(new_m);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
m_copydata(m, 0, m->m_pkthdr.len, mtod(new_m, caddr_t));
|
||||||
|
new_m->m_len = new_m->m_pkthdr.len = m->m_pkthdr.len;
|
||||||
|
|
||||||
|
if ((new_m->m_flags & M_EXT) != 0) {
|
||||||
|
pa = new_m->m_ext.ext_paddr;
|
||||||
|
KASSERT(new_m->m_data == new_m->m_ext.ext_buf);
|
||||||
|
KASSERT(pa != M_PADDR_INVALID);
|
||||||
|
} else {
|
||||||
|
pa = new_m->m_paddr;
|
||||||
|
KASSERT(pa != M_PADDR_INVALID);
|
||||||
|
KASSERT(new_m->m_data == M_BUFADDR(new_m));
|
||||||
|
pa += M_BUFOFFSET(new_m);
|
||||||
|
}
|
||||||
|
if (__predict_false(xengnt_grant_access(
|
||||||
|
sc->sc_xbusd->xbusd_otherend_id,
|
||||||
|
xpmap_ptom_masked(pa),
|
||||||
|
GNTMAP_readonly, &req->txreq_gntref) != 0)) {
|
||||||
|
m_freem(new_m);
|
||||||
|
ifp->if_flags |= IFF_OACTIVE;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
/* we will be able to send new_m */
|
||||||
|
IFQ_DEQUEUE(&ifp->if_snd, m);
|
||||||
|
m_freem(m);
|
||||||
|
m = new_m;
|
||||||
|
} else {
|
||||||
|
if (__predict_false(xengnt_grant_access(
|
||||||
|
sc->sc_xbusd->xbusd_otherend_id,
|
||||||
|
xpmap_ptom_masked(pa),
|
||||||
|
GNTMAP_readonly, &req->txreq_gntref) != 0)) {
|
||||||
|
ifp->if_flags |= IFF_OACTIVE;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
/* we will be able to send m */
|
||||||
|
IFQ_DEQUEUE(&ifp->if_snd, m);
|
||||||
|
}
|
||||||
|
|
||||||
|
KASSERT(((pa ^ (pa + m->m_pkthdr.len - 1)) & PG_FRAME) == 0);
|
||||||
|
|
||||||
|
SLIST_REMOVE_HEAD(&sc->sc_txreq_head, txreq_next);
|
||||||
|
req->txreq_m = m;
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_MBUF, ("xennet_start id %d, "
|
||||||
|
"mbuf %p, buf %p/%p/%p, size %d\n",
|
||||||
|
req->txreq_id, m, mtod(m, void *), (void *)pa,
|
||||||
|
(void *)xpmap_ptom_masked(pa), m->m_pkthdr.len));
|
||||||
|
pmap_extract_ma(pmap_kernel(), mtod(m, vaddr_t), &pa2);
|
||||||
|
DPRINTFN(XEDB_MBUF, ("xennet_start pa %p ma %p/%p\n",
|
||||||
|
(void *)pa, (void *)xpmap_ptom_masked(pa), (void *)pa2));
|
||||||
|
#ifdef XENNET_DEBUG_DUMP
|
||||||
|
xennet_hex_dump(mtod(m, u_char *), m->m_pkthdr.len, "s", req->txreq_id);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
txreq = RING_GET_REQUEST(&sc->sc_tx_ring, req_prod);
|
||||||
|
txreq->id = req->txreq_id;
|
||||||
|
txreq->gref = req->txreq_gntref;
|
||||||
|
txreq->offset = pa & ~PG_FRAME;
|
||||||
|
txreq->size = m->m_pkthdr.len;
|
||||||
|
txreq->flags = 0;
|
||||||
|
|
||||||
|
req_prod++;
|
||||||
|
sc->sc_tx_ring.req_prod_pvt = req_prod;
|
||||||
|
RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&sc->sc_tx_ring, notify);
|
||||||
|
if (notify)
|
||||||
|
do_notify = 1;
|
||||||
|
|
||||||
|
#ifdef XENNET_DEBUG
|
||||||
|
DPRINTFN(XEDB_MEM, ("packet addr %p/%p, physical %p/%p, "
|
||||||
|
"m_paddr %p, len %d/%d\n", M_BUFADDR(m), mtod(m, void *),
|
||||||
|
(void *)*kvtopte(mtod(m, vaddr_t)),
|
||||||
|
(void *)xpmap_mtop(*kvtopte(mtod(m, vaddr_t))),
|
||||||
|
(void *)m->m_paddr, m->m_pkthdr.len, m->m_len));
|
||||||
|
DPRINTFN(XEDB_MEM, ("id %d gref %d offset %d size %d flags %d"
|
||||||
|
" prod %d\n",
|
||||||
|
txreq->id, txreq->gref, txreq->offset, txreq->size,
|
||||||
|
txreq->flags, req_prod));
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if NBPFILTER > 0
|
||||||
|
/*
|
||||||
|
* Pass packet to bpf if there is a listener.
|
||||||
|
*/
|
||||||
|
if (ifp->if_bpf) {
|
||||||
|
bpf_mtap(ifp->if_bpf, m);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
x86_lfence();
|
||||||
|
if (do_notify) {
|
||||||
|
hypervisor_notify_via_evtchn(sc->sc_evtchn);
|
||||||
|
ifp->if_timer = 5;
|
||||||
|
}
|
||||||
|
splx(s);
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_FOLLOW, ("%s: xennet_start() done\n",
|
||||||
|
sc->sc_dev.dv_xname));
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
xennet_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
|
||||||
|
{
|
||||||
|
#ifdef XENNET_DEBUG
|
||||||
|
struct xennet_xenbus_softc *sc = ifp->if_softc;
|
||||||
|
#endif
|
||||||
|
int s, error = 0;
|
||||||
|
|
||||||
|
s = splnet();
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_FOLLOW, ("%s: xennet_ioctl()\n", sc->sc_dev.dv_xname));
|
||||||
|
error = ether_ioctl(ifp, cmd, data);
|
||||||
|
if (error == ENETRESET)
|
||||||
|
error = 0;
|
||||||
|
splx(s);
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_FOLLOW, ("%s: xennet_ioctl() returning %d\n",
|
||||||
|
sc->sc_dev.dv_xname, error));
|
||||||
|
|
||||||
|
return error;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
xennet_watchdog(struct ifnet *ifp)
|
||||||
|
{
|
||||||
|
struct xennet_xenbus_softc *sc = ifp->if_softc;
|
||||||
|
|
||||||
|
printf("%s: xennet_watchdog\n", sc->sc_dev.dv_xname);
|
||||||
|
}
|
||||||
|
|
||||||
|
int
|
||||||
|
xennet_init(struct ifnet *ifp)
|
||||||
|
{
|
||||||
|
struct xennet_xenbus_softc *sc = ifp->if_softc;
|
||||||
|
int s = splnet();
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_FOLLOW, ("%s: xennet_init()\n", sc->sc_dev.dv_xname));
|
||||||
|
|
||||||
|
if (ifp->if_flags & IFF_UP) {
|
||||||
|
if ((ifp->if_flags & IFF_RUNNING) == 0) {
|
||||||
|
xennet_alloc_rx_buffer(sc);
|
||||||
|
sc->sc_rx_ring.sring->rsp_event =
|
||||||
|
sc->sc_rx_ring.rsp_cons + 1;
|
||||||
|
hypervisor_enable_event(sc->sc_evtchn);
|
||||||
|
hypervisor_notify_via_evtchn(sc->sc_evtchn);
|
||||||
|
xennet_reset(sc);
|
||||||
|
}
|
||||||
|
ifp->if_flags |= IFF_RUNNING;
|
||||||
|
ifp->if_flags &= ~IFF_OACTIVE;
|
||||||
|
ifp->if_timer = 0;
|
||||||
|
} else {
|
||||||
|
ifp->if_flags &= ~IFF_RUNNING;
|
||||||
|
xennet_reset(sc);
|
||||||
|
}
|
||||||
|
splx(s);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
xennet_stop(struct ifnet *ifp, int disable)
|
||||||
|
{
|
||||||
|
ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
xennet_reset(struct xennet_xenbus_softc *sc)
|
||||||
|
{
|
||||||
|
|
||||||
|
DPRINTFN(XEDB_FOLLOW, ("%s: xennet_reset()\n", sc->sc_dev.dv_xname));
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef XENNET_DEBUG_DUMP
|
||||||
|
#define XCHR(x) hexdigits[(x) & 0xf]
|
||||||
|
static void
|
||||||
|
xennet_hex_dump(const unsigned char *pkt, size_t len, const char *type, int id)
|
||||||
|
{
|
||||||
|
size_t i, j;
|
||||||
|
|
||||||
|
printf("pkt %p len %d/%x type %s id %d\n", pkt, len, len, type, id);
|
||||||
|
printf("00000000 ");
|
||||||
|
for(i=0; i<len; i++) {
|
||||||
|
printf("%c%c ", XCHR(pkt[i]>>4), XCHR(pkt[i]));
|
||||||
|
if ((i+1) % 16 == 8)
|
||||||
|
printf(" ");
|
||||||
|
if ((i+1) % 16 == 0) {
|
||||||
|
printf(" %c", '|');
|
||||||
|
for(j=0; j<16; j++)
|
||||||
|
printf("%c", pkt[i-15+j]>=32 &&
|
||||||
|
pkt[i-15+j]<127?pkt[i-15+j]:'.');
|
||||||
|
printf("%c\n%c%c%c%c%c%c%c%c ", '|',
|
||||||
|
XCHR((i+1)>>28), XCHR((i+1)>>24),
|
||||||
|
XCHR((i+1)>>20), XCHR((i+1)>>16),
|
||||||
|
XCHR((i+1)>>12), XCHR((i+1)>>8),
|
||||||
|
XCHR((i+1)>>4), XCHR(i+1));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
printf("\n");
|
||||||
|
}
|
||||||
|
#undef XCHR
|
||||||
|
#endif
|
||||||
Loading…
Reference in New Issue
Block a user