1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 2009-2011 Spectra Logic Corporation 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions, and the following disclaimer, 12 * without modification. 13 * 2. Redistributions in binary form must reproduce at minimum a disclaimer 14 * substantially similar to the "NO WARRANTY" disclaimer below 15 * ("Disclaimer") and any redistribution must be conditioned upon 16 * including a substantially similar Disclaimer requirement for further 17 * binary redistribution. 18 * 19 * NO WARRANTY 20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 21 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR 23 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 24 * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 28 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING 29 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 30 * POSSIBILITY OF SUCH DAMAGES. 31 * 32 * Authors: Justin T. Gibbs (Spectra Logic Corporation) 33 * Alan Somers (Spectra Logic Corporation) 34 * John Suykerbuyk (Spectra Logic Corporation) 35 */ 36 37 #include <sys/cdefs.h> 38 __FBSDID("$FreeBSD$"); 39 40 /** 41 * \file netback.c 42 * 43 * \brief Device driver supporting the vending of network access 44 * from this FreeBSD domain to other domains. 45 */ 46 #include "opt_inet.h" 47 #include "opt_inet6.h" 48 49 #include <sys/param.h> 50 #include <sys/kernel.h> 51 52 #include <sys/bus.h> 53 #include <sys/module.h> 54 #include <sys/rman.h> 55 #include <sys/socket.h> 56 #include <sys/sockio.h> 57 #include <sys/sysctl.h> 58 59 #include <net/if.h> 60 #include <net/if_var.h> 61 #include <net/if_arp.h> 62 #include <net/ethernet.h> 63 #include <net/if_dl.h> 64 #include <net/if_media.h> 65 #include <net/if_types.h> 66 67 #include <netinet/in.h> 68 #include <netinet/ip.h> 69 #include <netinet/if_ether.h> 70 #include <netinet/tcp.h> 71 #include <netinet/ip_icmp.h> 72 #include <netinet/udp.h> 73 #include <machine/in_cksum.h> 74 75 #include <vm/vm.h> 76 #include <vm/pmap.h> 77 #include <vm/vm_extern.h> 78 #include <vm/vm_kern.h> 79 80 #include <machine/_inttypes.h> 81 82 #include <xen/xen-os.h> 83 #include <xen/hypervisor.h> 84 #include <xen/xen_intr.h> 85 #include <contrib/xen/io/netif.h> 86 #include <xen/xenbus/xenbusvar.h> 87 88 /*--------------------------- Compile-time Tunables --------------------------*/ 89 90 /*---------------------------------- Macros ----------------------------------*/ 91 /** 92 * Custom malloc type for all driver allocations. 93 */ 94 static MALLOC_DEFINE(M_XENNETBACK, "xnb", "Xen Net Back Driver Data"); 95 96 #define XNB_SG 1 /* netback driver supports feature-sg */ 97 #define XNB_GSO_TCPV4 0 /* netback driver supports feature-gso-tcpv4 */ 98 #define XNB_RX_COPY 1 /* netback driver supports feature-rx-copy */ 99 #define XNB_RX_FLIP 0 /* netback driver does not support feature-rx-flip */ 100 101 #undef XNB_DEBUG 102 #define XNB_DEBUG /* hardcode on during development */ 103 104 #ifdef XNB_DEBUG 105 #define DPRINTF(fmt, args...) \ 106 printf("xnb(%s:%d): " fmt, __FUNCTION__, __LINE__, ##args) 107 #else 108 #define DPRINTF(fmt, args...) do {} while (0) 109 #endif 110 111 /* Default length for stack-allocated grant tables */ 112 #define GNTTAB_LEN (64) 113 114 /* Features supported by all backends. TSO and LRO can be negotiated */ 115 #define XNB_CSUM_FEATURES (CSUM_TCP | CSUM_UDP) 116 117 #define NET_TX_RING_SIZE __RING_SIZE((netif_tx_sring_t *)0, PAGE_SIZE) 118 #define NET_RX_RING_SIZE __RING_SIZE((netif_rx_sring_t *)0, PAGE_SIZE) 119 120 /** 121 * Two argument version of the standard macro. Second argument is a tentative 122 * value of req_cons 123 */ 124 #define RING_HAS_UNCONSUMED_REQUESTS_2(_r, cons) ({ \ 125 unsigned int req = (_r)->sring->req_prod - cons; \ 126 unsigned int rsp = RING_SIZE(_r) - \ 127 (cons - (_r)->rsp_prod_pvt); \ 128 req < rsp ? req : rsp; \ 129 }) 130 131 #define virt_to_mfn(x) (vtophys(x) >> PAGE_SHIFT) 132 #define virt_to_offset(x) ((x) & (PAGE_SIZE - 1)) 133 134 /** 135 * Predefined array type of grant table copy descriptors. Used to pass around 136 * statically allocated memory structures. 137 */ 138 typedef struct gnttab_copy gnttab_copy_table[GNTTAB_LEN]; 139 140 /*--------------------------- Forward Declarations ---------------------------*/ 141 struct xnb_softc; 142 struct xnb_pkt; 143 144 static void xnb_attach_failed(struct xnb_softc *xnb, 145 int err, const char *fmt, ...) 146 __printflike(3,4); 147 static int xnb_shutdown(struct xnb_softc *xnb); 148 static int create_netdev(device_t dev); 149 static int xnb_detach(device_t dev); 150 static int xnb_ifmedia_upd(struct ifnet *ifp); 151 static void xnb_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr); 152 static void xnb_intr(void *arg); 153 static int xnb_send(netif_rx_back_ring_t *rxb, domid_t otherend, 154 const struct mbuf *mbufc, gnttab_copy_table gnttab); 155 static int xnb_recv(netif_tx_back_ring_t *txb, domid_t otherend, 156 struct mbuf **mbufc, struct ifnet *ifnet, 157 gnttab_copy_table gnttab); 158 static int xnb_ring2pkt(struct xnb_pkt *pkt, 159 const netif_tx_back_ring_t *tx_ring, 160 RING_IDX start); 161 static void xnb_txpkt2rsp(const struct xnb_pkt *pkt, 162 netif_tx_back_ring_t *ring, int error); 163 static struct mbuf *xnb_pkt2mbufc(const struct xnb_pkt *pkt, struct ifnet *ifp); 164 static int xnb_txpkt2gnttab(const struct xnb_pkt *pkt, 165 struct mbuf *mbufc, 166 gnttab_copy_table gnttab, 167 const netif_tx_back_ring_t *txb, 168 domid_t otherend_id); 169 static void xnb_update_mbufc(struct mbuf *mbufc, 170 const gnttab_copy_table gnttab, int n_entries); 171 static int xnb_mbufc2pkt(const struct mbuf *mbufc, 172 struct xnb_pkt *pkt, 173 RING_IDX start, int space); 174 static int xnb_rxpkt2gnttab(const struct xnb_pkt *pkt, 175 const struct mbuf *mbufc, 176 gnttab_copy_table gnttab, 177 const netif_rx_back_ring_t *rxb, 178 domid_t otherend_id); 179 static int xnb_rxpkt2rsp(const struct xnb_pkt *pkt, 180 const gnttab_copy_table gnttab, int n_entries, 181 netif_rx_back_ring_t *ring); 182 static void xnb_stop(struct xnb_softc*); 183 static int xnb_ioctl(struct ifnet*, u_long, caddr_t); 184 static void xnb_start_locked(struct ifnet*); 185 static void xnb_start(struct ifnet*); 186 static void xnb_ifinit_locked(struct xnb_softc*); 187 static void xnb_ifinit(void*); 188 #ifdef XNB_DEBUG 189 static int xnb_unit_test_main(SYSCTL_HANDLER_ARGS); 190 static int xnb_dump_rings(SYSCTL_HANDLER_ARGS); 191 #endif 192 #if defined(INET) || defined(INET6) 193 static void xnb_add_mbuf_cksum(struct mbuf *mbufc); 194 #endif 195 /*------------------------------ Data Structures -----------------------------*/ 196 197 /** 198 * Representation of a xennet packet. Simplified version of a packet as 199 * stored in the Xen tx ring. Applicable to both RX and TX packets 200 */ 201 struct xnb_pkt{ 202 /** 203 * Array index of the first data-bearing (eg, not extra info) entry 204 * for this packet 205 */ 206 RING_IDX car; 207 208 /** 209 * Array index of the second data-bearing entry for this packet. 210 * Invalid if the packet has only one data-bearing entry. If the 211 * packet has more than two data-bearing entries, then the second 212 * through the last will be sequential modulo the ring size 213 */ 214 RING_IDX cdr; 215 216 /** 217 * Optional extra info. Only valid if flags contains 218 * NETTXF_extra_info. Note that extra.type will always be 219 * XEN_NETIF_EXTRA_TYPE_GSO. Currently, no known netfront or netback 220 * driver will ever set XEN_NETIF_EXTRA_TYPE_MCAST_* 221 */ 222 netif_extra_info_t extra; 223 224 /** Size of entire packet in bytes. */ 225 uint16_t size; 226 227 /** The size of the first entry's data in bytes */ 228 uint16_t car_size; 229 230 /** 231 * Either NETTXF_ or NETRXF_ flags. Note that the flag values are 232 * not the same for TX and RX packets 233 */ 234 uint16_t flags; 235 236 /** 237 * The number of valid data-bearing entries (either netif_tx_request's 238 * or netif_rx_response's) in the packet. If this is 0, it means the 239 * entire packet is invalid. 240 */ 241 uint16_t list_len; 242 243 /** There was an error processing the packet */ 244 uint8_t error; 245 }; 246 247 /** xnb_pkt method: initialize it */ 248 static inline void 249 xnb_pkt_initialize(struct xnb_pkt *pxnb) 250 { 251 bzero(pxnb, sizeof(*pxnb)); 252 } 253 254 /** xnb_pkt method: mark the packet as valid */ 255 static inline void 256 xnb_pkt_validate(struct xnb_pkt *pxnb) 257 { 258 pxnb->error = 0; 259 }; 260 261 /** xnb_pkt method: mark the packet as invalid */ 262 static inline void 263 xnb_pkt_invalidate(struct xnb_pkt *pxnb) 264 { 265 pxnb->error = 1; 266 }; 267 268 /** xnb_pkt method: Check whether the packet is valid */ 269 static inline int 270 xnb_pkt_is_valid(const struct xnb_pkt *pxnb) 271 { 272 return (! pxnb->error); 273 } 274 275 #ifdef XNB_DEBUG 276 /** xnb_pkt method: print the packet's contents in human-readable format*/ 277 static void __unused 278 xnb_dump_pkt(const struct xnb_pkt *pkt) { 279 if (pkt == NULL) { 280 DPRINTF("Was passed a null pointer.\n"); 281 return; 282 } 283 DPRINTF("pkt address= %p\n", pkt); 284 DPRINTF("pkt->size=%d\n", pkt->size); 285 DPRINTF("pkt->car_size=%d\n", pkt->car_size); 286 DPRINTF("pkt->flags=0x%04x\n", pkt->flags); 287 DPRINTF("pkt->list_len=%d\n", pkt->list_len); 288 /* DPRINTF("pkt->extra"); TODO */ 289 DPRINTF("pkt->car=%d\n", pkt->car); 290 DPRINTF("pkt->cdr=%d\n", pkt->cdr); 291 DPRINTF("pkt->error=%d\n", pkt->error); 292 } 293 #endif /* XNB_DEBUG */ 294 295 static void 296 xnb_dump_txreq(RING_IDX idx, const struct netif_tx_request *txreq) 297 { 298 if (txreq != NULL) { 299 DPRINTF("netif_tx_request index =%u\n", idx); 300 DPRINTF("netif_tx_request.gref =%u\n", txreq->gref); 301 DPRINTF("netif_tx_request.offset=%hu\n", txreq->offset); 302 DPRINTF("netif_tx_request.flags =%hu\n", txreq->flags); 303 DPRINTF("netif_tx_request.id =%hu\n", txreq->id); 304 DPRINTF("netif_tx_request.size =%hu\n", txreq->size); 305 } 306 } 307 308 /** 309 * \brief Configuration data for a shared memory request ring 310 * used to communicate with the front-end client of this 311 * this driver. 312 */ 313 struct xnb_ring_config { 314 /** 315 * Runtime structures for ring access. Unfortunately, TX and RX rings 316 * use different data structures, and that cannot be changed since it 317 * is part of the interdomain protocol. 318 */ 319 union{ 320 netif_rx_back_ring_t rx_ring; 321 netif_tx_back_ring_t tx_ring; 322 } back_ring; 323 324 /** 325 * The device bus address returned by the hypervisor when 326 * mapping the ring and required to unmap it when a connection 327 * is torn down. 328 */ 329 uint64_t bus_addr; 330 331 /** The pseudo-physical address where ring memory is mapped.*/ 332 uint64_t gnt_addr; 333 334 /** KVA address where ring memory is mapped. */ 335 vm_offset_t va; 336 337 /** 338 * Grant table handles, one per-ring page, returned by the 339 * hyperpervisor upon mapping of the ring and required to 340 * unmap it when a connection is torn down. 341 */ 342 grant_handle_t handle; 343 344 /** The number of ring pages mapped for the current connection. */ 345 unsigned ring_pages; 346 347 /** 348 * The grant references, one per-ring page, supplied by the 349 * front-end, allowing us to reference the ring pages in the 350 * front-end's domain and to map these pages into our own domain. 351 */ 352 grant_ref_t ring_ref; 353 }; 354 355 /** 356 * Per-instance connection state flags. 357 */ 358 typedef enum 359 { 360 /** Communication with the front-end has been established. */ 361 XNBF_RING_CONNECTED = 0x01, 362 363 /** 364 * Front-end requests exist in the ring and are waiting for 365 * xnb_xen_req objects to free up. 366 */ 367 XNBF_RESOURCE_SHORTAGE = 0x02, 368 369 /** Connection teardown has started. */ 370 XNBF_SHUTDOWN = 0x04, 371 372 /** A thread is already performing shutdown processing. */ 373 XNBF_IN_SHUTDOWN = 0x08 374 } xnb_flag_t; 375 376 /** 377 * Types of rings. Used for array indices and to identify a ring's control 378 * data structure type 379 */ 380 typedef enum{ 381 XNB_RING_TYPE_TX = 0, /* ID of TX rings, used for array indices */ 382 XNB_RING_TYPE_RX = 1, /* ID of RX rings, used for array indices */ 383 XNB_NUM_RING_TYPES 384 } xnb_ring_type_t; 385 386 /** 387 * Per-instance configuration data. 388 */ 389 struct xnb_softc { 390 /** NewBus device corresponding to this instance. */ 391 device_t dev; 392 393 /* Media related fields */ 394 395 /** Generic network media state */ 396 struct ifmedia sc_media; 397 398 /** Media carrier info */ 399 struct ifnet *xnb_ifp; 400 401 /** Our own private carrier state */ 402 unsigned carrier; 403 404 /** Device MAC Address */ 405 uint8_t mac[ETHER_ADDR_LEN]; 406 407 /* Xen related fields */ 408 409 /** 410 * \brief The netif protocol abi in effect. 411 * 412 * There are situations where the back and front ends can 413 * have a different, native abi (e.g. intel x86_64 and 414 * 32bit x86 domains on the same machine). The back-end 415 * always accommodates the front-end's native abi. That 416 * value is pulled from the XenStore and recorded here. 417 */ 418 int abi; 419 420 /** 421 * Name of the bridge to which this VIF is connected, if any 422 * This field is dynamically allocated by xenbus and must be free()ed 423 * when no longer needed 424 */ 425 char *bridge; 426 427 /** The interrupt driven even channel used to signal ring events. */ 428 evtchn_port_t evtchn; 429 430 /** Xen device handle.*/ 431 long handle; 432 433 /** Handle to the communication ring event channel. */ 434 xen_intr_handle_t xen_intr_handle; 435 436 /** 437 * \brief Cached value of the front-end's domain id. 438 * 439 * This value is used at once for each mapped page in 440 * a transaction. We cache it to avoid incuring the 441 * cost of an ivar access every time this is needed. 442 */ 443 domid_t otherend_id; 444 445 /** 446 * Undocumented frontend feature. Has something to do with 447 * scatter/gather IO 448 */ 449 uint8_t can_sg; 450 /** Undocumented frontend feature */ 451 uint8_t gso; 452 /** Undocumented frontend feature */ 453 uint8_t gso_prefix; 454 /** Can checksum TCP/UDP over IPv4 */ 455 uint8_t ip_csum; 456 457 /* Implementation related fields */ 458 /** 459 * Preallocated grant table copy descriptor for RX operations. 460 * Access must be protected by rx_lock 461 */ 462 gnttab_copy_table rx_gnttab; 463 464 /** 465 * Preallocated grant table copy descriptor for TX operations. 466 * Access must be protected by tx_lock 467 */ 468 gnttab_copy_table tx_gnttab; 469 470 /** 471 * Resource representing allocated physical address space 472 * associated with our per-instance kva region. 473 */ 474 struct resource *pseudo_phys_res; 475 476 /** Resource id for allocated physical address space. */ 477 int pseudo_phys_res_id; 478 479 /** Ring mapping and interrupt configuration data. */ 480 struct xnb_ring_config ring_configs[XNB_NUM_RING_TYPES]; 481 482 /** 483 * Global pool of kva used for mapping remote domain ring 484 * and I/O transaction data. 485 */ 486 vm_offset_t kva; 487 488 /** Pseudo-physical address corresponding to kva. */ 489 uint64_t gnt_base_addr; 490 491 /** Various configuration and state bit flags. */ 492 xnb_flag_t flags; 493 494 /** Mutex protecting per-instance data in the receive path. */ 495 struct mtx rx_lock; 496 497 /** Mutex protecting per-instance data in the softc structure. */ 498 struct mtx sc_lock; 499 500 /** Mutex protecting per-instance data in the transmit path. */ 501 struct mtx tx_lock; 502 503 /** The size of the global kva pool. */ 504 int kva_size; 505 506 /** Name of the interface */ 507 char if_name[IFNAMSIZ]; 508 }; 509 510 /*---------------------------- Debugging functions ---------------------------*/ 511 #ifdef XNB_DEBUG 512 static void __unused 513 xnb_dump_gnttab_copy(const struct gnttab_copy *entry) 514 { 515 if (entry == NULL) { 516 printf("NULL grant table pointer\n"); 517 return; 518 } 519 520 if (entry->flags & GNTCOPY_dest_gref) 521 printf("gnttab dest ref=\t%u\n", entry->dest.u.ref); 522 else 523 printf("gnttab dest gmfn=\t%"PRI_xen_pfn"\n", 524 entry->dest.u.gmfn); 525 printf("gnttab dest offset=\t%hu\n", entry->dest.offset); 526 printf("gnttab dest domid=\t%hu\n", entry->dest.domid); 527 if (entry->flags & GNTCOPY_source_gref) 528 printf("gnttab source ref=\t%u\n", entry->source.u.ref); 529 else 530 printf("gnttab source gmfn=\t%"PRI_xen_pfn"\n", 531 entry->source.u.gmfn); 532 printf("gnttab source offset=\t%hu\n", entry->source.offset); 533 printf("gnttab source domid=\t%hu\n", entry->source.domid); 534 printf("gnttab len=\t%hu\n", entry->len); 535 printf("gnttab flags=\t%hu\n", entry->flags); 536 printf("gnttab status=\t%hd\n", entry->status); 537 } 538 539 static int 540 xnb_dump_rings(SYSCTL_HANDLER_ARGS) 541 { 542 static char results[720]; 543 struct xnb_softc const* xnb = (struct xnb_softc*)arg1; 544 netif_rx_back_ring_t const* rxb = 545 &xnb->ring_configs[XNB_RING_TYPE_RX].back_ring.rx_ring; 546 netif_tx_back_ring_t const* txb = 547 &xnb->ring_configs[XNB_RING_TYPE_TX].back_ring.tx_ring; 548 549 /* empty the result strings */ 550 results[0] = 0; 551 552 if ( !txb || !txb->sring || !rxb || !rxb->sring ) 553 return (SYSCTL_OUT(req, results, strnlen(results, 720))); 554 555 snprintf(results, 720, 556 "\n\t%35s %18s\n" /* TX, RX */ 557 "\t%16s %18d %18d\n" /* req_cons */ 558 "\t%16s %18d %18d\n" /* nr_ents */ 559 "\t%16s %18d %18d\n" /* rsp_prod_pvt */ 560 "\t%16s %18p %18p\n" /* sring */ 561 "\t%16s %18d %18d\n" /* req_prod */ 562 "\t%16s %18d %18d\n" /* req_event */ 563 "\t%16s %18d %18d\n" /* rsp_prod */ 564 "\t%16s %18d %18d\n", /* rsp_event */ 565 "TX", "RX", 566 "req_cons", txb->req_cons, rxb->req_cons, 567 "nr_ents", txb->nr_ents, rxb->nr_ents, 568 "rsp_prod_pvt", txb->rsp_prod_pvt, rxb->rsp_prod_pvt, 569 "sring", txb->sring, rxb->sring, 570 "sring->req_prod", txb->sring->req_prod, rxb->sring->req_prod, 571 "sring->req_event", txb->sring->req_event, rxb->sring->req_event, 572 "sring->rsp_prod", txb->sring->rsp_prod, rxb->sring->rsp_prod, 573 "sring->rsp_event", txb->sring->rsp_event, rxb->sring->rsp_event); 574 575 return (SYSCTL_OUT(req, results, strnlen(results, 720))); 576 } 577 578 static void __unused 579 xnb_dump_mbuf(const struct mbuf *m) 580 { 581 int len; 582 uint8_t *d; 583 if (m == NULL) 584 return; 585 586 printf("xnb_dump_mbuf:\n"); 587 if (m->m_flags & M_PKTHDR) { 588 printf(" flowid=%10d, csum_flags=%#8x, csum_data=%#8x, " 589 "tso_segsz=%5hd\n", 590 m->m_pkthdr.flowid, (int)m->m_pkthdr.csum_flags, 591 m->m_pkthdr.csum_data, m->m_pkthdr.tso_segsz); 592 printf(" rcvif=%16p, len=%19d\n", 593 m->m_pkthdr.rcvif, m->m_pkthdr.len); 594 } 595 printf(" m_next=%16p, m_nextpk=%16p, m_data=%16p\n", 596 m->m_next, m->m_nextpkt, m->m_data); 597 printf(" m_len=%17d, m_flags=%#15x, m_type=%18u\n", 598 m->m_len, m->m_flags, m->m_type); 599 600 len = m->m_len; 601 d = mtod(m, uint8_t*); 602 while (len > 0) { 603 int i; 604 printf(" "); 605 for (i = 0; (i < 16) && (len > 0); i++, len--) { 606 printf("%02hhx ", *(d++)); 607 } 608 printf("\n"); 609 } 610 } 611 #endif /* XNB_DEBUG */ 612 613 /*------------------------ Inter-Domain Communication ------------------------*/ 614 /** 615 * Free dynamically allocated KVA or pseudo-physical address allocations. 616 * 617 * \param xnb Per-instance xnb configuration structure. 618 */ 619 static void 620 xnb_free_communication_mem(struct xnb_softc *xnb) 621 { 622 if (xnb->kva != 0) { 623 if (xnb->pseudo_phys_res != NULL) { 624 xenmem_free(xnb->dev, xnb->pseudo_phys_res_id, 625 xnb->pseudo_phys_res); 626 xnb->pseudo_phys_res = NULL; 627 } 628 } 629 xnb->kva = 0; 630 xnb->gnt_base_addr = 0; 631 } 632 633 /** 634 * Cleanup all inter-domain communication mechanisms. 635 * 636 * \param xnb Per-instance xnb configuration structure. 637 */ 638 static int 639 xnb_disconnect(struct xnb_softc *xnb) 640 { 641 struct gnttab_unmap_grant_ref gnts[XNB_NUM_RING_TYPES]; 642 int error __diagused; 643 int i; 644 645 if (xnb->xen_intr_handle != NULL) 646 xen_intr_unbind(&xnb->xen_intr_handle); 647 648 /* 649 * We may still have another thread currently processing requests. We 650 * must acquire the rx and tx locks to make sure those threads are done, 651 * but we can release those locks as soon as we acquire them, because no 652 * more interrupts will be arriving. 653 */ 654 mtx_lock(&xnb->tx_lock); 655 mtx_unlock(&xnb->tx_lock); 656 mtx_lock(&xnb->rx_lock); 657 mtx_unlock(&xnb->rx_lock); 658 659 mtx_lock(&xnb->sc_lock); 660 /* Free malloc'd softc member variables */ 661 if (xnb->bridge != NULL) { 662 free(xnb->bridge, M_XENSTORE); 663 xnb->bridge = NULL; 664 } 665 666 /* All request processing has stopped, so unmap the rings */ 667 for (i=0; i < XNB_NUM_RING_TYPES; i++) { 668 gnts[i].host_addr = xnb->ring_configs[i].gnt_addr; 669 gnts[i].dev_bus_addr = xnb->ring_configs[i].bus_addr; 670 gnts[i].handle = xnb->ring_configs[i].handle; 671 } 672 error = HYPERVISOR_grant_table_op(GNTTABOP_unmap_grant_ref, gnts, 673 XNB_NUM_RING_TYPES); 674 KASSERT(error == 0, ("Grant table unmap op failed (%d)", error)); 675 676 xnb_free_communication_mem(xnb); 677 /* 678 * Zero the ring config structs because the pointers, handles, and 679 * grant refs contained therein are no longer valid. 680 */ 681 bzero(&xnb->ring_configs[XNB_RING_TYPE_TX], 682 sizeof(struct xnb_ring_config)); 683 bzero(&xnb->ring_configs[XNB_RING_TYPE_RX], 684 sizeof(struct xnb_ring_config)); 685 686 xnb->flags &= ~XNBF_RING_CONNECTED; 687 mtx_unlock(&xnb->sc_lock); 688 689 return (0); 690 } 691 692 /** 693 * Map a single shared memory ring into domain local address space and 694 * initialize its control structure 695 * 696 * \param xnb Per-instance xnb configuration structure 697 * \param ring_type Array index of this ring in the xnb's array of rings 698 * \return An errno 699 */ 700 static int 701 xnb_connect_ring(struct xnb_softc *xnb, xnb_ring_type_t ring_type) 702 { 703 struct gnttab_map_grant_ref gnt; 704 struct xnb_ring_config *ring = &xnb->ring_configs[ring_type]; 705 int error; 706 707 /* TX ring type = 0, RX =1 */ 708 ring->va = xnb->kva + ring_type * PAGE_SIZE; 709 ring->gnt_addr = xnb->gnt_base_addr + ring_type * PAGE_SIZE; 710 711 gnt.host_addr = ring->gnt_addr; 712 gnt.flags = GNTMAP_host_map; 713 gnt.ref = ring->ring_ref; 714 gnt.dom = xnb->otherend_id; 715 716 error = HYPERVISOR_grant_table_op(GNTTABOP_map_grant_ref, &gnt, 1); 717 if (error != 0) 718 panic("netback: Ring page grant table op failed (%d)", error); 719 720 if (gnt.status != 0) { 721 ring->va = 0; 722 error = EACCES; 723 xenbus_dev_fatal(xnb->dev, error, 724 "Ring shared page mapping failed. " 725 "Status %d.", gnt.status); 726 } else { 727 ring->handle = gnt.handle; 728 ring->bus_addr = gnt.dev_bus_addr; 729 730 if (ring_type == XNB_RING_TYPE_TX) { 731 BACK_RING_INIT(&ring->back_ring.tx_ring, 732 (netif_tx_sring_t*)ring->va, 733 ring->ring_pages * PAGE_SIZE); 734 } else if (ring_type == XNB_RING_TYPE_RX) { 735 BACK_RING_INIT(&ring->back_ring.rx_ring, 736 (netif_rx_sring_t*)ring->va, 737 ring->ring_pages * PAGE_SIZE); 738 } else { 739 xenbus_dev_fatal(xnb->dev, error, 740 "Unknown ring type %d", ring_type); 741 } 742 } 743 744 return error; 745 } 746 747 /** 748 * Setup the shared memory rings and bind an interrupt to the event channel 749 * used to notify us of ring changes. 750 * 751 * \param xnb Per-instance xnb configuration structure. 752 */ 753 static int 754 xnb_connect_comms(struct xnb_softc *xnb) 755 { 756 int error; 757 xnb_ring_type_t i; 758 759 if ((xnb->flags & XNBF_RING_CONNECTED) != 0) 760 return (0); 761 762 /* 763 * Kva for our rings are at the tail of the region of kva allocated 764 * by xnb_alloc_communication_mem(). 765 */ 766 for (i=0; i < XNB_NUM_RING_TYPES; i++) { 767 error = xnb_connect_ring(xnb, i); 768 if (error != 0) 769 return error; 770 } 771 772 xnb->flags |= XNBF_RING_CONNECTED; 773 774 error = xen_intr_bind_remote_port(xnb->dev, 775 xnb->otherend_id, 776 xnb->evtchn, 777 /*filter*/NULL, 778 xnb_intr, /*arg*/xnb, 779 INTR_TYPE_NET | INTR_MPSAFE, 780 &xnb->xen_intr_handle); 781 if (error != 0) { 782 (void)xnb_disconnect(xnb); 783 xenbus_dev_fatal(xnb->dev, error, "binding event channel"); 784 return (error); 785 } 786 787 DPRINTF("rings connected!\n"); 788 789 return (0); 790 } 791 792 /** 793 * Size KVA and pseudo-physical address allocations based on negotiated 794 * values for the size and number of I/O requests, and the size of our 795 * communication ring. 796 * 797 * \param xnb Per-instance xnb configuration structure. 798 * 799 * These address spaces are used to dynamically map pages in the 800 * front-end's domain into our own. 801 */ 802 static int 803 xnb_alloc_communication_mem(struct xnb_softc *xnb) 804 { 805 xnb_ring_type_t i; 806 807 xnb->kva_size = 0; 808 for (i=0; i < XNB_NUM_RING_TYPES; i++) { 809 xnb->kva_size += xnb->ring_configs[i].ring_pages * PAGE_SIZE; 810 } 811 812 /* 813 * Reserve a range of pseudo physical memory that we can map 814 * into kva. These pages will only be backed by machine 815 * pages ("real memory") during the lifetime of front-end requests 816 * via grant table operations. We will map the netif tx and rx rings 817 * into this space. 818 */ 819 xnb->pseudo_phys_res_id = 0; 820 xnb->pseudo_phys_res = xenmem_alloc(xnb->dev, &xnb->pseudo_phys_res_id, 821 xnb->kva_size); 822 if (xnb->pseudo_phys_res == NULL) { 823 xnb->kva = 0; 824 return (ENOMEM); 825 } 826 xnb->kva = (vm_offset_t)rman_get_virtual(xnb->pseudo_phys_res); 827 xnb->gnt_base_addr = rman_get_start(xnb->pseudo_phys_res); 828 return (0); 829 } 830 831 /** 832 * Collect information from the XenStore related to our device and its frontend 833 * 834 * \param xnb Per-instance xnb configuration structure. 835 */ 836 static int 837 xnb_collect_xenstore_info(struct xnb_softc *xnb) 838 { 839 /** 840 * \todo Linux collects the following info. We should collect most 841 * of this, too: 842 * "feature-rx-notify" 843 */ 844 const char *otherend_path; 845 const char *our_path; 846 int err; 847 unsigned int rx_copy, bridge_len; 848 uint8_t no_csum_offload; 849 850 otherend_path = xenbus_get_otherend_path(xnb->dev); 851 our_path = xenbus_get_node(xnb->dev); 852 853 /* Collect the critical communication parameters */ 854 err = xs_gather(XST_NIL, otherend_path, 855 "tx-ring-ref", "%l" PRIu32, 856 &xnb->ring_configs[XNB_RING_TYPE_TX].ring_ref, 857 "rx-ring-ref", "%l" PRIu32, 858 &xnb->ring_configs[XNB_RING_TYPE_RX].ring_ref, 859 "event-channel", "%" PRIu32, &xnb->evtchn, 860 NULL); 861 if (err != 0) { 862 xenbus_dev_fatal(xnb->dev, err, 863 "Unable to retrieve ring information from " 864 "frontend %s. Unable to connect.", 865 otherend_path); 866 return (err); 867 } 868 869 /* Collect the handle from xenstore */ 870 err = xs_scanf(XST_NIL, our_path, "handle", NULL, "%li", &xnb->handle); 871 if (err != 0) { 872 xenbus_dev_fatal(xnb->dev, err, 873 "Error reading handle from frontend %s. " 874 "Unable to connect.", otherend_path); 875 } 876 877 /* 878 * Collect the bridgename, if any. We do not need bridge_len; we just 879 * throw it away 880 */ 881 err = xs_read(XST_NIL, our_path, "bridge", &bridge_len, 882 (void**)&xnb->bridge); 883 if (err != 0) 884 xnb->bridge = NULL; 885 886 /* 887 * Does the frontend request that we use rx copy? If not, return an 888 * error because this driver only supports rx copy. 889 */ 890 err = xs_scanf(XST_NIL, otherend_path, "request-rx-copy", NULL, 891 "%" PRIu32, &rx_copy); 892 if (err == ENOENT) { 893 err = 0; 894 rx_copy = 0; 895 } 896 if (err < 0) { 897 xenbus_dev_fatal(xnb->dev, err, "reading %s/request-rx-copy", 898 otherend_path); 899 return err; 900 } 901 /** 902 * \todo: figure out the exact meaning of this feature, and when 903 * the frontend will set it to true. It should be set to true 904 * at some point 905 */ 906 /* if (!rx_copy)*/ 907 /* return EOPNOTSUPP;*/ 908 909 /** \todo Collect the rx notify feature */ 910 911 /* Collect the feature-sg. */ 912 if (xs_scanf(XST_NIL, otherend_path, "feature-sg", NULL, 913 "%hhu", &xnb->can_sg) < 0) 914 xnb->can_sg = 0; 915 916 /* Collect remaining frontend features */ 917 if (xs_scanf(XST_NIL, otherend_path, "feature-gso-tcpv4", NULL, 918 "%hhu", &xnb->gso) < 0) 919 xnb->gso = 0; 920 921 if (xs_scanf(XST_NIL, otherend_path, "feature-gso-tcpv4-prefix", NULL, 922 "%hhu", &xnb->gso_prefix) < 0) 923 xnb->gso_prefix = 0; 924 925 if (xs_scanf(XST_NIL, otherend_path, "feature-no-csum-offload", NULL, 926 "%hhu", &no_csum_offload) < 0) 927 no_csum_offload = 0; 928 xnb->ip_csum = (no_csum_offload == 0); 929 930 return (0); 931 } 932 933 /** 934 * Supply information about the physical device to the frontend 935 * via XenBus. 936 * 937 * \param xnb Per-instance xnb configuration structure. 938 */ 939 static int 940 xnb_publish_backend_info(struct xnb_softc *xnb) 941 { 942 struct xs_transaction xst; 943 const char *our_path; 944 int error; 945 946 our_path = xenbus_get_node(xnb->dev); 947 948 do { 949 error = xs_transaction_start(&xst); 950 if (error != 0) { 951 xenbus_dev_fatal(xnb->dev, error, 952 "Error publishing backend info " 953 "(start transaction)"); 954 break; 955 } 956 957 error = xs_printf(xst, our_path, "feature-sg", 958 "%d", XNB_SG); 959 if (error != 0) 960 break; 961 962 error = xs_printf(xst, our_path, "feature-gso-tcpv4", 963 "%d", XNB_GSO_TCPV4); 964 if (error != 0) 965 break; 966 967 error = xs_printf(xst, our_path, "feature-rx-copy", 968 "%d", XNB_RX_COPY); 969 if (error != 0) 970 break; 971 972 error = xs_printf(xst, our_path, "feature-rx-flip", 973 "%d", XNB_RX_FLIP); 974 if (error != 0) 975 break; 976 977 error = xs_transaction_end(xst, 0); 978 if (error != 0 && error != EAGAIN) { 979 xenbus_dev_fatal(xnb->dev, error, "ending transaction"); 980 break; 981 } 982 983 } while (error == EAGAIN); 984 985 return (error); 986 } 987 988 /** 989 * Connect to our netfront peer now that it has completed publishing 990 * its configuration into the XenStore. 991 * 992 * \param xnb Per-instance xnb configuration structure. 993 */ 994 static void 995 xnb_connect(struct xnb_softc *xnb) 996 { 997 int error; 998 999 if (xenbus_get_state(xnb->dev) == XenbusStateConnected) 1000 return; 1001 1002 if (xnb_collect_xenstore_info(xnb) != 0) 1003 return; 1004 1005 xnb->flags &= ~XNBF_SHUTDOWN; 1006 1007 /* Read front end configuration. */ 1008 1009 /* Allocate resources whose size depends on front-end configuration. */ 1010 error = xnb_alloc_communication_mem(xnb); 1011 if (error != 0) { 1012 xenbus_dev_fatal(xnb->dev, error, 1013 "Unable to allocate communication memory"); 1014 return; 1015 } 1016 1017 /* 1018 * Connect communication channel. 1019 */ 1020 error = xnb_connect_comms(xnb); 1021 if (error != 0) { 1022 /* Specific errors are reported by xnb_connect_comms(). */ 1023 return; 1024 } 1025 xnb->carrier = 1; 1026 1027 /* Ready for I/O. */ 1028 xenbus_set_state(xnb->dev, XenbusStateConnected); 1029 } 1030 1031 /*-------------------------- Device Teardown Support -------------------------*/ 1032 /** 1033 * Perform device shutdown functions. 1034 * 1035 * \param xnb Per-instance xnb configuration structure. 1036 * 1037 * Mark this instance as shutting down, wait for any active requests 1038 * to drain, disconnect from the front-end, and notify any waiters (e.g. 1039 * a thread invoking our detach method) that detach can now proceed. 1040 */ 1041 static int 1042 xnb_shutdown(struct xnb_softc *xnb) 1043 { 1044 /* 1045 * Due to the need to drop our mutex during some 1046 * xenbus operations, it is possible for two threads 1047 * to attempt to close out shutdown processing at 1048 * the same time. Tell the caller that hits this 1049 * race to try back later. 1050 */ 1051 if ((xnb->flags & XNBF_IN_SHUTDOWN) != 0) 1052 return (EAGAIN); 1053 1054 xnb->flags |= XNBF_SHUTDOWN; 1055 1056 xnb->flags |= XNBF_IN_SHUTDOWN; 1057 1058 mtx_unlock(&xnb->sc_lock); 1059 /* Free the network interface */ 1060 xnb->carrier = 0; 1061 if (xnb->xnb_ifp != NULL) { 1062 ether_ifdetach(xnb->xnb_ifp); 1063 if_free(xnb->xnb_ifp); 1064 xnb->xnb_ifp = NULL; 1065 } 1066 1067 xnb_disconnect(xnb); 1068 1069 if (xenbus_get_state(xnb->dev) < XenbusStateClosing) 1070 xenbus_set_state(xnb->dev, XenbusStateClosing); 1071 mtx_lock(&xnb->sc_lock); 1072 1073 xnb->flags &= ~XNBF_IN_SHUTDOWN; 1074 1075 /* Indicate to xnb_detach() that is it safe to proceed. */ 1076 wakeup(xnb); 1077 1078 return (0); 1079 } 1080 1081 /** 1082 * Report an attach time error to the console and Xen, and cleanup 1083 * this instance by forcing immediate detach processing. 1084 * 1085 * \param xnb Per-instance xnb configuration structure. 1086 * \param err Errno describing the error. 1087 * \param fmt Printf style format and arguments 1088 */ 1089 static void 1090 xnb_attach_failed(struct xnb_softc *xnb, int err, const char *fmt, ...) 1091 { 1092 va_list ap; 1093 va_list ap_hotplug; 1094 1095 va_start(ap, fmt); 1096 va_copy(ap_hotplug, ap); 1097 xs_vprintf(XST_NIL, xenbus_get_node(xnb->dev), 1098 "hotplug-error", fmt, ap_hotplug); 1099 va_end(ap_hotplug); 1100 (void)xs_printf(XST_NIL, xenbus_get_node(xnb->dev), 1101 "hotplug-status", "error"); 1102 1103 xenbus_dev_vfatal(xnb->dev, err, fmt, ap); 1104 va_end(ap); 1105 1106 (void)xs_printf(XST_NIL, xenbus_get_node(xnb->dev), "online", "0"); 1107 xnb_detach(xnb->dev); 1108 } 1109 1110 /*---------------------------- NewBus Entrypoints ----------------------------*/ 1111 /** 1112 * Inspect a XenBus device and claim it if is of the appropriate type. 1113 * 1114 * \param dev NewBus device object representing a candidate XenBus device. 1115 * 1116 * \return 0 for success, errno codes for failure. 1117 */ 1118 static int 1119 xnb_probe(device_t dev) 1120 { 1121 if (!strcmp(xenbus_get_type(dev), "vif")) { 1122 DPRINTF("Claiming device %d, %s\n", device_get_unit(dev), 1123 devclass_get_name(device_get_devclass(dev))); 1124 device_set_desc(dev, "Backend Virtual Network Device"); 1125 device_quiet(dev); 1126 return (0); 1127 } 1128 return (ENXIO); 1129 } 1130 1131 /** 1132 * Setup sysctl variables to control various Network Back parameters. 1133 * 1134 * \param xnb Xen Net Back softc. 1135 * 1136 */ 1137 static void 1138 xnb_setup_sysctl(struct xnb_softc *xnb) 1139 { 1140 struct sysctl_ctx_list *sysctl_ctx = NULL; 1141 struct sysctl_oid *sysctl_tree = NULL; 1142 1143 sysctl_ctx = device_get_sysctl_ctx(xnb->dev); 1144 if (sysctl_ctx == NULL) 1145 return; 1146 1147 sysctl_tree = device_get_sysctl_tree(xnb->dev); 1148 if (sysctl_tree == NULL) 1149 return; 1150 1151 #ifdef XNB_DEBUG 1152 SYSCTL_ADD_PROC(sysctl_ctx, 1153 SYSCTL_CHILDREN(sysctl_tree), 1154 OID_AUTO, 1155 "unit_test_results", 1156 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_NEEDGIANT, 1157 xnb, 1158 0, 1159 xnb_unit_test_main, 1160 "A", 1161 "Results of builtin unit tests"); 1162 1163 SYSCTL_ADD_PROC(sysctl_ctx, 1164 SYSCTL_CHILDREN(sysctl_tree), 1165 OID_AUTO, 1166 "dump_rings", 1167 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_NEEDGIANT, 1168 xnb, 1169 0, 1170 xnb_dump_rings, 1171 "A", 1172 "Xennet Back Rings"); 1173 #endif /* XNB_DEBUG */ 1174 } 1175 1176 /** 1177 * Create a network device. 1178 * @param handle device handle 1179 */ 1180 int 1181 create_netdev(device_t dev) 1182 { 1183 struct ifnet *ifp; 1184 struct xnb_softc *xnb; 1185 int err = 0; 1186 uint32_t handle; 1187 1188 xnb = device_get_softc(dev); 1189 mtx_init(&xnb->sc_lock, "xnb_softc", "xen netback softc lock", MTX_DEF); 1190 mtx_init(&xnb->tx_lock, "xnb_tx", "xen netback tx lock", MTX_DEF); 1191 mtx_init(&xnb->rx_lock, "xnb_rx", "xen netback rx lock", MTX_DEF); 1192 1193 xnb->dev = dev; 1194 1195 ifmedia_init(&xnb->sc_media, 0, xnb_ifmedia_upd, xnb_ifmedia_sts); 1196 ifmedia_add(&xnb->sc_media, IFM_ETHER|IFM_MANUAL, 0, NULL); 1197 ifmedia_set(&xnb->sc_media, IFM_ETHER|IFM_MANUAL); 1198 1199 /* 1200 * Set the MAC address to a dummy value (00:00:00:00:00), 1201 * if the MAC address of the host-facing interface is set 1202 * to the same as the guest-facing one (the value found in 1203 * xenstore), the bridge would stop delivering packets to 1204 * us because it would see that the destination address of 1205 * the packet is the same as the interface, and so the bridge 1206 * would expect the packet has already been delivered locally 1207 * (and just drop it). 1208 */ 1209 bzero(&xnb->mac[0], sizeof(xnb->mac)); 1210 1211 /* The interface will be named using the following nomenclature: 1212 * 1213 * xnb<domid>.<handle> 1214 * 1215 * Where handle is the oder of the interface referred to the guest. 1216 */ 1217 err = xs_scanf(XST_NIL, xenbus_get_node(xnb->dev), "handle", NULL, 1218 "%" PRIu32, &handle); 1219 if (err != 0) 1220 return (err); 1221 snprintf(xnb->if_name, IFNAMSIZ, "xnb%" PRIu16 ".%" PRIu32, 1222 xenbus_get_otherend_id(dev), handle); 1223 1224 if (err == 0) { 1225 /* Set up ifnet structure */ 1226 ifp = xnb->xnb_ifp = if_alloc(IFT_ETHER); 1227 ifp->if_softc = xnb; 1228 if_initname(ifp, xnb->if_name, IF_DUNIT_NONE); 1229 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 1230 ifp->if_ioctl = xnb_ioctl; 1231 ifp->if_start = xnb_start; 1232 ifp->if_init = xnb_ifinit; 1233 ifp->if_mtu = ETHERMTU; 1234 ifp->if_snd.ifq_maxlen = NET_RX_RING_SIZE - 1; 1235 1236 ifp->if_hwassist = XNB_CSUM_FEATURES; 1237 ifp->if_capabilities = IFCAP_HWCSUM; 1238 ifp->if_capenable = IFCAP_HWCSUM; 1239 1240 ether_ifattach(ifp, xnb->mac); 1241 xnb->carrier = 0; 1242 } 1243 1244 return err; 1245 } 1246 1247 /** 1248 * Attach to a XenBus device that has been claimed by our probe routine. 1249 * 1250 * \param dev NewBus device object representing this Xen Net Back instance. 1251 * 1252 * \return 0 for success, errno codes for failure. 1253 */ 1254 static int 1255 xnb_attach(device_t dev) 1256 { 1257 struct xnb_softc *xnb; 1258 int error; 1259 xnb_ring_type_t i; 1260 1261 error = create_netdev(dev); 1262 if (error != 0) { 1263 xenbus_dev_fatal(dev, error, "creating netdev"); 1264 return (error); 1265 } 1266 1267 DPRINTF("Attaching to %s\n", xenbus_get_node(dev)); 1268 1269 /* 1270 * Basic initialization. 1271 * After this block it is safe to call xnb_detach() 1272 * to clean up any allocated data for this instance. 1273 */ 1274 xnb = device_get_softc(dev); 1275 xnb->otherend_id = xenbus_get_otherend_id(dev); 1276 for (i=0; i < XNB_NUM_RING_TYPES; i++) { 1277 xnb->ring_configs[i].ring_pages = 1; 1278 } 1279 1280 /* 1281 * Setup sysctl variables. 1282 */ 1283 xnb_setup_sysctl(xnb); 1284 1285 /* Update hot-plug status to satisfy xend. */ 1286 error = xs_printf(XST_NIL, xenbus_get_node(xnb->dev), 1287 "hotplug-status", "connected"); 1288 if (error != 0) { 1289 xnb_attach_failed(xnb, error, "writing %s/hotplug-status", 1290 xenbus_get_node(xnb->dev)); 1291 return (error); 1292 } 1293 1294 if ((error = xnb_publish_backend_info(xnb)) != 0) { 1295 /* 1296 * If we can't publish our data, we cannot participate 1297 * in this connection, and waiting for a front-end state 1298 * change will not help the situation. 1299 */ 1300 xnb_attach_failed(xnb, error, 1301 "Publishing backend status for %s", 1302 xenbus_get_node(xnb->dev)); 1303 return error; 1304 } 1305 1306 /* Tell the front end that we are ready to connect. */ 1307 xenbus_set_state(dev, XenbusStateInitWait); 1308 1309 return (0); 1310 } 1311 1312 /** 1313 * Detach from a net back device instance. 1314 * 1315 * \param dev NewBus device object representing this Xen Net Back instance. 1316 * 1317 * \return 0 for success, errno codes for failure. 1318 * 1319 * \note A net back device may be detached at any time in its life-cycle, 1320 * including part way through the attach process. For this reason, 1321 * initialization order and the initialization state checks in this 1322 * routine must be carefully coupled so that attach time failures 1323 * are gracefully handled. 1324 */ 1325 static int 1326 xnb_detach(device_t dev) 1327 { 1328 struct xnb_softc *xnb; 1329 1330 DPRINTF("\n"); 1331 1332 xnb = device_get_softc(dev); 1333 mtx_lock(&xnb->sc_lock); 1334 while (xnb_shutdown(xnb) == EAGAIN) { 1335 msleep(xnb, &xnb->sc_lock, /*wakeup prio unchanged*/0, 1336 "xnb_shutdown", 0); 1337 } 1338 mtx_unlock(&xnb->sc_lock); 1339 DPRINTF("\n"); 1340 1341 mtx_destroy(&xnb->tx_lock); 1342 mtx_destroy(&xnb->rx_lock); 1343 mtx_destroy(&xnb->sc_lock); 1344 return (0); 1345 } 1346 1347 /** 1348 * Prepare this net back device for suspension of this VM. 1349 * 1350 * \param dev NewBus device object representing this Xen net Back instance. 1351 * 1352 * \return 0 for success, errno codes for failure. 1353 */ 1354 static int 1355 xnb_suspend(device_t dev) 1356 { 1357 return (0); 1358 } 1359 1360 /** 1361 * Perform any processing required to recover from a suspended state. 1362 * 1363 * \param dev NewBus device object representing this Xen Net Back instance. 1364 * 1365 * \return 0 for success, errno codes for failure. 1366 */ 1367 static int 1368 xnb_resume(device_t dev) 1369 { 1370 return (0); 1371 } 1372 1373 /** 1374 * Handle state changes expressed via the XenStore by our front-end peer. 1375 * 1376 * \param dev NewBus device object representing this Xen 1377 * Net Back instance. 1378 * \param frontend_state The new state of the front-end. 1379 * 1380 * \return 0 for success, errno codes for failure. 1381 */ 1382 static void 1383 xnb_frontend_changed(device_t dev, XenbusState frontend_state) 1384 { 1385 struct xnb_softc *xnb; 1386 1387 xnb = device_get_softc(dev); 1388 1389 DPRINTF("frontend_state=%s, xnb_state=%s\n", 1390 xenbus_strstate(frontend_state), 1391 xenbus_strstate(xenbus_get_state(xnb->dev))); 1392 1393 switch (frontend_state) { 1394 case XenbusStateInitialising: 1395 case XenbusStateInitialised: 1396 break; 1397 case XenbusStateConnected: 1398 xnb_connect(xnb); 1399 break; 1400 case XenbusStateClosing: 1401 case XenbusStateClosed: 1402 mtx_lock(&xnb->sc_lock); 1403 xnb_shutdown(xnb); 1404 mtx_unlock(&xnb->sc_lock); 1405 if (frontend_state == XenbusStateClosed) 1406 xenbus_set_state(xnb->dev, XenbusStateClosed); 1407 break; 1408 default: 1409 xenbus_dev_fatal(xnb->dev, EINVAL, "saw state %d at frontend", 1410 frontend_state); 1411 break; 1412 } 1413 } 1414 1415 /*---------------------------- Request Processing ----------------------------*/ 1416 /** 1417 * Interrupt handler bound to the shared ring's event channel. 1418 * Entry point for the xennet transmit path in netback 1419 * Transfers packets from the Xen ring to the host's generic networking stack 1420 * 1421 * \param arg Callback argument registerd during event channel 1422 * binding - the xnb_softc for this instance. 1423 */ 1424 static void 1425 xnb_intr(void *arg) 1426 { 1427 struct xnb_softc *xnb; 1428 struct ifnet *ifp; 1429 netif_tx_back_ring_t *txb; 1430 RING_IDX req_prod_local; 1431 1432 xnb = (struct xnb_softc *)arg; 1433 ifp = xnb->xnb_ifp; 1434 txb = &xnb->ring_configs[XNB_RING_TYPE_TX].back_ring.tx_ring; 1435 1436 mtx_lock(&xnb->tx_lock); 1437 do { 1438 int notify; 1439 req_prod_local = txb->sring->req_prod; 1440 xen_rmb(); 1441 1442 for (;;) { 1443 struct mbuf *mbufc; 1444 int err; 1445 1446 err = xnb_recv(txb, xnb->otherend_id, &mbufc, ifp, 1447 xnb->tx_gnttab); 1448 if (err || (mbufc == NULL)) 1449 break; 1450 1451 /* Send the packet to the generic network stack */ 1452 (*xnb->xnb_ifp->if_input)(xnb->xnb_ifp, mbufc); 1453 } 1454 1455 RING_PUSH_RESPONSES_AND_CHECK_NOTIFY(txb, notify); 1456 if (notify != 0) 1457 xen_intr_signal(xnb->xen_intr_handle); 1458 1459 txb->sring->req_event = txb->req_cons + 1; 1460 xen_mb(); 1461 } while (txb->sring->req_prod != req_prod_local) ; 1462 mtx_unlock(&xnb->tx_lock); 1463 1464 xnb_start(ifp); 1465 } 1466 1467 /** 1468 * Build a struct xnb_pkt based on netif_tx_request's from a netif tx ring. 1469 * Will read exactly 0 or 1 packets from the ring; never a partial packet. 1470 * \param[out] pkt The returned packet. If there is an error building 1471 * the packet, pkt.list_len will be set to 0. 1472 * \param[in] tx_ring Pointer to the Ring that is the input to this function 1473 * \param[in] start The ring index of the first potential request 1474 * \return The number of requests consumed to build this packet 1475 */ 1476 static int 1477 xnb_ring2pkt(struct xnb_pkt *pkt, const netif_tx_back_ring_t *tx_ring, 1478 RING_IDX start) 1479 { 1480 /* 1481 * Outline: 1482 * 1) Initialize pkt 1483 * 2) Read the first request of the packet 1484 * 3) Read the extras 1485 * 4) Set cdr 1486 * 5) Loop on the remainder of the packet 1487 * 6) Finalize pkt (stuff like car_size and list_len) 1488 */ 1489 int idx = start; 1490 int discard = 0; /* whether to discard the packet */ 1491 int more_data = 0; /* there are more request past the last one */ 1492 uint16_t cdr_size = 0; /* accumulated size of requests 2 through n */ 1493 1494 xnb_pkt_initialize(pkt); 1495 1496 /* Read the first request */ 1497 if (RING_HAS_UNCONSUMED_REQUESTS_2(tx_ring, idx)) { 1498 netif_tx_request_t *tx = RING_GET_REQUEST(tx_ring, idx); 1499 pkt->size = tx->size; 1500 pkt->flags = tx->flags & ~NETTXF_more_data; 1501 more_data = tx->flags & NETTXF_more_data; 1502 pkt->list_len++; 1503 pkt->car = idx; 1504 idx++; 1505 } 1506 1507 /* Read the extra info */ 1508 if ((pkt->flags & NETTXF_extra_info) && 1509 RING_HAS_UNCONSUMED_REQUESTS_2(tx_ring, idx)) { 1510 netif_extra_info_t *ext = 1511 (netif_extra_info_t*) RING_GET_REQUEST(tx_ring, idx); 1512 pkt->extra.type = ext->type; 1513 switch (pkt->extra.type) { 1514 case XEN_NETIF_EXTRA_TYPE_GSO: 1515 pkt->extra.u.gso = ext->u.gso; 1516 break; 1517 default: 1518 /* 1519 * The reference Linux netfront driver will 1520 * never set any other extra.type. So we don't 1521 * know what to do with it. Let's print an 1522 * error, then consume and discard the packet 1523 */ 1524 printf("xnb(%s:%d): Unknown extra info type %d." 1525 " Discarding packet\n", 1526 __func__, __LINE__, pkt->extra.type); 1527 xnb_dump_txreq(start, RING_GET_REQUEST(tx_ring, 1528 start)); 1529 xnb_dump_txreq(idx, RING_GET_REQUEST(tx_ring, 1530 idx)); 1531 discard = 1; 1532 break; 1533 } 1534 1535 pkt->extra.flags = ext->flags; 1536 if (ext->flags & XEN_NETIF_EXTRA_FLAG_MORE) { 1537 /* 1538 * The reference linux netfront driver never sets this 1539 * flag (nor does any other known netfront). So we 1540 * will discard the packet. 1541 */ 1542 printf("xnb(%s:%d): Request sets " 1543 "XEN_NETIF_EXTRA_FLAG_MORE, but we can't handle " 1544 "that\n", __func__, __LINE__); 1545 xnb_dump_txreq(start, RING_GET_REQUEST(tx_ring, start)); 1546 xnb_dump_txreq(idx, RING_GET_REQUEST(tx_ring, idx)); 1547 discard = 1; 1548 } 1549 1550 idx++; 1551 } 1552 1553 /* Set cdr. If there is not more data, cdr is invalid */ 1554 pkt->cdr = idx; 1555 1556 /* Loop on remainder of packet */ 1557 while (more_data && RING_HAS_UNCONSUMED_REQUESTS_2(tx_ring, idx)) { 1558 netif_tx_request_t *tx = RING_GET_REQUEST(tx_ring, idx); 1559 pkt->list_len++; 1560 cdr_size += tx->size; 1561 if (tx->flags & ~NETTXF_more_data) { 1562 /* There should be no other flags set at this point */ 1563 printf("xnb(%s:%d): Request sets unknown flags %d " 1564 "after the 1st request in the packet.\n", 1565 __func__, __LINE__, tx->flags); 1566 xnb_dump_txreq(start, RING_GET_REQUEST(tx_ring, start)); 1567 xnb_dump_txreq(idx, RING_GET_REQUEST(tx_ring, idx)); 1568 } 1569 1570 more_data = tx->flags & NETTXF_more_data; 1571 idx++; 1572 } 1573 1574 /* Finalize packet */ 1575 if (more_data != 0) { 1576 /* The ring ran out of requests before finishing the packet */ 1577 xnb_pkt_invalidate(pkt); 1578 idx = start; /* tell caller that we consumed no requests */ 1579 } else { 1580 /* Calculate car_size */ 1581 pkt->car_size = pkt->size - cdr_size; 1582 } 1583 if (discard != 0) { 1584 xnb_pkt_invalidate(pkt); 1585 } 1586 1587 return idx - start; 1588 } 1589 1590 /** 1591 * Respond to all the requests that constituted pkt. Builds the responses and 1592 * writes them to the ring, but doesn't push them to the shared ring. 1593 * \param[in] pkt the packet that needs a response 1594 * \param[in] error true if there was an error handling the packet, such 1595 * as in the hypervisor copy op or mbuf allocation 1596 * \param[out] ring Responses go here 1597 */ 1598 static void 1599 xnb_txpkt2rsp(const struct xnb_pkt *pkt, netif_tx_back_ring_t *ring, 1600 int error) 1601 { 1602 /* 1603 * Outline: 1604 * 1) Respond to the first request 1605 * 2) Respond to the extra info reques 1606 * Loop through every remaining request in the packet, generating 1607 * responses that copy those requests' ids and sets the status 1608 * appropriately. 1609 */ 1610 netif_tx_request_t *tx; 1611 netif_tx_response_t *rsp; 1612 int i; 1613 uint16_t status; 1614 1615 status = (xnb_pkt_is_valid(pkt) == 0) || error ? 1616 NETIF_RSP_ERROR : NETIF_RSP_OKAY; 1617 KASSERT((pkt->list_len == 0) || (ring->rsp_prod_pvt == pkt->car), 1618 ("Cannot respond to ring requests out of order")); 1619 1620 if (pkt->list_len >= 1) { 1621 uint16_t id; 1622 tx = RING_GET_REQUEST(ring, ring->rsp_prod_pvt); 1623 id = tx->id; 1624 rsp = RING_GET_RESPONSE(ring, ring->rsp_prod_pvt); 1625 rsp->id = id; 1626 rsp->status = status; 1627 ring->rsp_prod_pvt++; 1628 1629 if (pkt->flags & NETRXF_extra_info) { 1630 rsp = RING_GET_RESPONSE(ring, ring->rsp_prod_pvt); 1631 rsp->status = NETIF_RSP_NULL; 1632 ring->rsp_prod_pvt++; 1633 } 1634 } 1635 1636 for (i=0; i < pkt->list_len - 1; i++) { 1637 uint16_t id; 1638 tx = RING_GET_REQUEST(ring, ring->rsp_prod_pvt); 1639 id = tx->id; 1640 rsp = RING_GET_RESPONSE(ring, ring->rsp_prod_pvt); 1641 rsp->id = id; 1642 rsp->status = status; 1643 ring->rsp_prod_pvt++; 1644 } 1645 } 1646 1647 /** 1648 * Create an mbuf chain to represent a packet. Initializes all of the headers 1649 * in the mbuf chain, but does not copy the data. The returned chain must be 1650 * free()'d when no longer needed 1651 * \param[in] pkt A packet to model the mbuf chain after 1652 * \return A newly allocated mbuf chain, possibly with clusters attached. 1653 * NULL on failure 1654 */ 1655 static struct mbuf* 1656 xnb_pkt2mbufc(const struct xnb_pkt *pkt, struct ifnet *ifp) 1657 { 1658 /** 1659 * \todo consider using a memory pool for mbufs instead of 1660 * reallocating them for every packet 1661 */ 1662 /** \todo handle extra data */ 1663 struct mbuf *m; 1664 1665 m = m_getm(NULL, pkt->size, M_NOWAIT, MT_DATA); 1666 1667 if (m != NULL) { 1668 m->m_pkthdr.rcvif = ifp; 1669 if (pkt->flags & NETTXF_data_validated) { 1670 /* 1671 * We lie to the host OS and always tell it that the 1672 * checksums are ok, because the packet is unlikely to 1673 * get corrupted going across domains. 1674 */ 1675 m->m_pkthdr.csum_flags = ( 1676 CSUM_IP_CHECKED | 1677 CSUM_IP_VALID | 1678 CSUM_DATA_VALID | 1679 CSUM_PSEUDO_HDR 1680 ); 1681 m->m_pkthdr.csum_data = 0xffff; 1682 } 1683 } 1684 return m; 1685 } 1686 1687 /** 1688 * Build a gnttab_copy table that can be used to copy data from a pkt 1689 * to an mbufc. Does not actually perform the copy. Always uses gref's on 1690 * the packet side. 1691 * \param[in] pkt pkt's associated requests form the src for 1692 * the copy operation 1693 * \param[in] mbufc mbufc's storage forms the dest for the copy operation 1694 * \param[out] gnttab Storage for the returned grant table 1695 * \param[in] txb Pointer to the backend ring structure 1696 * \param[in] otherend_id The domain ID of the other end of the copy 1697 * \return The number of gnttab entries filled 1698 */ 1699 static int 1700 xnb_txpkt2gnttab(const struct xnb_pkt *pkt, struct mbuf *mbufc, 1701 gnttab_copy_table gnttab, const netif_tx_back_ring_t *txb, 1702 domid_t otherend_id) 1703 { 1704 1705 struct mbuf *mbuf = mbufc;/* current mbuf within the chain */ 1706 int gnt_idx = 0; /* index into grant table */ 1707 RING_IDX r_idx = pkt->car; /* index into tx ring buffer */ 1708 int r_ofs = 0; /* offset of next data within tx request's data area */ 1709 int m_ofs = 0; /* offset of next data within mbuf's data area */ 1710 /* size in bytes that still needs to be represented in the table */ 1711 uint16_t size_remaining = pkt->size; 1712 1713 while (size_remaining > 0) { 1714 const netif_tx_request_t *txq = RING_GET_REQUEST(txb, r_idx); 1715 const size_t mbuf_space = M_TRAILINGSPACE(mbuf) - m_ofs; 1716 const size_t req_size = 1717 r_idx == pkt->car ? pkt->car_size : txq->size; 1718 const size_t pkt_space = req_size - r_ofs; 1719 /* 1720 * space is the largest amount of data that can be copied in the 1721 * grant table's next entry 1722 */ 1723 const size_t space = MIN(pkt_space, mbuf_space); 1724 1725 /* TODO: handle this error condition without panicking */ 1726 KASSERT(gnt_idx < GNTTAB_LEN, ("Grant table is too short")); 1727 1728 gnttab[gnt_idx].source.u.ref = txq->gref; 1729 gnttab[gnt_idx].source.domid = otherend_id; 1730 gnttab[gnt_idx].source.offset = txq->offset + r_ofs; 1731 gnttab[gnt_idx].dest.u.gmfn = virt_to_mfn( 1732 mtod(mbuf, vm_offset_t) + m_ofs); 1733 gnttab[gnt_idx].dest.offset = virt_to_offset( 1734 mtod(mbuf, vm_offset_t) + m_ofs); 1735 gnttab[gnt_idx].dest.domid = DOMID_SELF; 1736 gnttab[gnt_idx].len = space; 1737 gnttab[gnt_idx].flags = GNTCOPY_source_gref; 1738 1739 gnt_idx++; 1740 r_ofs += space; 1741 m_ofs += space; 1742 size_remaining -= space; 1743 if (req_size - r_ofs <= 0) { 1744 /* Must move to the next tx request */ 1745 r_ofs = 0; 1746 r_idx = (r_idx == pkt->car) ? pkt->cdr : r_idx + 1; 1747 } 1748 if (M_TRAILINGSPACE(mbuf) - m_ofs <= 0) { 1749 /* Must move to the next mbuf */ 1750 m_ofs = 0; 1751 mbuf = mbuf->m_next; 1752 } 1753 } 1754 1755 return gnt_idx; 1756 } 1757 1758 /** 1759 * Check the status of the grant copy operations, and update mbufs various 1760 * non-data fields to reflect the data present. 1761 * \param[in,out] mbufc mbuf chain to update. The chain must be valid and of 1762 * the correct length, and data should already be present 1763 * \param[in] gnttab A grant table for a just completed copy op 1764 * \param[in] n_entries The number of valid entries in the grant table 1765 */ 1766 static void 1767 xnb_update_mbufc(struct mbuf *mbufc, const gnttab_copy_table gnttab, 1768 int n_entries) 1769 { 1770 struct mbuf *mbuf = mbufc; 1771 int i; 1772 size_t total_size = 0; 1773 1774 for (i = 0; i < n_entries; i++) { 1775 KASSERT(gnttab[i].status == GNTST_okay, 1776 ("Some gnttab_copy entry had error status %hd\n", 1777 gnttab[i].status)); 1778 1779 mbuf->m_len += gnttab[i].len; 1780 total_size += gnttab[i].len; 1781 if (M_TRAILINGSPACE(mbuf) <= 0) { 1782 mbuf = mbuf->m_next; 1783 } 1784 } 1785 mbufc->m_pkthdr.len = total_size; 1786 1787 #if defined(INET) || defined(INET6) 1788 xnb_add_mbuf_cksum(mbufc); 1789 #endif 1790 } 1791 1792 /** 1793 * Dequeue at most one packet from the shared ring 1794 * \param[in,out] txb Netif tx ring. A packet will be removed from it, and 1795 * its private indices will be updated. But the indices 1796 * will not be pushed to the shared ring. 1797 * \param[in] ifnet Interface to which the packet will be sent 1798 * \param[in] otherend Domain ID of the other end of the ring 1799 * \param[out] mbufc The assembled mbuf chain, ready to send to the generic 1800 * networking stack 1801 * \param[in,out] gnttab Pointer to enough memory for a grant table. We make 1802 * this a function parameter so that we will take less 1803 * stack space. 1804 * \return An error code 1805 */ 1806 static int 1807 xnb_recv(netif_tx_back_ring_t *txb, domid_t otherend, struct mbuf **mbufc, 1808 struct ifnet *ifnet, gnttab_copy_table gnttab) 1809 { 1810 struct xnb_pkt pkt; 1811 /* number of tx requests consumed to build the last packet */ 1812 int num_consumed; 1813 int nr_ents; 1814 1815 *mbufc = NULL; 1816 num_consumed = xnb_ring2pkt(&pkt, txb, txb->req_cons); 1817 if (num_consumed == 0) 1818 return 0; /* Nothing to receive */ 1819 1820 /* update statistics independent of errors */ 1821 if_inc_counter(ifnet, IFCOUNTER_IPACKETS, 1); 1822 1823 /* 1824 * if we got here, then 1 or more requests was consumed, but the packet 1825 * is not necessarily valid. 1826 */ 1827 if (xnb_pkt_is_valid(&pkt) == 0) { 1828 /* got a garbage packet, respond and drop it */ 1829 xnb_txpkt2rsp(&pkt, txb, 1); 1830 txb->req_cons += num_consumed; 1831 DPRINTF("xnb_intr: garbage packet, num_consumed=%d\n", 1832 num_consumed); 1833 if_inc_counter(ifnet, IFCOUNTER_IERRORS, 1); 1834 return EINVAL; 1835 } 1836 1837 *mbufc = xnb_pkt2mbufc(&pkt, ifnet); 1838 1839 if (*mbufc == NULL) { 1840 /* 1841 * Couldn't allocate mbufs. Respond and drop the packet. Do 1842 * not consume the requests 1843 */ 1844 xnb_txpkt2rsp(&pkt, txb, 1); 1845 DPRINTF("xnb_intr: Couldn't allocate mbufs, num_consumed=%d\n", 1846 num_consumed); 1847 if_inc_counter(ifnet, IFCOUNTER_IQDROPS, 1); 1848 return ENOMEM; 1849 } 1850 1851 nr_ents = xnb_txpkt2gnttab(&pkt, *mbufc, gnttab, txb, otherend); 1852 1853 if (nr_ents > 0) { 1854 int __unused hv_ret = HYPERVISOR_grant_table_op(GNTTABOP_copy, 1855 gnttab, nr_ents); 1856 KASSERT(hv_ret == 0, 1857 ("HYPERVISOR_grant_table_op returned %d\n", hv_ret)); 1858 xnb_update_mbufc(*mbufc, gnttab, nr_ents); 1859 } 1860 1861 xnb_txpkt2rsp(&pkt, txb, 0); 1862 txb->req_cons += num_consumed; 1863 return 0; 1864 } 1865 1866 /** 1867 * Create an xnb_pkt based on the contents of an mbuf chain. 1868 * \param[in] mbufc mbuf chain to transform into a packet 1869 * \param[out] pkt Storage for the newly generated xnb_pkt 1870 * \param[in] start The ring index of the first available slot in the rx 1871 * ring 1872 * \param[in] space The number of free slots in the rx ring 1873 * \retval 0 Success 1874 * \retval EINVAL mbufc was corrupt or not convertible into a pkt 1875 * \retval EAGAIN There was not enough space in the ring to queue the 1876 * packet 1877 */ 1878 static int 1879 xnb_mbufc2pkt(const struct mbuf *mbufc, struct xnb_pkt *pkt, 1880 RING_IDX start, int space) 1881 { 1882 1883 int retval = 0; 1884 1885 if ((mbufc == NULL) || 1886 ( (mbufc->m_flags & M_PKTHDR) == 0) || 1887 (mbufc->m_pkthdr.len == 0)) { 1888 xnb_pkt_invalidate(pkt); 1889 retval = EINVAL; 1890 } else { 1891 int slots_required; 1892 1893 xnb_pkt_validate(pkt); 1894 pkt->flags = 0; 1895 pkt->size = mbufc->m_pkthdr.len; 1896 pkt->car = start; 1897 pkt->car_size = mbufc->m_len; 1898 1899 if (mbufc->m_pkthdr.csum_flags & CSUM_TSO) { 1900 pkt->flags |= NETRXF_extra_info; 1901 pkt->extra.u.gso.size = mbufc->m_pkthdr.tso_segsz; 1902 pkt->extra.u.gso.type = XEN_NETIF_GSO_TYPE_TCPV4; 1903 pkt->extra.u.gso.pad = 0; 1904 pkt->extra.u.gso.features = 0; 1905 pkt->extra.type = XEN_NETIF_EXTRA_TYPE_GSO; 1906 pkt->extra.flags = 0; 1907 pkt->cdr = start + 2; 1908 } else { 1909 pkt->cdr = start + 1; 1910 } 1911 if (mbufc->m_pkthdr.csum_flags & (CSUM_TSO | CSUM_DELAY_DATA)) { 1912 pkt->flags |= 1913 (NETRXF_csum_blank | NETRXF_data_validated); 1914 } 1915 1916 /* 1917 * Each ring response can have up to PAGE_SIZE of data. 1918 * Assume that we can defragment the mbuf chain efficiently 1919 * into responses so that each response but the last uses all 1920 * PAGE_SIZE bytes. 1921 */ 1922 pkt->list_len = howmany(pkt->size, PAGE_SIZE); 1923 1924 if (pkt->list_len > 1) { 1925 pkt->flags |= NETRXF_more_data; 1926 } 1927 1928 slots_required = pkt->list_len + 1929 (pkt->flags & NETRXF_extra_info ? 1 : 0); 1930 if (slots_required > space) { 1931 xnb_pkt_invalidate(pkt); 1932 retval = EAGAIN; 1933 } 1934 } 1935 1936 return retval; 1937 } 1938 1939 /** 1940 * Build a gnttab_copy table that can be used to copy data from an mbuf chain 1941 * to the frontend's shared buffers. Does not actually perform the copy. 1942 * Always uses gref's on the other end's side. 1943 * \param[in] pkt pkt's associated responses form the dest for the copy 1944 * operatoin 1945 * \param[in] mbufc The source for the copy operation 1946 * \param[out] gnttab Storage for the returned grant table 1947 * \param[in] rxb Pointer to the backend ring structure 1948 * \param[in] otherend_id The domain ID of the other end of the copy 1949 * \return The number of gnttab entries filled 1950 */ 1951 static int 1952 xnb_rxpkt2gnttab(const struct xnb_pkt *pkt, const struct mbuf *mbufc, 1953 gnttab_copy_table gnttab, const netif_rx_back_ring_t *rxb, 1954 domid_t otherend_id) 1955 { 1956 1957 const struct mbuf *mbuf = mbufc;/* current mbuf within the chain */ 1958 int gnt_idx = 0; /* index into grant table */ 1959 RING_IDX r_idx = pkt->car; /* index into rx ring buffer */ 1960 int r_ofs = 0; /* offset of next data within rx request's data area */ 1961 int m_ofs = 0; /* offset of next data within mbuf's data area */ 1962 /* size in bytes that still needs to be represented in the table */ 1963 uint16_t size_remaining; 1964 1965 size_remaining = (xnb_pkt_is_valid(pkt) != 0) ? pkt->size : 0; 1966 1967 while (size_remaining > 0) { 1968 const netif_rx_request_t *rxq = RING_GET_REQUEST(rxb, r_idx); 1969 const size_t mbuf_space = mbuf->m_len - m_ofs; 1970 /* Xen shared pages have an implied size of PAGE_SIZE */ 1971 const size_t req_size = PAGE_SIZE; 1972 const size_t pkt_space = req_size - r_ofs; 1973 /* 1974 * space is the largest amount of data that can be copied in the 1975 * grant table's next entry 1976 */ 1977 const size_t space = MIN(pkt_space, mbuf_space); 1978 1979 /* TODO: handle this error condition without panicing */ 1980 KASSERT(gnt_idx < GNTTAB_LEN, ("Grant table is too short")); 1981 1982 gnttab[gnt_idx].dest.u.ref = rxq->gref; 1983 gnttab[gnt_idx].dest.domid = otherend_id; 1984 gnttab[gnt_idx].dest.offset = r_ofs; 1985 gnttab[gnt_idx].source.u.gmfn = virt_to_mfn( 1986 mtod(mbuf, vm_offset_t) + m_ofs); 1987 gnttab[gnt_idx].source.offset = virt_to_offset( 1988 mtod(mbuf, vm_offset_t) + m_ofs); 1989 gnttab[gnt_idx].source.domid = DOMID_SELF; 1990 gnttab[gnt_idx].len = space; 1991 gnttab[gnt_idx].flags = GNTCOPY_dest_gref; 1992 1993 gnt_idx++; 1994 1995 r_ofs += space; 1996 m_ofs += space; 1997 size_remaining -= space; 1998 if (req_size - r_ofs <= 0) { 1999 /* Must move to the next rx request */ 2000 r_ofs = 0; 2001 r_idx = (r_idx == pkt->car) ? pkt->cdr : r_idx + 1; 2002 } 2003 if (mbuf->m_len - m_ofs <= 0) { 2004 /* Must move to the next mbuf */ 2005 m_ofs = 0; 2006 mbuf = mbuf->m_next; 2007 } 2008 } 2009 2010 return gnt_idx; 2011 } 2012 2013 /** 2014 * Generates responses for all the requests that constituted pkt. Builds 2015 * responses and writes them to the ring, but doesn't push the shared ring 2016 * indices. 2017 * \param[in] pkt the packet that needs a response 2018 * \param[in] gnttab The grant copy table corresponding to this packet. 2019 * Used to determine how many rsp->netif_rx_response_t's to 2020 * generate. 2021 * \param[in] n_entries Number of relevant entries in the grant table 2022 * \param[out] ring Responses go here 2023 * \return The number of RX requests that were consumed to generate 2024 * the responses 2025 */ 2026 static int 2027 xnb_rxpkt2rsp(const struct xnb_pkt *pkt, const gnttab_copy_table gnttab, 2028 int n_entries, netif_rx_back_ring_t *ring) 2029 { 2030 /* 2031 * This code makes the following assumptions: 2032 * * All entries in gnttab set GNTCOPY_dest_gref 2033 * * The entries in gnttab are grouped by their grefs: any two 2034 * entries with the same gref must be adjacent 2035 */ 2036 int error = 0; 2037 int gnt_idx, i; 2038 int n_responses = 0; 2039 grant_ref_t last_gref = GRANT_REF_INVALID; 2040 RING_IDX r_idx; 2041 2042 KASSERT(gnttab != NULL, ("Received a null granttable copy")); 2043 2044 /* 2045 * In the event of an error, we only need to send one response to the 2046 * netfront. In that case, we musn't write any data to the responses 2047 * after the one we send. So we must loop all the way through gnttab 2048 * looking for errors before we generate any responses 2049 * 2050 * Since we're looping through the grant table anyway, we'll count the 2051 * number of different gref's in it, which will tell us how many 2052 * responses to generate 2053 */ 2054 for (gnt_idx = 0; gnt_idx < n_entries; gnt_idx++) { 2055 int16_t status = gnttab[gnt_idx].status; 2056 if (status != GNTST_okay) { 2057 DPRINTF( 2058 "Got error %d for hypervisor gnttab_copy status\n", 2059 status); 2060 error = 1; 2061 break; 2062 } 2063 if (gnttab[gnt_idx].dest.u.ref != last_gref) { 2064 n_responses++; 2065 last_gref = gnttab[gnt_idx].dest.u.ref; 2066 } 2067 } 2068 2069 if (error != 0) { 2070 uint16_t id; 2071 netif_rx_response_t *rsp; 2072 2073 id = RING_GET_REQUEST(ring, ring->rsp_prod_pvt)->id; 2074 rsp = RING_GET_RESPONSE(ring, ring->rsp_prod_pvt); 2075 rsp->id = id; 2076 rsp->status = NETIF_RSP_ERROR; 2077 n_responses = 1; 2078 } else { 2079 gnt_idx = 0; 2080 const int has_extra = pkt->flags & NETRXF_extra_info; 2081 if (has_extra != 0) 2082 n_responses++; 2083 2084 for (i = 0; i < n_responses; i++) { 2085 netif_rx_request_t rxq; 2086 netif_rx_response_t *rsp; 2087 2088 r_idx = ring->rsp_prod_pvt + i; 2089 /* 2090 * We copy the structure of rxq instead of making a 2091 * pointer because it shares the same memory as rsp. 2092 */ 2093 rxq = *(RING_GET_REQUEST(ring, r_idx)); 2094 rsp = RING_GET_RESPONSE(ring, r_idx); 2095 if (has_extra && (i == 1)) { 2096 netif_extra_info_t *ext = 2097 (netif_extra_info_t*)rsp; 2098 ext->type = XEN_NETIF_EXTRA_TYPE_GSO; 2099 ext->flags = 0; 2100 ext->u.gso.size = pkt->extra.u.gso.size; 2101 ext->u.gso.type = XEN_NETIF_GSO_TYPE_TCPV4; 2102 ext->u.gso.pad = 0; 2103 ext->u.gso.features = 0; 2104 } else { 2105 rsp->id = rxq.id; 2106 rsp->status = GNTST_okay; 2107 rsp->offset = 0; 2108 rsp->flags = 0; 2109 if (i < pkt->list_len - 1) 2110 rsp->flags |= NETRXF_more_data; 2111 if ((i == 0) && has_extra) 2112 rsp->flags |= NETRXF_extra_info; 2113 if ((i == 0) && 2114 (pkt->flags & NETRXF_data_validated)) { 2115 rsp->flags |= NETRXF_data_validated; 2116 rsp->flags |= NETRXF_csum_blank; 2117 } 2118 rsp->status = 0; 2119 for (; gnttab[gnt_idx].dest.u.ref == rxq.gref; 2120 gnt_idx++) { 2121 rsp->status += gnttab[gnt_idx].len; 2122 } 2123 } 2124 } 2125 } 2126 2127 ring->req_cons += n_responses; 2128 ring->rsp_prod_pvt += n_responses; 2129 return n_responses; 2130 } 2131 2132 #if defined(INET) || defined(INET6) 2133 /** 2134 * Add IP, TCP, and/or UDP checksums to every mbuf in a chain. The first mbuf 2135 * in the chain must start with a struct ether_header. 2136 * 2137 * XXX This function will perform incorrectly on UDP packets that are split up 2138 * into multiple ethernet frames. 2139 */ 2140 static void 2141 xnb_add_mbuf_cksum(struct mbuf *mbufc) 2142 { 2143 struct ether_header *eh; 2144 struct ip *iph; 2145 uint16_t ether_type; 2146 2147 eh = mtod(mbufc, struct ether_header*); 2148 ether_type = ntohs(eh->ether_type); 2149 if (ether_type != ETHERTYPE_IP) { 2150 /* Nothing to calculate */ 2151 return; 2152 } 2153 2154 iph = (struct ip*)(eh + 1); 2155 if (mbufc->m_pkthdr.csum_flags & CSUM_IP_VALID) { 2156 iph->ip_sum = 0; 2157 iph->ip_sum = in_cksum_hdr(iph); 2158 } 2159 2160 switch (iph->ip_p) { 2161 case IPPROTO_TCP: 2162 if (mbufc->m_pkthdr.csum_flags & CSUM_IP_VALID) { 2163 size_t tcplen = ntohs(iph->ip_len) - sizeof(struct ip); 2164 struct tcphdr *th = (struct tcphdr*)(iph + 1); 2165 th->th_sum = in_pseudo(iph->ip_src.s_addr, 2166 iph->ip_dst.s_addr, htons(IPPROTO_TCP + tcplen)); 2167 th->th_sum = in_cksum_skip(mbufc, 2168 sizeof(struct ether_header) + ntohs(iph->ip_len), 2169 sizeof(struct ether_header) + (iph->ip_hl << 2)); 2170 } 2171 break; 2172 case IPPROTO_UDP: 2173 if (mbufc->m_pkthdr.csum_flags & CSUM_IP_VALID) { 2174 size_t udplen = ntohs(iph->ip_len) - sizeof(struct ip); 2175 struct udphdr *uh = (struct udphdr*)(iph + 1); 2176 uh->uh_sum = in_pseudo(iph->ip_src.s_addr, 2177 iph->ip_dst.s_addr, htons(IPPROTO_UDP + udplen)); 2178 uh->uh_sum = in_cksum_skip(mbufc, 2179 sizeof(struct ether_header) + ntohs(iph->ip_len), 2180 sizeof(struct ether_header) + (iph->ip_hl << 2)); 2181 } 2182 break; 2183 default: 2184 break; 2185 } 2186 } 2187 #endif /* INET || INET6 */ 2188 2189 static void 2190 xnb_stop(struct xnb_softc *xnb) 2191 { 2192 struct ifnet *ifp; 2193 2194 mtx_assert(&xnb->sc_lock, MA_OWNED); 2195 ifp = xnb->xnb_ifp; 2196 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 2197 if_link_state_change(ifp, LINK_STATE_DOWN); 2198 } 2199 2200 static int 2201 xnb_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 2202 { 2203 struct xnb_softc *xnb = ifp->if_softc; 2204 struct ifreq *ifr = (struct ifreq*) data; 2205 #ifdef INET 2206 struct ifaddr *ifa = (struct ifaddr*)data; 2207 #endif 2208 int error = 0; 2209 2210 switch (cmd) { 2211 case SIOCSIFFLAGS: 2212 mtx_lock(&xnb->sc_lock); 2213 if (ifp->if_flags & IFF_UP) { 2214 xnb_ifinit_locked(xnb); 2215 } else { 2216 if (ifp->if_drv_flags & IFF_DRV_RUNNING) { 2217 xnb_stop(xnb); 2218 } 2219 } 2220 /* 2221 * Note: netfront sets a variable named xn_if_flags 2222 * here, but that variable is never read 2223 */ 2224 mtx_unlock(&xnb->sc_lock); 2225 break; 2226 case SIOCSIFADDR: 2227 #ifdef INET 2228 mtx_lock(&xnb->sc_lock); 2229 if (ifa->ifa_addr->sa_family == AF_INET) { 2230 ifp->if_flags |= IFF_UP; 2231 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 2232 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | 2233 IFF_DRV_OACTIVE); 2234 if_link_state_change(ifp, 2235 LINK_STATE_DOWN); 2236 ifp->if_drv_flags |= IFF_DRV_RUNNING; 2237 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2238 if_link_state_change(ifp, 2239 LINK_STATE_UP); 2240 } 2241 arp_ifinit(ifp, ifa); 2242 mtx_unlock(&xnb->sc_lock); 2243 } else { 2244 mtx_unlock(&xnb->sc_lock); 2245 #endif 2246 error = ether_ioctl(ifp, cmd, data); 2247 #ifdef INET 2248 } 2249 #endif 2250 break; 2251 case SIOCSIFCAP: 2252 mtx_lock(&xnb->sc_lock); 2253 if (ifr->ifr_reqcap & IFCAP_TXCSUM) { 2254 ifp->if_capenable |= IFCAP_TXCSUM; 2255 ifp->if_hwassist |= XNB_CSUM_FEATURES; 2256 } else { 2257 ifp->if_capenable &= ~(IFCAP_TXCSUM); 2258 ifp->if_hwassist &= ~(XNB_CSUM_FEATURES); 2259 } 2260 if ((ifr->ifr_reqcap & IFCAP_RXCSUM)) { 2261 ifp->if_capenable |= IFCAP_RXCSUM; 2262 } else { 2263 ifp->if_capenable &= ~(IFCAP_RXCSUM); 2264 } 2265 /* 2266 * TODO enable TSO4 and LRO once we no longer need 2267 * to calculate checksums in software 2268 */ 2269 #if 0 2270 if (ifr->if_reqcap |= IFCAP_TSO4) { 2271 if (IFCAP_TXCSUM & ifp->if_capenable) { 2272 printf("xnb: Xen netif requires that " 2273 "TXCSUM be enabled in order " 2274 "to use TSO4\n"); 2275 error = EINVAL; 2276 } else { 2277 ifp->if_capenable |= IFCAP_TSO4; 2278 ifp->if_hwassist |= CSUM_TSO; 2279 } 2280 } else { 2281 ifp->if_capenable &= ~(IFCAP_TSO4); 2282 ifp->if_hwassist &= ~(CSUM_TSO); 2283 } 2284 if (ifr->ifreqcap |= IFCAP_LRO) { 2285 ifp->if_capenable |= IFCAP_LRO; 2286 } else { 2287 ifp->if_capenable &= ~(IFCAP_LRO); 2288 } 2289 #endif 2290 mtx_unlock(&xnb->sc_lock); 2291 break; 2292 case SIOCSIFMTU: 2293 ifp->if_mtu = ifr->ifr_mtu; 2294 ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 2295 xnb_ifinit(xnb); 2296 break; 2297 case SIOCADDMULTI: 2298 case SIOCDELMULTI: 2299 break; 2300 case SIOCSIFMEDIA: 2301 case SIOCGIFMEDIA: 2302 error = ifmedia_ioctl(ifp, ifr, &xnb->sc_media, cmd); 2303 break; 2304 default: 2305 error = ether_ioctl(ifp, cmd, data); 2306 break; 2307 } 2308 return (error); 2309 } 2310 2311 static void 2312 xnb_start_locked(struct ifnet *ifp) 2313 { 2314 netif_rx_back_ring_t *rxb; 2315 struct xnb_softc *xnb; 2316 struct mbuf *mbufc; 2317 RING_IDX req_prod_local; 2318 2319 xnb = ifp->if_softc; 2320 rxb = &xnb->ring_configs[XNB_RING_TYPE_RX].back_ring.rx_ring; 2321 2322 if (!xnb->carrier) 2323 return; 2324 2325 do { 2326 int out_of_space = 0; 2327 int notify; 2328 req_prod_local = rxb->sring->req_prod; 2329 xen_rmb(); 2330 for (;;) { 2331 int error; 2332 2333 IF_DEQUEUE(&ifp->if_snd, mbufc); 2334 if (mbufc == NULL) 2335 break; 2336 error = xnb_send(rxb, xnb->otherend_id, mbufc, 2337 xnb->rx_gnttab); 2338 switch (error) { 2339 case EAGAIN: 2340 /* 2341 * Insufficient space in the ring. 2342 * Requeue pkt and send when space is 2343 * available. 2344 */ 2345 IF_PREPEND(&ifp->if_snd, mbufc); 2346 /* 2347 * Perhaps the frontend missed an IRQ 2348 * and went to sleep. Notify it to wake 2349 * it up. 2350 */ 2351 out_of_space = 1; 2352 break; 2353 2354 case EINVAL: 2355 /* OS gave a corrupt packet. Drop it.*/ 2356 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 2357 /* FALLTHROUGH */ 2358 default: 2359 /* Send succeeded, or packet had error. 2360 * Free the packet */ 2361 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 2362 if (mbufc) 2363 m_freem(mbufc); 2364 break; 2365 } 2366 if (out_of_space != 0) 2367 break; 2368 } 2369 2370 RING_PUSH_RESPONSES_AND_CHECK_NOTIFY(rxb, notify); 2371 if ((notify != 0) || (out_of_space != 0)) 2372 xen_intr_signal(xnb->xen_intr_handle); 2373 rxb->sring->req_event = req_prod_local + 1; 2374 xen_mb(); 2375 } while (rxb->sring->req_prod != req_prod_local) ; 2376 } 2377 2378 /** 2379 * Sends one packet to the ring. Blocks until the packet is on the ring 2380 * \param[in] mbufc Contains one packet to send. Caller must free 2381 * \param[in,out] rxb The packet will be pushed onto this ring, but the 2382 * otherend will not be notified. 2383 * \param[in] otherend The domain ID of the other end of the connection 2384 * \retval EAGAIN The ring did not have enough space for the packet. 2385 * The ring has not been modified 2386 * \param[in,out] gnttab Pointer to enough memory for a grant table. We make 2387 * this a function parameter so that we will take less 2388 * stack space. 2389 * \retval EINVAL mbufc was corrupt or not convertible into a pkt 2390 */ 2391 static int 2392 xnb_send(netif_rx_back_ring_t *ring, domid_t otherend, const struct mbuf *mbufc, 2393 gnttab_copy_table gnttab) 2394 { 2395 struct xnb_pkt pkt; 2396 int error, n_entries, n_reqs; 2397 RING_IDX space; 2398 2399 space = ring->sring->req_prod - ring->req_cons; 2400 error = xnb_mbufc2pkt(mbufc, &pkt, ring->rsp_prod_pvt, space); 2401 if (error != 0) 2402 return error; 2403 n_entries = xnb_rxpkt2gnttab(&pkt, mbufc, gnttab, ring, otherend); 2404 if (n_entries != 0) { 2405 int __unused hv_ret = HYPERVISOR_grant_table_op(GNTTABOP_copy, 2406 gnttab, n_entries); 2407 KASSERT(hv_ret == 0, ("HYPERVISOR_grant_table_op returned %d\n", 2408 hv_ret)); 2409 } 2410 2411 n_reqs = xnb_rxpkt2rsp(&pkt, gnttab, n_entries, ring); 2412 2413 return 0; 2414 } 2415 2416 static void 2417 xnb_start(struct ifnet *ifp) 2418 { 2419 struct xnb_softc *xnb; 2420 2421 xnb = ifp->if_softc; 2422 mtx_lock(&xnb->rx_lock); 2423 xnb_start_locked(ifp); 2424 mtx_unlock(&xnb->rx_lock); 2425 } 2426 2427 /* equivalent of network_open() in Linux */ 2428 static void 2429 xnb_ifinit_locked(struct xnb_softc *xnb) 2430 { 2431 struct ifnet *ifp; 2432 2433 ifp = xnb->xnb_ifp; 2434 2435 mtx_assert(&xnb->sc_lock, MA_OWNED); 2436 2437 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 2438 return; 2439 2440 xnb_stop(xnb); 2441 2442 ifp->if_drv_flags |= IFF_DRV_RUNNING; 2443 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 2444 if_link_state_change(ifp, LINK_STATE_UP); 2445 } 2446 2447 static void 2448 xnb_ifinit(void *xsc) 2449 { 2450 struct xnb_softc *xnb = xsc; 2451 2452 mtx_lock(&xnb->sc_lock); 2453 xnb_ifinit_locked(xnb); 2454 mtx_unlock(&xnb->sc_lock); 2455 } 2456 2457 /** 2458 * Callback used by the generic networking code to tell us when our carrier 2459 * state has changed. Since we don't have a physical carrier, we don't care 2460 */ 2461 static int 2462 xnb_ifmedia_upd(struct ifnet *ifp) 2463 { 2464 return (0); 2465 } 2466 2467 /** 2468 * Callback used by the generic networking code to ask us what our carrier 2469 * state is. Since we don't have a physical carrier, this is very simple 2470 */ 2471 static void 2472 xnb_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 2473 { 2474 ifmr->ifm_status = IFM_AVALID|IFM_ACTIVE; 2475 ifmr->ifm_active = IFM_ETHER|IFM_MANUAL; 2476 } 2477 2478 /*---------------------------- NewBus Registration ---------------------------*/ 2479 static device_method_t xnb_methods[] = { 2480 /* Device interface */ 2481 DEVMETHOD(device_probe, xnb_probe), 2482 DEVMETHOD(device_attach, xnb_attach), 2483 DEVMETHOD(device_detach, xnb_detach), 2484 DEVMETHOD(device_shutdown, bus_generic_shutdown), 2485 DEVMETHOD(device_suspend, xnb_suspend), 2486 DEVMETHOD(device_resume, xnb_resume), 2487 2488 /* Xenbus interface */ 2489 DEVMETHOD(xenbus_otherend_changed, xnb_frontend_changed), 2490 { 0, 0 } 2491 }; 2492 2493 static driver_t xnb_driver = { 2494 "xnb", 2495 xnb_methods, 2496 sizeof(struct xnb_softc), 2497 }; 2498 devclass_t xnb_devclass; 2499 2500 DRIVER_MODULE(xnb, xenbusb_back, xnb_driver, xnb_devclass, 0, 0); 2501 2502 /*-------------------------- Unit Tests -------------------------------------*/ 2503 #ifdef XNB_DEBUG 2504 #include "netback_unit_tests.c" 2505 #endif 2506