]> CyberLeo.Net >> Repos - FreeBSD/stable/10.git/blob - sys/dev/hyperv/netvsc/hv_netvsc_drv_freebsd.c
MFC 305052-305054,305110
[FreeBSD/stable/10.git] / sys / dev / hyperv / netvsc / hv_netvsc_drv_freebsd.c
1 /*-
2  * Copyright (c) 2010-2012 Citrix Inc.
3  * Copyright (c) 2009-2012,2016 Microsoft Corp.
4  * Copyright (c) 2012 NetApp Inc.
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 unmodified, this list of conditions, and the following
12  *    disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27  */
28
29 /*-
30  * Copyright (c) 2004-2006 Kip Macy
31  * All rights reserved.
32  *
33  * Redistribution and use in source and binary forms, with or without
34  * modification, are permitted provided that the following conditions
35  * are met:
36  * 1. Redistributions of source code must retain the above copyright
37  *    notice, this list of conditions and the following disclaimer.
38  * 2. Redistributions in binary form must reproduce the above copyright
39  *    notice, this list of conditions and the following disclaimer in the
40  *    documentation and/or other materials provided with the distribution.
41  *
42  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
43  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
44  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
45  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
46  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
47  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
48  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
49  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
50  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
51  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
52  * SUCH DAMAGE.
53  */
54
55 #include <sys/cdefs.h>
56 __FBSDID("$FreeBSD$");
57
58 #include "opt_inet6.h"
59 #include "opt_inet.h"
60
61 #include <sys/param.h>
62 #include <sys/systm.h>
63 #include <sys/sockio.h>
64 #include <sys/mbuf.h>
65 #include <sys/malloc.h>
66 #include <sys/module.h>
67 #include <sys/kernel.h>
68 #include <sys/socket.h>
69 #include <sys/proc.h>
70 #include <sys/queue.h>
71 #include <sys/lock.h>
72 #include <sys/sx.h>
73 #include <sys/smp.h>
74 #include <sys/sysctl.h>
75 #include <sys/buf_ring.h>
76
77 #include <net/if.h>
78 #include <net/if_arp.h>
79 #include <net/ethernet.h>
80 #include <net/if_dl.h>
81 #include <net/if_media.h>
82
83 #include <net/bpf.h>
84
85 #include <net/if_types.h>
86 #include <net/if_vlan_var.h>
87 #include <net/if.h>
88
89 #include <netinet/in_systm.h>
90 #include <netinet/in.h>
91 #include <netinet/ip.h>
92 #include <netinet/if_ether.h>
93 #include <netinet/tcp.h>
94 #include <netinet/udp.h>
95 #include <netinet/ip6.h>
96
97 #include <vm/vm.h>
98 #include <vm/vm_param.h>
99 #include <vm/vm_kern.h>
100 #include <vm/pmap.h>
101
102 #include <machine/bus.h>
103 #include <machine/resource.h>
104 #include <machine/frame.h>
105 #include <machine/vmparam.h>
106
107 #include <sys/bus.h>
108 #include <sys/rman.h>
109 #include <sys/mutex.h>
110 #include <sys/errno.h>
111 #include <sys/types.h>
112 #include <machine/atomic.h>
113
114 #include <machine/intr_machdep.h>
115
116 #include <machine/in_cksum.h>
117
118 #include <dev/hyperv/include/hyperv.h>
119 #include <dev/hyperv/include/hyperv_busdma.h>
120 #include <dev/hyperv/include/vmbus_xact.h>
121
122 #include <dev/hyperv/netvsc/hv_net_vsc.h>
123 #include <dev/hyperv/netvsc/hv_rndis.h>
124 #include <dev/hyperv/netvsc/hv_rndis_filter.h>
125 #include <dev/hyperv/netvsc/ndis.h>
126
127 #include "vmbus_if.h"
128
129 /* Short for Hyper-V network interface */
130 #define NETVSC_DEVNAME    "hn"
131
132 /*
133  * It looks like offset 0 of buf is reserved to hold the softc pointer.
134  * The sc pointer evidently not needed, and is not presently populated.
135  * The packet offset is where the netvsc_packet starts in the buffer.
136  */
137 #define HV_NV_SC_PTR_OFFSET_IN_BUF         0
138 #define HV_NV_PACKET_OFFSET_IN_BUF         16
139
140 /* YYY should get it from the underlying channel */
141 #define HN_TX_DESC_CNT                  512
142
143 #define HN_LROENT_CNT_DEF               128
144
145 #define HN_RING_CNT_DEF_MAX             8
146
147 #define HN_RNDIS_MSG_LEN                \
148     (sizeof(rndis_msg) +                \
149      RNDIS_HASHVAL_PPI_SIZE +           \
150      RNDIS_VLAN_PPI_SIZE +              \
151      RNDIS_TSO_PPI_SIZE +               \
152      RNDIS_CSUM_PPI_SIZE)
153 #define HN_RNDIS_MSG_BOUNDARY           PAGE_SIZE
154 #define HN_RNDIS_MSG_ALIGN              CACHE_LINE_SIZE
155
156 #define HN_TX_DATA_BOUNDARY             PAGE_SIZE
157 #define HN_TX_DATA_MAXSIZE              IP_MAXPACKET
158 #define HN_TX_DATA_SEGSIZE              PAGE_SIZE
159 /* -1 for RNDIS packet message */
160 #define HN_TX_DATA_SEGCNT_MAX           (NETVSC_PACKET_MAXPAGE - 1)
161
162 #define HN_DIRECT_TX_SIZE_DEF           128
163
164 #define HN_EARLY_TXEOF_THRESH           8
165
166 struct hn_txdesc {
167 #ifndef HN_USE_TXDESC_BUFRING
168         SLIST_ENTRY(hn_txdesc) link;
169 #endif
170         struct mbuf     *m;
171         struct hn_tx_ring *txr;
172         int             refs;
173         uint32_t        flags;          /* HN_TXD_FLAG_ */
174         struct hn_send_ctx send_ctx;
175
176         bus_dmamap_t    data_dmap;
177
178         bus_addr_t      rndis_msg_paddr;
179         rndis_msg       *rndis_msg;
180         bus_dmamap_t    rndis_msg_dmap;
181 };
182
183 #define HN_TXD_FLAG_ONLIST      0x1
184 #define HN_TXD_FLAG_DMAMAP      0x2
185
186 /*
187  * Only enable UDP checksum offloading when it is on 2012R2 or
188  * later.  UDP checksum offloading doesn't work on earlier
189  * Windows releases.
190  */
191 #define HN_CSUM_ASSIST_WIN8     (CSUM_IP | CSUM_TCP)
192 #define HN_CSUM_ASSIST          (CSUM_IP | CSUM_UDP | CSUM_TCP)
193
194 #define HN_LRO_LENLIM_MULTIRX_DEF       (12 * ETHERMTU)
195 #define HN_LRO_LENLIM_DEF               (25 * ETHERMTU)
196 /* YYY 2*MTU is a bit rough, but should be good enough. */
197 #define HN_LRO_LENLIM_MIN(ifp)          (2 * (ifp)->if_mtu)
198
199 #define HN_LRO_ACKCNT_DEF               1
200
201 /*
202  * Be aware that this sleepable mutex will exhibit WITNESS errors when
203  * certain TCP and ARP code paths are taken.  This appears to be a
204  * well-known condition, as all other drivers checked use a sleeping
205  * mutex to protect their transmit paths.
206  * Also Be aware that mutexes do not play well with semaphores, and there
207  * is a conflicting semaphore in a certain channel code path.
208  */
209 #define NV_LOCK_INIT(_sc, _name) \
210             mtx_init(&(_sc)->hn_lock, _name, MTX_NETWORK_LOCK, MTX_DEF)
211 #define NV_LOCK(_sc)            mtx_lock(&(_sc)->hn_lock)
212 #define NV_LOCK_ASSERT(_sc)     mtx_assert(&(_sc)->hn_lock, MA_OWNED)
213 #define NV_UNLOCK(_sc)          mtx_unlock(&(_sc)->hn_lock)
214 #define NV_LOCK_DESTROY(_sc)    mtx_destroy(&(_sc)->hn_lock)
215
216
217 /*
218  * Globals
219  */
220
221 int hv_promisc_mode = 0;    /* normal mode by default */
222
223 SYSCTL_NODE(_hw, OID_AUTO, hn, CTLFLAG_RD | CTLFLAG_MPSAFE, NULL,
224     "Hyper-V network interface");
225
226 /* Trust tcp segements verification on host side. */
227 static int hn_trust_hosttcp = 1;
228 SYSCTL_INT(_hw_hn, OID_AUTO, trust_hosttcp, CTLFLAG_RDTUN,
229     &hn_trust_hosttcp, 0,
230     "Trust tcp segement verification on host side, "
231     "when csum info is missing (global setting)");
232
233 /* Trust udp datagrams verification on host side. */
234 static int hn_trust_hostudp = 1;
235 SYSCTL_INT(_hw_hn, OID_AUTO, trust_hostudp, CTLFLAG_RDTUN,
236     &hn_trust_hostudp, 0,
237     "Trust udp datagram verification on host side, "
238     "when csum info is missing (global setting)");
239
240 /* Trust ip packets verification on host side. */
241 static int hn_trust_hostip = 1;
242 SYSCTL_INT(_hw_hn, OID_AUTO, trust_hostip, CTLFLAG_RDTUN,
243     &hn_trust_hostip, 0,
244     "Trust ip packet verification on host side, "
245     "when csum info is missing (global setting)");
246
247 /* Limit TSO burst size */
248 static int hn_tso_maxlen = 0;
249 SYSCTL_INT(_hw_hn, OID_AUTO, tso_maxlen, CTLFLAG_RDTUN,
250     &hn_tso_maxlen, 0, "TSO burst limit");
251
252 /* Limit chimney send size */
253 static int hn_tx_chimney_size = 0;
254 SYSCTL_INT(_hw_hn, OID_AUTO, tx_chimney_size, CTLFLAG_RDTUN,
255     &hn_tx_chimney_size, 0, "Chimney send packet size limit");
256
257 /* Limit the size of packet for direct transmission */
258 static int hn_direct_tx_size = HN_DIRECT_TX_SIZE_DEF;
259 SYSCTL_INT(_hw_hn, OID_AUTO, direct_tx_size, CTLFLAG_RDTUN,
260     &hn_direct_tx_size, 0, "Size of the packet for direct transmission");
261
262 #if defined(INET) || defined(INET6)
263 #if __FreeBSD_version >= 1100095
264 static int hn_lro_entry_count = HN_LROENT_CNT_DEF;
265 SYSCTL_INT(_hw_hn, OID_AUTO, lro_entry_count, CTLFLAG_RDTUN,
266     &hn_lro_entry_count, 0, "LRO entry count");
267 #endif
268 #endif
269
270 static int hn_share_tx_taskq = 0;
271 SYSCTL_INT(_hw_hn, OID_AUTO, share_tx_taskq, CTLFLAG_RDTUN,
272     &hn_share_tx_taskq, 0, "Enable shared TX taskqueue");
273
274 static struct taskqueue *hn_tx_taskq;
275
276 #ifndef HN_USE_TXDESC_BUFRING
277 static int hn_use_txdesc_bufring = 0;
278 #else
279 static int hn_use_txdesc_bufring = 1;
280 #endif
281 SYSCTL_INT(_hw_hn, OID_AUTO, use_txdesc_bufring, CTLFLAG_RD,
282     &hn_use_txdesc_bufring, 0, "Use buf_ring for TX descriptors");
283
284 static int hn_bind_tx_taskq = -1;
285 SYSCTL_INT(_hw_hn, OID_AUTO, bind_tx_taskq, CTLFLAG_RDTUN,
286     &hn_bind_tx_taskq, 0, "Bind TX taskqueue to the specified cpu");
287
288 static int hn_use_if_start = 0;
289 SYSCTL_INT(_hw_hn, OID_AUTO, use_if_start, CTLFLAG_RDTUN,
290     &hn_use_if_start, 0, "Use if_start TX method");
291
292 static int hn_chan_cnt = 0;
293 SYSCTL_INT(_hw_hn, OID_AUTO, chan_cnt, CTLFLAG_RDTUN,
294     &hn_chan_cnt, 0,
295     "# of channels to use; each channel has one RX ring and one TX ring");
296
297 static int hn_tx_ring_cnt = 0;
298 SYSCTL_INT(_hw_hn, OID_AUTO, tx_ring_cnt, CTLFLAG_RDTUN,
299     &hn_tx_ring_cnt, 0, "# of TX rings to use");
300
301 static int hn_tx_swq_depth = 0;
302 SYSCTL_INT(_hw_hn, OID_AUTO, tx_swq_depth, CTLFLAG_RDTUN,
303     &hn_tx_swq_depth, 0, "Depth of IFQ or BUFRING");
304
305 #if __FreeBSD_version >= 1100095
306 static u_int hn_lro_mbufq_depth = 0;
307 SYSCTL_UINT(_hw_hn, OID_AUTO, lro_mbufq_depth, CTLFLAG_RDTUN,
308     &hn_lro_mbufq_depth, 0, "Depth of LRO mbuf queue");
309 #endif
310
311 static u_int hn_cpu_index;
312
313 /*
314  * Forward declarations
315  */
316 static void hn_stop(hn_softc_t *sc);
317 static void hn_ifinit_locked(hn_softc_t *sc);
318 static void hn_ifinit(void *xsc);
319 static int  hn_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data);
320 static int hn_start_locked(struct hn_tx_ring *txr, int len);
321 static void hn_start(struct ifnet *ifp);
322 static void hn_start_txeof(struct hn_tx_ring *);
323 static int hn_ifmedia_upd(struct ifnet *ifp);
324 static void hn_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr);
325 #if __FreeBSD_version >= 1100099
326 static int hn_lro_lenlim_sysctl(SYSCTL_HANDLER_ARGS);
327 static int hn_lro_ackcnt_sysctl(SYSCTL_HANDLER_ARGS);
328 #endif
329 static int hn_trust_hcsum_sysctl(SYSCTL_HANDLER_ARGS);
330 static int hn_chim_size_sysctl(SYSCTL_HANDLER_ARGS);
331 #if __FreeBSD_version < 1100095
332 static int hn_rx_stat_int_sysctl(SYSCTL_HANDLER_ARGS);
333 #else
334 static int hn_rx_stat_u64_sysctl(SYSCTL_HANDLER_ARGS);
335 #endif
336 static int hn_rx_stat_ulong_sysctl(SYSCTL_HANDLER_ARGS);
337 static int hn_tx_stat_ulong_sysctl(SYSCTL_HANDLER_ARGS);
338 static int hn_tx_conf_int_sysctl(SYSCTL_HANDLER_ARGS);
339 static int hn_ndis_version_sysctl(SYSCTL_HANDLER_ARGS);
340 static int hn_check_iplen(const struct mbuf *, int);
341 static int hn_create_tx_ring(struct hn_softc *, int);
342 static void hn_destroy_tx_ring(struct hn_tx_ring *);
343 static int hn_create_tx_data(struct hn_softc *, int);
344 static void hn_destroy_tx_data(struct hn_softc *);
345 static void hn_start_taskfunc(void *, int);
346 static void hn_start_txeof_taskfunc(void *, int);
347 static void hn_stop_tx_tasks(struct hn_softc *);
348 static int hn_encap(struct hn_tx_ring *, struct hn_txdesc *, struct mbuf **);
349 static int hn_create_rx_data(struct hn_softc *sc, int);
350 static void hn_destroy_rx_data(struct hn_softc *sc);
351 static void hn_set_chim_size(struct hn_softc *, int);
352 static void hn_channel_attach(struct hn_softc *, struct vmbus_channel *);
353 static void hn_subchan_attach(struct hn_softc *, struct vmbus_channel *);
354 static void hn_subchan_setup(struct hn_softc *);
355
356 static int hn_transmit(struct ifnet *, struct mbuf *);
357 static void hn_xmit_qflush(struct ifnet *);
358 static int hn_xmit(struct hn_tx_ring *, int);
359 static void hn_xmit_txeof(struct hn_tx_ring *);
360 static void hn_xmit_taskfunc(void *, int);
361 static void hn_xmit_txeof_taskfunc(void *, int);
362
363 #if __FreeBSD_version >= 1100099
364 static void
365 hn_set_lro_lenlim(struct hn_softc *sc, int lenlim)
366 {
367         int i;
368
369         for (i = 0; i < sc->hn_rx_ring_inuse; ++i)
370                 sc->hn_rx_ring[i].hn_lro.lro_length_lim = lenlim;
371 }
372 #endif
373
374 static int
375 hn_get_txswq_depth(const struct hn_tx_ring *txr)
376 {
377
378         KASSERT(txr->hn_txdesc_cnt > 0, ("tx ring is not setup yet"));
379         if (hn_tx_swq_depth < txr->hn_txdesc_cnt)
380                 return txr->hn_txdesc_cnt;
381         return hn_tx_swq_depth;
382 }
383
384 static int
385 hn_ifmedia_upd(struct ifnet *ifp __unused)
386 {
387
388         return EOPNOTSUPP;
389 }
390
391 static void
392 hn_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
393 {
394         struct hn_softc *sc = ifp->if_softc;
395
396         ifmr->ifm_status = IFM_AVALID;
397         ifmr->ifm_active = IFM_ETHER;
398
399         if (!sc->hn_carrier) {
400                 ifmr->ifm_active |= IFM_NONE;
401                 return;
402         }
403         ifmr->ifm_status |= IFM_ACTIVE;
404         ifmr->ifm_active |= IFM_10G_T | IFM_FDX;
405 }
406
407 /* {F8615163-DF3E-46c5-913F-F2D2F965ED0E} */
408 static const struct hyperv_guid g_net_vsc_device_type = {
409         .hv_guid = {0x63, 0x51, 0x61, 0xF8, 0x3E, 0xDF, 0xc5, 0x46,
410                 0x91, 0x3F, 0xF2, 0xD2, 0xF9, 0x65, 0xED, 0x0E}
411 };
412
413 /*
414  * Standard probe entry point.
415  *
416  */
417 static int
418 netvsc_probe(device_t dev)
419 {
420         if (VMBUS_PROBE_GUID(device_get_parent(dev), dev,
421             &g_net_vsc_device_type) == 0) {
422                 device_set_desc(dev, "Hyper-V Network Interface");
423                 return BUS_PROBE_DEFAULT;
424         }
425         return ENXIO;
426 }
427
428 static void
429 hn_cpuset_setthread_task(void *xmask, int pending __unused)
430 {
431         cpuset_t *mask = xmask;
432         int error;
433
434         error = cpuset_setthread(curthread->td_tid, mask);
435         if (error) {
436                 panic("curthread=%ju: can't pin; error=%d",
437                     (uintmax_t)curthread->td_tid, error);
438         }
439 }
440
441 /*
442  * Standard attach entry point.
443  *
444  * Called when the driver is loaded.  It allocates needed resources,
445  * and initializes the "hardware" and software.
446  */
447 static int
448 netvsc_attach(device_t dev)
449 {
450         struct sysctl_oid_list *child;
451         struct sysctl_ctx_list *ctx;
452         netvsc_device_info device_info;
453         hn_softc_t *sc;
454         int unit = device_get_unit(dev);
455         struct ifnet *ifp = NULL;
456         int error, ring_cnt, tx_ring_cnt;
457         int tso_maxlen;
458
459         sc = device_get_softc(dev);
460
461         sc->hn_unit = unit;
462         sc->hn_dev = dev;
463         sc->hn_prichan = vmbus_get_channel(dev);
464
465         if (hn_tx_taskq == NULL) {
466                 sc->hn_tx_taskq = taskqueue_create("hn_tx", M_WAITOK,
467                     taskqueue_thread_enqueue, &sc->hn_tx_taskq);
468                 taskqueue_start_threads(&sc->hn_tx_taskq, 1, PI_NET, "%s tx",
469                     device_get_nameunit(dev));
470                 if (hn_bind_tx_taskq >= 0) {
471                         int cpu = hn_bind_tx_taskq;
472                         struct task cpuset_task;
473                         cpuset_t cpu_set;
474
475                         if (cpu > mp_ncpus - 1)
476                                 cpu = mp_ncpus - 1;
477                         CPU_SETOF(cpu, &cpu_set);
478                         TASK_INIT(&cpuset_task, 0, hn_cpuset_setthread_task,
479                             &cpu_set);
480                         taskqueue_enqueue(sc->hn_tx_taskq, &cpuset_task);
481                         taskqueue_drain(sc->hn_tx_taskq, &cpuset_task);
482                 }
483         } else {
484                 sc->hn_tx_taskq = hn_tx_taskq;
485         }
486         NV_LOCK_INIT(sc, "NetVSCLock");
487
488         ifp = sc->hn_ifp = sc->arpcom.ac_ifp = if_alloc(IFT_ETHER);
489         ifp->if_softc = sc;
490         if_initname(ifp, device_get_name(dev), device_get_unit(dev));
491
492         /*
493          * Figure out the # of RX rings (ring_cnt) and the # of TX rings
494          * to use (tx_ring_cnt).
495          *
496          * NOTE:
497          * The # of RX rings to use is same as the # of channels to use.
498          */
499         ring_cnt = hn_chan_cnt;
500         if (ring_cnt <= 0) {
501                 /* Default */
502                 ring_cnt = mp_ncpus;
503                 if (ring_cnt > HN_RING_CNT_DEF_MAX)
504                         ring_cnt = HN_RING_CNT_DEF_MAX;
505         } else if (ring_cnt > mp_ncpus) {
506                 ring_cnt = mp_ncpus;
507         }
508
509         tx_ring_cnt = hn_tx_ring_cnt;
510         if (tx_ring_cnt <= 0 || tx_ring_cnt > ring_cnt)
511                 tx_ring_cnt = ring_cnt;
512         if (hn_use_if_start) {
513                 /* ifnet.if_start only needs one TX ring. */
514                 tx_ring_cnt = 1;
515         }
516
517         /*
518          * Set the leader CPU for channels.
519          */
520         sc->hn_cpu = atomic_fetchadd_int(&hn_cpu_index, ring_cnt) % mp_ncpus;
521
522         error = hn_create_tx_data(sc, tx_ring_cnt);
523         if (error)
524                 goto failed;
525         error = hn_create_rx_data(sc, ring_cnt);
526         if (error)
527                 goto failed;
528
529         /*
530          * Associate the first TX/RX ring w/ the primary channel.
531          */
532         hn_channel_attach(sc, sc->hn_prichan);
533
534         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
535         ifp->if_ioctl = hn_ioctl;
536         ifp->if_init = hn_ifinit;
537         /* needed by hv_rf_on_device_add() code */
538         ifp->if_mtu = ETHERMTU;
539         if (hn_use_if_start) {
540                 int qdepth = hn_get_txswq_depth(&sc->hn_tx_ring[0]);
541
542                 ifp->if_start = hn_start;
543                 IFQ_SET_MAXLEN(&ifp->if_snd, qdepth);
544                 ifp->if_snd.ifq_drv_maxlen = qdepth - 1;
545                 IFQ_SET_READY(&ifp->if_snd);
546         } else {
547                 ifp->if_transmit = hn_transmit;
548                 ifp->if_qflush = hn_xmit_qflush;
549         }
550
551         ifmedia_init(&sc->hn_media, 0, hn_ifmedia_upd, hn_ifmedia_sts);
552         ifmedia_add(&sc->hn_media, IFM_ETHER | IFM_AUTO, 0, NULL);
553         ifmedia_set(&sc->hn_media, IFM_ETHER | IFM_AUTO);
554         /* XXX ifmedia_set really should do this for us */
555         sc->hn_media.ifm_media = sc->hn_media.ifm_cur->ifm_media;
556
557         /*
558          * Tell upper layers that we support full VLAN capability.
559          */
560         ifp->if_data.ifi_hdrlen = sizeof(struct ether_vlan_header);
561         ifp->if_capabilities |=
562             IFCAP_VLAN_HWTAGGING | IFCAP_VLAN_MTU | IFCAP_HWCSUM | IFCAP_TSO |
563             IFCAP_LRO;
564         ifp->if_capenable |=
565             IFCAP_VLAN_HWTAGGING | IFCAP_VLAN_MTU | IFCAP_HWCSUM | IFCAP_TSO |
566             IFCAP_LRO;
567         ifp->if_hwassist = sc->hn_tx_ring[0].hn_csum_assist | CSUM_TSO;
568
569         sc->hn_xact = vmbus_xact_ctx_create(bus_get_dma_tag(dev),
570             HN_XACT_REQ_SIZE, HN_XACT_RESP_SIZE, 0);
571         if (sc->hn_xact == NULL)
572                 goto failed;
573
574         error = hv_rf_on_device_add(sc, &device_info, &ring_cnt,
575             &sc->hn_rx_ring[0]);
576         if (error)
577                 goto failed;
578         KASSERT(ring_cnt > 0 && ring_cnt <= sc->hn_rx_ring_inuse,
579             ("invalid channel count %d, should be less than %d",
580              ring_cnt, sc->hn_rx_ring_inuse));
581
582         /*
583          * Set the # of TX/RX rings that could be used according to
584          * the # of channels that host offered.
585          */
586         if (sc->hn_tx_ring_inuse > ring_cnt)
587                 sc->hn_tx_ring_inuse = ring_cnt;
588         sc->hn_rx_ring_inuse = ring_cnt;
589         device_printf(dev, "%d TX ring, %d RX ring\n",
590             sc->hn_tx_ring_inuse, sc->hn_rx_ring_inuse);
591
592         if (sc->hn_rx_ring_inuse > 1)
593                 hn_subchan_setup(sc);
594
595 #if __FreeBSD_version >= 1100099
596         if (sc->hn_rx_ring_inuse > 1) {
597                 /*
598                  * Reduce TCP segment aggregation limit for multiple
599                  * RX rings to increase ACK timeliness.
600                  */
601                 hn_set_lro_lenlim(sc, HN_LRO_LENLIM_MULTIRX_DEF);
602         }
603 #endif
604
605         if (device_info.link_state == NDIS_MEDIA_STATE_CONNECTED) {
606                 sc->hn_carrier = 1;
607         }
608
609         tso_maxlen = hn_tso_maxlen;
610         if (tso_maxlen <= 0 || tso_maxlen > IP_MAXPACKET)
611                 tso_maxlen = IP_MAXPACKET;
612
613         ifp->if_hw_tsomaxsegcount = HN_TX_DATA_SEGCNT_MAX;
614         ifp->if_hw_tsomaxsegsize = PAGE_SIZE;
615         ifp->if_hw_tsomax = tso_maxlen -
616             (ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN);
617
618         ether_ifattach(ifp, device_info.mac_addr);
619
620         if_printf(ifp, "TSO: %u/%u/%u\n", ifp->if_hw_tsomax,
621             ifp->if_hw_tsomaxsegcount, ifp->if_hw_tsomaxsegsize);
622
623         hn_set_chim_size(sc, sc->hn_chim_szmax);
624         if (hn_tx_chimney_size > 0 &&
625             hn_tx_chimney_size < sc->hn_chim_szmax)
626                 hn_set_chim_size(sc, hn_tx_chimney_size);
627
628         ctx = device_get_sysctl_ctx(dev);
629         child = SYSCTL_CHILDREN(device_get_sysctl_tree(dev));
630         SYSCTL_ADD_UINT(ctx, child, OID_AUTO, "nvs_version", CTLFLAG_RD,
631             &sc->hn_nvs_ver, 0, "NVS version");
632         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "ndis_version",
633             CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, sc, 0,
634             hn_ndis_version_sysctl, "A", "NDIS version");
635
636         return (0);
637 failed:
638         hn_destroy_tx_data(sc);
639         if (ifp != NULL)
640                 if_free(ifp);
641         return (error);
642 }
643
644 /*
645  * Standard detach entry point
646  */
647 static int
648 netvsc_detach(device_t dev)
649 {
650         struct hn_softc *sc = device_get_softc(dev);
651
652         if (bootverbose)
653                 printf("netvsc_detach\n");
654
655         /*
656          * XXXKYS:  Need to clean up all our
657          * driver state; this is the driver
658          * unloading.
659          */
660
661         /*
662          * XXXKYS:  Need to stop outgoing traffic and unregister
663          * the netdevice.
664          */
665
666         hv_rf_on_device_remove(sc);
667
668         hn_stop_tx_tasks(sc);
669
670         ifmedia_removeall(&sc->hn_media);
671         hn_destroy_rx_data(sc);
672         hn_destroy_tx_data(sc);
673
674         if (sc->hn_tx_taskq != hn_tx_taskq)
675                 taskqueue_free(sc->hn_tx_taskq);
676
677         vmbus_xact_ctx_destroy(sc->hn_xact);
678         return (0);
679 }
680
681 /*
682  * Standard shutdown entry point
683  */
684 static int
685 netvsc_shutdown(device_t dev)
686 {
687         return (0);
688 }
689
690 static __inline int
691 hn_txdesc_dmamap_load(struct hn_tx_ring *txr, struct hn_txdesc *txd,
692     struct mbuf **m_head, bus_dma_segment_t *segs, int *nsegs)
693 {
694         struct mbuf *m = *m_head;
695         int error;
696
697         error = bus_dmamap_load_mbuf_sg(txr->hn_tx_data_dtag, txd->data_dmap,
698             m, segs, nsegs, BUS_DMA_NOWAIT);
699         if (error == EFBIG) {
700                 struct mbuf *m_new;
701
702                 m_new = m_collapse(m, M_NOWAIT, HN_TX_DATA_SEGCNT_MAX);
703                 if (m_new == NULL)
704                         return ENOBUFS;
705                 else
706                         *m_head = m = m_new;
707                 txr->hn_tx_collapsed++;
708
709                 error = bus_dmamap_load_mbuf_sg(txr->hn_tx_data_dtag,
710                     txd->data_dmap, m, segs, nsegs, BUS_DMA_NOWAIT);
711         }
712         if (!error) {
713                 bus_dmamap_sync(txr->hn_tx_data_dtag, txd->data_dmap,
714                     BUS_DMASYNC_PREWRITE);
715                 txd->flags |= HN_TXD_FLAG_DMAMAP;
716         }
717         return error;
718 }
719
720 static __inline void
721 hn_txdesc_dmamap_unload(struct hn_tx_ring *txr, struct hn_txdesc *txd)
722 {
723
724         if (txd->flags & HN_TXD_FLAG_DMAMAP) {
725                 bus_dmamap_sync(txr->hn_tx_data_dtag,
726                     txd->data_dmap, BUS_DMASYNC_POSTWRITE);
727                 bus_dmamap_unload(txr->hn_tx_data_dtag,
728                     txd->data_dmap);
729                 txd->flags &= ~HN_TXD_FLAG_DMAMAP;
730         }
731 }
732
733 static __inline int
734 hn_txdesc_put(struct hn_tx_ring *txr, struct hn_txdesc *txd)
735 {
736
737         KASSERT((txd->flags & HN_TXD_FLAG_ONLIST) == 0,
738             ("put an onlist txd %#x", txd->flags));
739
740         KASSERT(txd->refs > 0, ("invalid txd refs %d", txd->refs));
741         if (atomic_fetchadd_int(&txd->refs, -1) != 1)
742                 return 0;
743
744         hn_txdesc_dmamap_unload(txr, txd);
745         if (txd->m != NULL) {
746                 m_freem(txd->m);
747                 txd->m = NULL;
748         }
749
750         txd->flags |= HN_TXD_FLAG_ONLIST;
751
752 #ifndef HN_USE_TXDESC_BUFRING
753         mtx_lock_spin(&txr->hn_txlist_spin);
754         KASSERT(txr->hn_txdesc_avail >= 0 &&
755             txr->hn_txdesc_avail < txr->hn_txdesc_cnt,
756             ("txdesc_put: invalid txd avail %d", txr->hn_txdesc_avail));
757         txr->hn_txdesc_avail++;
758         SLIST_INSERT_HEAD(&txr->hn_txlist, txd, link);
759         mtx_unlock_spin(&txr->hn_txlist_spin);
760 #else
761         atomic_add_int(&txr->hn_txdesc_avail, 1);
762         buf_ring_enqueue(txr->hn_txdesc_br, txd);
763 #endif
764
765         return 1;
766 }
767
768 static __inline struct hn_txdesc *
769 hn_txdesc_get(struct hn_tx_ring *txr)
770 {
771         struct hn_txdesc *txd;
772
773 #ifndef HN_USE_TXDESC_BUFRING
774         mtx_lock_spin(&txr->hn_txlist_spin);
775         txd = SLIST_FIRST(&txr->hn_txlist);
776         if (txd != NULL) {
777                 KASSERT(txr->hn_txdesc_avail > 0,
778                     ("txdesc_get: invalid txd avail %d", txr->hn_txdesc_avail));
779                 txr->hn_txdesc_avail--;
780                 SLIST_REMOVE_HEAD(&txr->hn_txlist, link);
781         }
782         mtx_unlock_spin(&txr->hn_txlist_spin);
783 #else
784         txd = buf_ring_dequeue_sc(txr->hn_txdesc_br);
785 #endif
786
787         if (txd != NULL) {
788 #ifdef HN_USE_TXDESC_BUFRING
789                 atomic_subtract_int(&txr->hn_txdesc_avail, 1);
790 #endif
791                 KASSERT(txd->m == NULL && txd->refs == 0 &&
792                     (txd->flags & HN_TXD_FLAG_ONLIST), ("invalid txd"));
793                 txd->flags &= ~HN_TXD_FLAG_ONLIST;
794                 txd->refs = 1;
795         }
796         return txd;
797 }
798
799 static __inline void
800 hn_txdesc_hold(struct hn_txdesc *txd)
801 {
802
803         /* 0->1 transition will never work */
804         KASSERT(txd->refs > 0, ("invalid refs %d", txd->refs));
805         atomic_add_int(&txd->refs, 1);
806 }
807
808 static __inline void
809 hn_txeof(struct hn_tx_ring *txr)
810 {
811         txr->hn_has_txeof = 0;
812         txr->hn_txeof(txr);
813 }
814
815 static void
816 hn_tx_done(struct hn_send_ctx *sndc, struct hn_softc *sc,
817     struct vmbus_channel *chan, const void *data __unused, int dlen __unused)
818 {
819         struct hn_txdesc *txd = sndc->hn_cbarg;
820         struct hn_tx_ring *txr;
821
822         if (sndc->hn_chim_idx != HN_NVS_CHIM_IDX_INVALID)
823                 hn_chim_free(sc, sndc->hn_chim_idx);
824
825         txr = txd->txr;
826         KASSERT(txr->hn_chan == chan,
827             ("channel mismatch, on chan%u, should be chan%u",
828              vmbus_chan_subidx(chan), vmbus_chan_subidx(txr->hn_chan)));
829
830         txr->hn_has_txeof = 1;
831         hn_txdesc_put(txr, txd);
832
833         ++txr->hn_txdone_cnt;
834         if (txr->hn_txdone_cnt >= HN_EARLY_TXEOF_THRESH) {
835                 txr->hn_txdone_cnt = 0;
836                 if (txr->hn_oactive)
837                         hn_txeof(txr);
838         }
839 }
840
841 void
842 netvsc_channel_rollup(struct hn_rx_ring *rxr, struct hn_tx_ring *txr)
843 {
844 #if defined(INET) || defined(INET6)
845         struct lro_ctrl *lro = &rxr->hn_lro;
846         struct lro_entry *queued;
847
848         while ((queued = SLIST_FIRST(&lro->lro_active)) != NULL) {
849                 SLIST_REMOVE_HEAD(&lro->lro_active, next);
850                 tcp_lro_flush(lro, queued);
851         }
852 #endif
853
854         /*
855          * NOTE:
856          * 'txr' could be NULL, if multiple channels and
857          * ifnet.if_start method are enabled.
858          */
859         if (txr == NULL || !txr->hn_has_txeof)
860                 return;
861
862         txr->hn_txdone_cnt = 0;
863         hn_txeof(txr);
864 }
865
866 /*
867  * NOTE:
868  * If this function fails, then both txd and m_head0 will be freed.
869  */
870 static int
871 hn_encap(struct hn_tx_ring *txr, struct hn_txdesc *txd, struct mbuf **m_head0)
872 {
873         bus_dma_segment_t segs[HN_TX_DATA_SEGCNT_MAX];
874         int error, nsegs, i;
875         struct mbuf *m_head = *m_head0;
876         rndis_msg *rndis_mesg;
877         rndis_packet *rndis_pkt;
878         rndis_per_packet_info *rppi;
879         struct rndis_hash_value *hash_value;
880         uint32_t rndis_msg_size, tot_data_buf_len, send_buf_section_idx;
881         int send_buf_section_size;
882
883         tot_data_buf_len = m_head->m_pkthdr.len;
884
885         /*
886          * extension points to the area reserved for the
887          * rndis_filter_packet, which is placed just after
888          * the netvsc_packet (and rppi struct, if present;
889          * length is updated later).
890          */
891         rndis_mesg = txd->rndis_msg;
892         /* XXX not necessary */
893         memset(rndis_mesg, 0, HN_RNDIS_MSG_LEN);
894         rndis_mesg->ndis_msg_type = REMOTE_NDIS_PACKET_MSG;
895
896         rndis_pkt = &rndis_mesg->msg.packet;
897         rndis_pkt->data_offset = sizeof(rndis_packet);
898         rndis_pkt->data_length = tot_data_buf_len;
899         rndis_pkt->per_pkt_info_offset = sizeof(rndis_packet);
900
901         rndis_msg_size = RNDIS_MESSAGE_SIZE(rndis_packet);
902
903         /*
904          * Set the hash value for this packet, so that the host could
905          * dispatch the TX done event for this packet back to this TX
906          * ring's channel.
907          */
908         rndis_msg_size += RNDIS_HASHVAL_PPI_SIZE;
909         rppi = hv_set_rppi_data(rndis_mesg, RNDIS_HASHVAL_PPI_SIZE,
910             nbl_hash_value);
911         hash_value = (struct rndis_hash_value *)((uint8_t *)rppi +
912             rppi->per_packet_info_offset);
913         hash_value->hash_value = txr->hn_tx_idx;
914
915         if (m_head->m_flags & M_VLANTAG) {
916                 ndis_8021q_info *rppi_vlan_info;
917
918                 rndis_msg_size += RNDIS_VLAN_PPI_SIZE;
919                 rppi = hv_set_rppi_data(rndis_mesg, RNDIS_VLAN_PPI_SIZE,
920                     ieee_8021q_info);
921
922                 rppi_vlan_info = (ndis_8021q_info *)((uint8_t *)rppi +
923                     rppi->per_packet_info_offset);
924                 rppi_vlan_info->u1.s1.vlan_id =
925                     m_head->m_pkthdr.ether_vtag & 0xfff;
926         }
927
928         if (m_head->m_pkthdr.csum_flags & CSUM_TSO) {
929                 rndis_tcp_tso_info *tso_info;   
930                 struct ether_vlan_header *eh;
931                 int ether_len;
932
933                 /*
934                  * XXX need m_pullup and use mtodo
935                  */
936                 eh = mtod(m_head, struct ether_vlan_header*);
937                 if (eh->evl_encap_proto == htons(ETHERTYPE_VLAN))
938                         ether_len = ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN;
939                 else
940                         ether_len = ETHER_HDR_LEN;
941
942                 rndis_msg_size += RNDIS_TSO_PPI_SIZE;
943                 rppi = hv_set_rppi_data(rndis_mesg, RNDIS_TSO_PPI_SIZE,
944                     tcp_large_send_info);
945
946                 tso_info = (rndis_tcp_tso_info *)((uint8_t *)rppi +
947                     rppi->per_packet_info_offset);
948                 tso_info->lso_v2_xmit.type =
949                     RNDIS_TCP_LARGE_SEND_OFFLOAD_V2_TYPE;
950
951 #ifdef INET
952                 if (m_head->m_pkthdr.csum_flags & CSUM_IP_TSO) {
953                         struct ip *ip =
954                             (struct ip *)(m_head->m_data + ether_len);
955                         unsigned long iph_len = ip->ip_hl << 2;
956                         struct tcphdr *th =
957                             (struct tcphdr *)((caddr_t)ip + iph_len);
958
959                         tso_info->lso_v2_xmit.ip_version =
960                             RNDIS_TCP_LARGE_SEND_OFFLOAD_IPV4;
961                         ip->ip_len = 0;
962                         ip->ip_sum = 0;
963
964                         th->th_sum = in_pseudo(ip->ip_src.s_addr,
965                             ip->ip_dst.s_addr, htons(IPPROTO_TCP));
966                 }
967 #endif
968 #if defined(INET6) && defined(INET)
969                 else
970 #endif
971 #ifdef INET6
972                 {
973                         struct ip6_hdr *ip6 = (struct ip6_hdr *)
974                             (m_head->m_data + ether_len);
975                         struct tcphdr *th = (struct tcphdr *)(ip6 + 1);
976
977                         tso_info->lso_v2_xmit.ip_version =
978                             RNDIS_TCP_LARGE_SEND_OFFLOAD_IPV6;
979                         ip6->ip6_plen = 0;
980                         th->th_sum = in6_cksum_pseudo(ip6, 0, IPPROTO_TCP, 0);
981                 }
982 #endif
983                 tso_info->lso_v2_xmit.tcp_header_offset = 0;
984                 tso_info->lso_v2_xmit.mss = m_head->m_pkthdr.tso_segsz;
985         } else if (m_head->m_pkthdr.csum_flags & txr->hn_csum_assist) {
986                 rndis_tcp_ip_csum_info *csum_info;
987
988                 rndis_msg_size += RNDIS_CSUM_PPI_SIZE;
989                 rppi = hv_set_rppi_data(rndis_mesg, RNDIS_CSUM_PPI_SIZE,
990                     tcpip_chksum_info);
991                 csum_info = (rndis_tcp_ip_csum_info *)((uint8_t *)rppi +
992                     rppi->per_packet_info_offset);
993
994                 csum_info->xmit.is_ipv4 = 1;
995                 if (m_head->m_pkthdr.csum_flags & CSUM_IP)
996                         csum_info->xmit.ip_header_csum = 1;
997
998                 if (m_head->m_pkthdr.csum_flags & CSUM_TCP) {
999                         csum_info->xmit.tcp_csum = 1;
1000                         csum_info->xmit.tcp_header_offset = 0;
1001                 } else if (m_head->m_pkthdr.csum_flags & CSUM_UDP) {
1002                         csum_info->xmit.udp_csum = 1;
1003                 }
1004         }
1005
1006         rndis_mesg->msg_len = tot_data_buf_len + rndis_msg_size;
1007         tot_data_buf_len = rndis_mesg->msg_len;
1008
1009         /*
1010          * Chimney send, if the packet could fit into one chimney buffer.
1011          */
1012         if (tot_data_buf_len < txr->hn_chim_size) {
1013                 txr->hn_tx_chimney_tried++;
1014                 send_buf_section_idx = hn_chim_alloc(txr->hn_sc);
1015                 if (send_buf_section_idx != HN_NVS_CHIM_IDX_INVALID) {
1016                         uint8_t *dest = txr->hn_sc->hn_chim +
1017                             (send_buf_section_idx * txr->hn_sc->hn_chim_szmax);
1018
1019                         memcpy(dest, rndis_mesg, rndis_msg_size);
1020                         dest += rndis_msg_size;
1021                         m_copydata(m_head, 0, m_head->m_pkthdr.len, dest);
1022
1023                         send_buf_section_size = tot_data_buf_len;
1024                         txr->hn_gpa_cnt = 0;
1025                         txr->hn_tx_chimney++;
1026                         goto done;
1027                 }
1028         }
1029
1030         error = hn_txdesc_dmamap_load(txr, txd, &m_head, segs, &nsegs);
1031         if (error) {
1032                 int freed;
1033
1034                 /*
1035                  * This mbuf is not linked w/ the txd yet, so free it now.
1036                  */
1037                 m_freem(m_head);
1038                 *m_head0 = NULL;
1039
1040                 freed = hn_txdesc_put(txr, txd);
1041                 KASSERT(freed != 0,
1042                     ("fail to free txd upon txdma error"));
1043
1044                 txr->hn_txdma_failed++;
1045                 if_inc_counter(txr->hn_sc->hn_ifp, IFCOUNTER_OERRORS, 1);
1046                 return error;
1047         }
1048         *m_head0 = m_head;
1049
1050         /* +1 RNDIS packet message */
1051         txr->hn_gpa_cnt = nsegs + 1;
1052
1053         /* send packet with page buffer */
1054         txr->hn_gpa[0].gpa_page = atop(txd->rndis_msg_paddr);
1055         txr->hn_gpa[0].gpa_ofs = txd->rndis_msg_paddr & PAGE_MASK;
1056         txr->hn_gpa[0].gpa_len = rndis_msg_size;
1057
1058         /*
1059          * Fill the page buffers with mbuf info after the page
1060          * buffer for RNDIS packet message.
1061          */
1062         for (i = 0; i < nsegs; ++i) {
1063                 struct vmbus_gpa *gpa = &txr->hn_gpa[i + 1];
1064
1065                 gpa->gpa_page = atop(segs[i].ds_addr);
1066                 gpa->gpa_ofs = segs[i].ds_addr & PAGE_MASK;
1067                 gpa->gpa_len = segs[i].ds_len;
1068         }
1069
1070         send_buf_section_idx = HN_NVS_CHIM_IDX_INVALID;
1071         send_buf_section_size = 0;
1072 done:
1073         txd->m = m_head;
1074
1075         /* Set the completion routine */
1076         hn_send_ctx_init(&txd->send_ctx, hn_tx_done, txd,
1077             send_buf_section_idx, send_buf_section_size);
1078
1079         return 0;
1080 }
1081
1082 /*
1083  * NOTE:
1084  * If this function fails, then txd will be freed, but the mbuf
1085  * associated w/ the txd will _not_ be freed.
1086  */
1087 static int
1088 hn_send_pkt(struct ifnet *ifp, struct hn_tx_ring *txr, struct hn_txdesc *txd)
1089 {
1090         int error, send_failed = 0;
1091
1092 again:
1093         /*
1094          * Make sure that txd is not freed before ETHER_BPF_MTAP.
1095          */
1096         hn_txdesc_hold(txd);
1097         error = hv_nv_on_send(txr->hn_chan, HN_NVS_RNDIS_MTYPE_DATA,
1098             &txd->send_ctx, txr->hn_gpa, txr->hn_gpa_cnt);
1099         if (!error) {
1100                 ETHER_BPF_MTAP(ifp, txd->m);
1101                 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1102                 if (!hn_use_if_start) {
1103                         if_inc_counter(ifp, IFCOUNTER_OBYTES,
1104                             txd->m->m_pkthdr.len);
1105                         if (txd->m->m_flags & M_MCAST)
1106                                 if_inc_counter(ifp, IFCOUNTER_OMCASTS, 1);
1107                 }
1108                 txr->hn_pkts++;
1109         }
1110         hn_txdesc_put(txr, txd);
1111
1112         if (__predict_false(error)) {
1113                 int freed;
1114
1115                 /*
1116                  * This should "really rarely" happen.
1117                  *
1118                  * XXX Too many RX to be acked or too many sideband
1119                  * commands to run?  Ask netvsc_channel_rollup()
1120                  * to kick start later.
1121                  */
1122                 txr->hn_has_txeof = 1;
1123                 if (!send_failed) {
1124                         txr->hn_send_failed++;
1125                         send_failed = 1;
1126                         /*
1127                          * Try sending again after set hn_has_txeof;
1128                          * in case that we missed the last
1129                          * netvsc_channel_rollup().
1130                          */
1131                         goto again;
1132                 }
1133                 if_printf(ifp, "send failed\n");
1134
1135                 /*
1136                  * Caller will perform further processing on the
1137                  * associated mbuf, so don't free it in hn_txdesc_put();
1138                  * only unload it from the DMA map in hn_txdesc_put(),
1139                  * if it was loaded.
1140                  */
1141                 txd->m = NULL;
1142                 freed = hn_txdesc_put(txr, txd);
1143                 KASSERT(freed != 0,
1144                     ("fail to free txd upon send error"));
1145
1146                 txr->hn_send_failed++;
1147         }
1148         return error;
1149 }
1150
1151 /*
1152  * Start a transmit of one or more packets
1153  */
1154 static int
1155 hn_start_locked(struct hn_tx_ring *txr, int len)
1156 {
1157         struct hn_softc *sc = txr->hn_sc;
1158         struct ifnet *ifp = sc->hn_ifp;
1159
1160         KASSERT(hn_use_if_start,
1161             ("hn_start_locked is called, when if_start is disabled"));
1162         KASSERT(txr == &sc->hn_tx_ring[0], ("not the first TX ring"));
1163         mtx_assert(&txr->hn_tx_lock, MA_OWNED);
1164
1165         if ((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) !=
1166             IFF_DRV_RUNNING)
1167                 return 0;
1168
1169         while (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) {
1170                 struct hn_txdesc *txd;
1171                 struct mbuf *m_head;
1172                 int error;
1173
1174                 IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head);
1175                 if (m_head == NULL)
1176                         break;
1177
1178                 if (len > 0 && m_head->m_pkthdr.len > len) {
1179                         /*
1180                          * This sending could be time consuming; let callers
1181                          * dispatch this packet sending (and sending of any
1182                          * following up packets) to tx taskqueue.
1183                          */
1184                         IFQ_DRV_PREPEND(&ifp->if_snd, m_head);
1185                         return 1;
1186                 }
1187
1188                 txd = hn_txdesc_get(txr);
1189                 if (txd == NULL) {
1190                         txr->hn_no_txdescs++;
1191                         IFQ_DRV_PREPEND(&ifp->if_snd, m_head);
1192                         atomic_set_int(&ifp->if_drv_flags, IFF_DRV_OACTIVE);
1193                         break;
1194                 }
1195
1196                 error = hn_encap(txr, txd, &m_head);
1197                 if (error) {
1198                         /* Both txd and m_head are freed */
1199                         continue;
1200                 }
1201
1202                 error = hn_send_pkt(ifp, txr, txd);
1203                 if (__predict_false(error)) {
1204                         /* txd is freed, but m_head is not */
1205                         IFQ_DRV_PREPEND(&ifp->if_snd, m_head);
1206                         atomic_set_int(&ifp->if_drv_flags, IFF_DRV_OACTIVE);
1207                         break;
1208                 }
1209         }
1210         return 0;
1211 }
1212
1213 /*
1214  * Link up/down notification
1215  */
1216 void
1217 netvsc_linkstatus_callback(struct hn_softc *sc, uint32_t status)
1218 {
1219         if (status == 1) {
1220                 sc->hn_carrier = 1;
1221         } else {
1222                 sc->hn_carrier = 0;
1223         }
1224 }
1225
1226 /*
1227  * Append the specified data to the indicated mbuf chain,
1228  * Extend the mbuf chain if the new data does not fit in
1229  * existing space.
1230  *
1231  * This is a minor rewrite of m_append() from sys/kern/uipc_mbuf.c.
1232  * There should be an equivalent in the kernel mbuf code,
1233  * but there does not appear to be one yet.
1234  *
1235  * Differs from m_append() in that additional mbufs are
1236  * allocated with cluster size MJUMPAGESIZE, and filled
1237  * accordingly.
1238  *
1239  * Return 1 if able to complete the job; otherwise 0.
1240  */
1241 static int
1242 hv_m_append(struct mbuf *m0, int len, c_caddr_t cp)
1243 {
1244         struct mbuf *m, *n;
1245         int remainder, space;
1246
1247         for (m = m0; m->m_next != NULL; m = m->m_next)
1248                 ;
1249         remainder = len;
1250         space = M_TRAILINGSPACE(m);
1251         if (space > 0) {
1252                 /*
1253                  * Copy into available space.
1254                  */
1255                 if (space > remainder)
1256                         space = remainder;
1257                 bcopy(cp, mtod(m, caddr_t) + m->m_len, space);
1258                 m->m_len += space;
1259                 cp += space;
1260                 remainder -= space;
1261         }
1262         while (remainder > 0) {
1263                 /*
1264                  * Allocate a new mbuf; could check space
1265                  * and allocate a cluster instead.
1266                  */
1267                 n = m_getjcl(M_DONTWAIT, m->m_type, 0, MJUMPAGESIZE);
1268                 if (n == NULL)
1269                         break;
1270                 n->m_len = min(MJUMPAGESIZE, remainder);
1271                 bcopy(cp, mtod(n, caddr_t), n->m_len);
1272                 cp += n->m_len;
1273                 remainder -= n->m_len;
1274                 m->m_next = n;
1275                 m = n;
1276         }
1277         if (m0->m_flags & M_PKTHDR)
1278                 m0->m_pkthdr.len += len - remainder;
1279
1280         return (remainder == 0);
1281 }
1282
1283 #if defined(INET) || defined(INET6)
1284 static __inline int
1285 hn_lro_rx(struct lro_ctrl *lc, struct mbuf *m)
1286 {
1287 #if __FreeBSD_version >= 1100095
1288         if (hn_lro_mbufq_depth) {
1289                 tcp_lro_queue_mbuf(lc, m);
1290                 return 0;
1291         }
1292 #endif
1293         return tcp_lro_rx(lc, m, 0);
1294 }
1295 #endif
1296
1297 /*
1298  * Called when we receive a data packet from the "wire" on the
1299  * specified device
1300  *
1301  * Note:  This is no longer used as a callback
1302  */
1303 int
1304 netvsc_recv(struct hn_rx_ring *rxr, const void *data, int dlen,
1305     const struct hn_recvinfo *info)
1306 {
1307         struct ifnet *ifp = rxr->hn_ifp;
1308         struct mbuf *m_new;
1309         int size, do_lro = 0, do_csum = 1;
1310
1311         if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
1312                 return (0);
1313
1314         /*
1315          * Bail out if packet contains more data than configured MTU.
1316          */
1317         if (dlen > (ifp->if_mtu + ETHER_HDR_LEN)) {
1318                 return (0);
1319         } else if (dlen <= MHLEN) {
1320                 m_new = m_gethdr(M_NOWAIT, MT_DATA);
1321                 if (m_new == NULL) {
1322                         if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1);
1323                         return (0);
1324                 }
1325                 memcpy(mtod(m_new, void *), data, dlen);
1326                 m_new->m_pkthdr.len = m_new->m_len = dlen;
1327                 rxr->hn_small_pkts++;
1328         } else {
1329                 /*
1330                  * Get an mbuf with a cluster.  For packets 2K or less,
1331                  * get a standard 2K cluster.  For anything larger, get a
1332                  * 4K cluster.  Any buffers larger than 4K can cause problems
1333                  * if looped around to the Hyper-V TX channel, so avoid them.
1334                  */
1335                 size = MCLBYTES;
1336                 if (dlen > MCLBYTES) {
1337                         /* 4096 */
1338                         size = MJUMPAGESIZE;
1339                 }
1340
1341                 m_new = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, size);
1342                 if (m_new == NULL) {
1343                         if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1);
1344                         return (0);
1345                 }
1346
1347                 hv_m_append(m_new, dlen, data);
1348         }
1349         m_new->m_pkthdr.rcvif = ifp;
1350
1351         if (__predict_false((ifp->if_capenable & IFCAP_RXCSUM) == 0))
1352                 do_csum = 0;
1353
1354         /* receive side checksum offload */
1355         if (info->csum_info != NULL) {
1356                 /* IP csum offload */
1357                 if (info->csum_info->receive.ip_csum_succeeded && do_csum) {
1358                         m_new->m_pkthdr.csum_flags |=
1359                             (CSUM_IP_CHECKED | CSUM_IP_VALID);
1360                         rxr->hn_csum_ip++;
1361                 }
1362
1363                 /* TCP/UDP csum offload */
1364                 if ((info->csum_info->receive.tcp_csum_succeeded ||
1365                      info->csum_info->receive.udp_csum_succeeded) && do_csum) {
1366                         m_new->m_pkthdr.csum_flags |=
1367                             (CSUM_DATA_VALID | CSUM_PSEUDO_HDR);
1368                         m_new->m_pkthdr.csum_data = 0xffff;
1369                         if (info->csum_info->receive.tcp_csum_succeeded)
1370                                 rxr->hn_csum_tcp++;
1371                         else
1372                                 rxr->hn_csum_udp++;
1373                 }
1374
1375                 if (info->csum_info->receive.ip_csum_succeeded &&
1376                     info->csum_info->receive.tcp_csum_succeeded)
1377                         do_lro = 1;
1378         } else {
1379                 const struct ether_header *eh;
1380                 uint16_t etype;
1381                 int hoff;
1382
1383                 hoff = sizeof(*eh);
1384                 if (m_new->m_len < hoff)
1385                         goto skip;
1386                 eh = mtod(m_new, struct ether_header *);
1387                 etype = ntohs(eh->ether_type);
1388                 if (etype == ETHERTYPE_VLAN) {
1389                         const struct ether_vlan_header *evl;
1390
1391                         hoff = sizeof(*evl);
1392                         if (m_new->m_len < hoff)
1393                                 goto skip;
1394                         evl = mtod(m_new, struct ether_vlan_header *);
1395                         etype = ntohs(evl->evl_proto);
1396                 }
1397
1398                 if (etype == ETHERTYPE_IP) {
1399                         int pr;
1400
1401                         pr = hn_check_iplen(m_new, hoff);
1402                         if (pr == IPPROTO_TCP) {
1403                                 if (do_csum &&
1404                                     (rxr->hn_trust_hcsum &
1405                                      HN_TRUST_HCSUM_TCP)) {
1406                                         rxr->hn_csum_trusted++;
1407                                         m_new->m_pkthdr.csum_flags |=
1408                                            (CSUM_IP_CHECKED | CSUM_IP_VALID |
1409                                             CSUM_DATA_VALID | CSUM_PSEUDO_HDR);
1410                                         m_new->m_pkthdr.csum_data = 0xffff;
1411                                 }
1412                                 do_lro = 1;
1413                         } else if (pr == IPPROTO_UDP) {
1414                                 if (do_csum &&
1415                                     (rxr->hn_trust_hcsum &
1416                                      HN_TRUST_HCSUM_UDP)) {
1417                                         rxr->hn_csum_trusted++;
1418                                         m_new->m_pkthdr.csum_flags |=
1419                                            (CSUM_IP_CHECKED | CSUM_IP_VALID |
1420                                             CSUM_DATA_VALID | CSUM_PSEUDO_HDR);
1421                                         m_new->m_pkthdr.csum_data = 0xffff;
1422                                 }
1423                         } else if (pr != IPPROTO_DONE && do_csum &&
1424                             (rxr->hn_trust_hcsum & HN_TRUST_HCSUM_IP)) {
1425                                 rxr->hn_csum_trusted++;
1426                                 m_new->m_pkthdr.csum_flags |=
1427                                     (CSUM_IP_CHECKED | CSUM_IP_VALID);
1428                         }
1429                 }
1430         }
1431 skip:
1432         if (info->vlan_info != NULL) {
1433                 m_new->m_pkthdr.ether_vtag = info->vlan_info->u1.s1.vlan_id;
1434                 m_new->m_flags |= M_VLANTAG;
1435         }
1436
1437         if (info->hash_info != NULL && info->hash_value != NULL) {
1438                 int hash_type = M_HASHTYPE_OPAQUE;
1439
1440                 rxr->hn_rss_pkts++;
1441                 m_new->m_pkthdr.flowid = info->hash_value->hash_value;
1442                 if ((info->hash_info->hash_info & NDIS_HASH_FUNCTION_MASK) ==
1443                     NDIS_HASH_FUNCTION_TOEPLITZ) {
1444                         uint32_t type =
1445                             (info->hash_info->hash_info & NDIS_HASH_TYPE_MASK);
1446
1447                         switch (type) {
1448                         case NDIS_HASH_IPV4:
1449                                 hash_type = M_HASHTYPE_RSS_IPV4;
1450                                 break;
1451
1452                         case NDIS_HASH_TCP_IPV4:
1453                                 hash_type = M_HASHTYPE_RSS_TCP_IPV4;
1454                                 break;
1455
1456                         case NDIS_HASH_IPV6:
1457                                 hash_type = M_HASHTYPE_RSS_IPV6;
1458                                 break;
1459
1460                         case NDIS_HASH_IPV6_EX:
1461                                 hash_type = M_HASHTYPE_RSS_IPV6_EX;
1462                                 break;
1463
1464                         case NDIS_HASH_TCP_IPV6:
1465                                 hash_type = M_HASHTYPE_RSS_TCP_IPV6;
1466                                 break;
1467
1468                         case NDIS_HASH_TCP_IPV6_EX:
1469                                 hash_type = M_HASHTYPE_RSS_TCP_IPV6_EX;
1470                                 break;
1471                         }
1472                 }
1473                 M_HASHTYPE_SET(m_new, hash_type);
1474         } else {
1475                 if (info->hash_value != NULL)
1476                         m_new->m_pkthdr.flowid = info->hash_value->hash_value;
1477                 else
1478                         m_new->m_pkthdr.flowid = rxr->hn_rx_idx;
1479                 M_HASHTYPE_SET(m_new, M_HASHTYPE_OPAQUE);
1480         }
1481
1482         /*
1483          * Note:  Moved RX completion back to hv_nv_on_receive() so all
1484          * messages (not just data messages) will trigger a response.
1485          */
1486
1487         ifp->if_ipackets++;
1488         rxr->hn_pkts++;
1489
1490         if ((ifp->if_capenable & IFCAP_LRO) && do_lro) {
1491 #if defined(INET) || defined(INET6)
1492                 struct lro_ctrl *lro = &rxr->hn_lro;
1493
1494                 if (lro->lro_cnt) {
1495                         rxr->hn_lro_tried++;
1496                         if (hn_lro_rx(lro, m_new) == 0) {
1497                                 /* DONE! */
1498                                 return 0;
1499                         }
1500                 }
1501 #endif
1502         }
1503
1504         /* We're not holding the lock here, so don't release it */
1505         (*ifp->if_input)(ifp, m_new);
1506
1507         return (0);
1508 }
1509
1510 /*
1511  * Rules for using sc->temp_unusable:
1512  * 1.  sc->temp_unusable can only be read or written while holding NV_LOCK()
1513  * 2.  code reading sc->temp_unusable under NV_LOCK(), and finding 
1514  *     sc->temp_unusable set, must release NV_LOCK() and exit
1515  * 3.  to retain exclusive control of the interface,
1516  *     sc->temp_unusable must be set by code before releasing NV_LOCK()
1517  * 4.  only code setting sc->temp_unusable can clear sc->temp_unusable
1518  * 5.  code setting sc->temp_unusable must eventually clear sc->temp_unusable
1519  */
1520
1521 /*
1522  * Standard ioctl entry point.  Called when the user wants to configure
1523  * the interface.
1524  */
1525 static int
1526 hn_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
1527 {
1528         hn_softc_t *sc = ifp->if_softc;
1529         struct ifreq *ifr = (struct ifreq *)data;
1530 #ifdef INET
1531         struct ifaddr *ifa = (struct ifaddr *)data;
1532 #endif
1533         netvsc_device_info device_info;
1534         int mask, error = 0, ring_cnt;
1535         int retry_cnt = 500;
1536         
1537         switch(cmd) {
1538
1539         case SIOCSIFADDR:
1540 #ifdef INET
1541                 if (ifa->ifa_addr->sa_family == AF_INET) {
1542                         ifp->if_flags |= IFF_UP;
1543                         if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
1544                                 hn_ifinit(sc);
1545                         arp_ifinit(ifp, ifa);
1546                 } else
1547 #endif
1548                 error = ether_ioctl(ifp, cmd, data);
1549                 break;
1550         case SIOCSIFMTU:
1551                 /* Check MTU value change */
1552                 if (ifp->if_mtu == ifr->ifr_mtu)
1553                         break;
1554
1555                 if (ifr->ifr_mtu > NETVSC_MAX_CONFIGURABLE_MTU) {
1556                         error = EINVAL;
1557                         break;
1558                 }
1559
1560                 /* Obtain and record requested MTU */
1561                 ifp->if_mtu = ifr->ifr_mtu;
1562
1563 #if __FreeBSD_version >= 1100099
1564                 /*
1565                  * Make sure that LRO aggregation length limit is still
1566                  * valid, after the MTU change.
1567                  */
1568                 NV_LOCK(sc);
1569                 if (sc->hn_rx_ring[0].hn_lro.lro_length_lim <
1570                     HN_LRO_LENLIM_MIN(ifp))
1571                         hn_set_lro_lenlim(sc, HN_LRO_LENLIM_MIN(ifp));
1572                 NV_UNLOCK(sc);
1573 #endif
1574
1575                 do {
1576                         NV_LOCK(sc);
1577                         if (!sc->temp_unusable) {
1578                                 sc->temp_unusable = TRUE;
1579                                 retry_cnt = -1;
1580                         }
1581                         NV_UNLOCK(sc);
1582                         if (retry_cnt > 0) {
1583                                 retry_cnt--;
1584                                 DELAY(5 * 1000);
1585                         }
1586                 } while (retry_cnt > 0);
1587
1588                 if (retry_cnt == 0) {
1589                         error = EINVAL;
1590                         break;
1591                 }
1592
1593                 /* We must remove and add back the device to cause the new
1594                  * MTU to take effect.  This includes tearing down, but not
1595                  * deleting the channel, then bringing it back up.
1596                  */
1597                 error = hv_rf_on_device_remove(sc);
1598                 if (error) {
1599                         NV_LOCK(sc);
1600                         sc->temp_unusable = FALSE;
1601                         NV_UNLOCK(sc);
1602                         break;
1603                 }
1604
1605                 /* Wait for subchannels to be destroyed */
1606                 vmbus_subchan_drain(sc->hn_prichan);
1607
1608                 ring_cnt = sc->hn_rx_ring_inuse;
1609                 error = hv_rf_on_device_add(sc, &device_info, &ring_cnt,
1610                     &sc->hn_rx_ring[0]);
1611                 if (error) {
1612                         NV_LOCK(sc);
1613                         sc->temp_unusable = FALSE;
1614                         NV_UNLOCK(sc);
1615                         break;
1616                 }
1617                 /* # of channels can _not_ be changed */
1618                 KASSERT(sc->hn_rx_ring_inuse == ring_cnt,
1619                     ("RX ring count %d and channel count %u mismatch",
1620                      sc->hn_rx_ring_cnt, ring_cnt));
1621                 if (sc->hn_rx_ring_inuse > 1) {
1622                         int r;
1623
1624                         /*
1625                          * Skip the rings on primary channel; they are
1626                          * handled by the hv_rf_on_device_add() above.
1627                          */
1628                         for (r = 1; r < sc->hn_rx_ring_cnt; ++r) {
1629                                 sc->hn_rx_ring[r].hn_rx_flags &=
1630                                     ~HN_RX_FLAG_ATTACHED;
1631                         }
1632                         for (r = 1; r < sc->hn_tx_ring_cnt; ++r) {
1633                                 sc->hn_tx_ring[r].hn_tx_flags &=
1634                                     ~HN_TX_FLAG_ATTACHED;
1635                         }
1636                         hn_subchan_setup(sc);
1637                 }
1638
1639                 if (sc->hn_tx_ring[0].hn_chim_size > sc->hn_chim_szmax)
1640                         hn_set_chim_size(sc, sc->hn_chim_szmax);
1641
1642                 hn_ifinit_locked(sc);
1643
1644                 NV_LOCK(sc);
1645                 sc->temp_unusable = FALSE;
1646                 NV_UNLOCK(sc);
1647                 break;
1648         case SIOCSIFFLAGS:
1649                 do {
1650                        NV_LOCK(sc);
1651                        if (!sc->temp_unusable) {
1652                                sc->temp_unusable = TRUE;
1653                                retry_cnt = -1;
1654                        }
1655                        NV_UNLOCK(sc);
1656                        if (retry_cnt > 0) {
1657                                 retry_cnt--;
1658                                 DELAY(5 * 1000);
1659                        }
1660                 } while (retry_cnt > 0);
1661
1662                 if (retry_cnt == 0) {
1663                        error = EINVAL;
1664                        break;
1665                 }
1666
1667                 if (ifp->if_flags & IFF_UP) {
1668                         /*
1669                          * If only the state of the PROMISC flag changed,
1670                          * then just use the 'set promisc mode' command
1671                          * instead of reinitializing the entire NIC. Doing
1672                          * a full re-init means reloading the firmware and
1673                          * waiting for it to start up, which may take a
1674                          * second or two.
1675                          */
1676 #ifdef notyet
1677                         /* Fixme:  Promiscuous mode? */
1678                         if (ifp->if_drv_flags & IFF_DRV_RUNNING &&
1679                             ifp->if_flags & IFF_PROMISC &&
1680                             !(sc->hn_if_flags & IFF_PROMISC)) {
1681                                 /* do something here for Hyper-V */
1682                         } else if (ifp->if_drv_flags & IFF_DRV_RUNNING &&
1683                             !(ifp->if_flags & IFF_PROMISC) &&
1684                             sc->hn_if_flags & IFF_PROMISC) {
1685                                 /* do something here for Hyper-V */
1686                         } else
1687 #endif
1688                                 hn_ifinit_locked(sc);
1689                 } else {
1690                         if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1691                                 hn_stop(sc);
1692                         }
1693                 }
1694                 NV_LOCK(sc);
1695                 sc->temp_unusable = FALSE;
1696                 NV_UNLOCK(sc);
1697                 sc->hn_if_flags = ifp->if_flags;
1698                 error = 0;
1699                 break;
1700         case SIOCSIFCAP:
1701                 NV_LOCK(sc);
1702
1703                 mask = ifr->ifr_reqcap ^ ifp->if_capenable;
1704                 if (mask & IFCAP_TXCSUM) {
1705                         ifp->if_capenable ^= IFCAP_TXCSUM;
1706                         if (ifp->if_capenable & IFCAP_TXCSUM) {
1707                                 ifp->if_hwassist |=
1708                                     sc->hn_tx_ring[0].hn_csum_assist;
1709                         } else {
1710                                 ifp->if_hwassist &=
1711                                     ~sc->hn_tx_ring[0].hn_csum_assist;
1712                         }
1713                 }
1714
1715                 if (mask & IFCAP_RXCSUM)
1716                         ifp->if_capenable ^= IFCAP_RXCSUM;
1717
1718                 if (mask & IFCAP_LRO)
1719                         ifp->if_capenable ^= IFCAP_LRO;
1720
1721                 if (mask & IFCAP_TSO4) {
1722                         ifp->if_capenable ^= IFCAP_TSO4;
1723                         if (ifp->if_capenable & IFCAP_TSO4)
1724                                 ifp->if_hwassist |= CSUM_IP_TSO;
1725                         else
1726                                 ifp->if_hwassist &= ~CSUM_IP_TSO;
1727                 }
1728
1729                 if (mask & IFCAP_TSO6) {
1730                         ifp->if_capenable ^= IFCAP_TSO6;
1731                         if (ifp->if_capenable & IFCAP_TSO6)
1732                                 ifp->if_hwassist |= CSUM_IP6_TSO;
1733                         else
1734                                 ifp->if_hwassist &= ~CSUM_IP6_TSO;
1735                 }
1736
1737                 NV_UNLOCK(sc);
1738                 error = 0;
1739                 break;
1740         case SIOCADDMULTI:
1741         case SIOCDELMULTI:
1742 #ifdef notyet
1743                 /* Fixme:  Multicast mode? */
1744                 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1745                         NV_LOCK(sc);
1746                         netvsc_setmulti(sc);
1747                         NV_UNLOCK(sc);
1748                         error = 0;
1749                 }
1750 #endif
1751                 error = EINVAL;
1752                 break;
1753         case SIOCSIFMEDIA:
1754         case SIOCGIFMEDIA:
1755                 error = ifmedia_ioctl(ifp, ifr, &sc->hn_media, cmd);
1756                 break;
1757         default:
1758                 error = ether_ioctl(ifp, cmd, data);
1759                 break;
1760         }
1761
1762         return (error);
1763 }
1764
1765 /*
1766  *
1767  */
1768 static void
1769 hn_stop(hn_softc_t *sc)
1770 {
1771         struct ifnet *ifp;
1772         int ret, i;
1773
1774         ifp = sc->hn_ifp;
1775
1776         if (bootverbose)
1777                 printf(" Closing Device ...\n");
1778
1779         atomic_clear_int(&ifp->if_drv_flags,
1780             (IFF_DRV_RUNNING | IFF_DRV_OACTIVE));
1781         for (i = 0; i < sc->hn_tx_ring_inuse; ++i)
1782                 sc->hn_tx_ring[i].hn_oactive = 0;
1783
1784         if_link_state_change(ifp, LINK_STATE_DOWN);
1785         sc->hn_initdone = 0;
1786
1787         ret = hv_rf_on_close(sc);
1788 }
1789
1790 /*
1791  * FreeBSD transmit entry point
1792  */
1793 static void
1794 hn_start(struct ifnet *ifp)
1795 {
1796         struct hn_softc *sc = ifp->if_softc;
1797         struct hn_tx_ring *txr = &sc->hn_tx_ring[0];
1798
1799         if (txr->hn_sched_tx)
1800                 goto do_sched;
1801
1802         if (mtx_trylock(&txr->hn_tx_lock)) {
1803                 int sched;
1804
1805                 sched = hn_start_locked(txr, txr->hn_direct_tx_size);
1806                 mtx_unlock(&txr->hn_tx_lock);
1807                 if (!sched)
1808                         return;
1809         }
1810 do_sched:
1811         taskqueue_enqueue(txr->hn_tx_taskq, &txr->hn_tx_task);
1812 }
1813
1814 static void
1815 hn_start_txeof(struct hn_tx_ring *txr)
1816 {
1817         struct hn_softc *sc = txr->hn_sc;
1818         struct ifnet *ifp = sc->hn_ifp;
1819
1820         KASSERT(txr == &sc->hn_tx_ring[0], ("not the first TX ring"));
1821
1822         if (txr->hn_sched_tx)
1823                 goto do_sched;
1824
1825         if (mtx_trylock(&txr->hn_tx_lock)) {
1826                 int sched;
1827
1828                 atomic_clear_int(&ifp->if_drv_flags, IFF_DRV_OACTIVE);
1829                 sched = hn_start_locked(txr, txr->hn_direct_tx_size);
1830                 mtx_unlock(&txr->hn_tx_lock);
1831                 if (sched) {
1832                         taskqueue_enqueue(txr->hn_tx_taskq,
1833                             &txr->hn_tx_task);
1834                 }
1835         } else {
1836 do_sched:
1837                 /*
1838                  * Release the OACTIVE earlier, with the hope, that
1839                  * others could catch up.  The task will clear the
1840                  * flag again with the hn_tx_lock to avoid possible
1841                  * races.
1842                  */
1843                 atomic_clear_int(&ifp->if_drv_flags, IFF_DRV_OACTIVE);
1844                 taskqueue_enqueue(txr->hn_tx_taskq, &txr->hn_txeof_task);
1845         }
1846 }
1847
1848 /*
1849  *
1850  */
1851 static void
1852 hn_ifinit_locked(hn_softc_t *sc)
1853 {
1854         struct ifnet *ifp;
1855         int ret, i;
1856
1857         ifp = sc->hn_ifp;
1858
1859         if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1860                 return;
1861         }
1862
1863         hv_promisc_mode = 1;
1864
1865         ret = hv_rf_on_open(sc);
1866         if (ret != 0) {
1867                 return;
1868         } else {
1869                 sc->hn_initdone = 1;
1870         }
1871
1872         atomic_clear_int(&ifp->if_drv_flags, IFF_DRV_OACTIVE);
1873         for (i = 0; i < sc->hn_tx_ring_inuse; ++i)
1874                 sc->hn_tx_ring[i].hn_oactive = 0;
1875
1876         atomic_set_int(&ifp->if_drv_flags, IFF_DRV_RUNNING);
1877         if_link_state_change(ifp, LINK_STATE_UP);
1878 }
1879
1880 /*
1881  *
1882  */
1883 static void
1884 hn_ifinit(void *xsc)
1885 {
1886         hn_softc_t *sc = xsc;
1887
1888         NV_LOCK(sc);
1889         if (sc->temp_unusable) {
1890                 NV_UNLOCK(sc);
1891                 return;
1892         }
1893         sc->temp_unusable = TRUE;
1894         NV_UNLOCK(sc);
1895
1896         hn_ifinit_locked(sc);
1897
1898         NV_LOCK(sc);
1899         sc->temp_unusable = FALSE;
1900         NV_UNLOCK(sc);
1901 }
1902
1903 #ifdef LATER
1904 /*
1905  *
1906  */
1907 static void
1908 hn_watchdog(struct ifnet *ifp)
1909 {
1910         hn_softc_t *sc;
1911         sc = ifp->if_softc;
1912
1913         printf("hn%d: watchdog timeout -- resetting\n", sc->hn_unit);
1914         hn_ifinit(sc);    /*???*/
1915         ifp->if_oerrors++;
1916 }
1917 #endif
1918
1919 #if __FreeBSD_version >= 1100099
1920
1921 static int
1922 hn_lro_lenlim_sysctl(SYSCTL_HANDLER_ARGS)
1923 {
1924         struct hn_softc *sc = arg1;
1925         unsigned int lenlim;
1926         int error;
1927
1928         lenlim = sc->hn_rx_ring[0].hn_lro.lro_length_lim;
1929         error = sysctl_handle_int(oidp, &lenlim, 0, req);
1930         if (error || req->newptr == NULL)
1931                 return error;
1932
1933         if (lenlim < HN_LRO_LENLIM_MIN(sc->hn_ifp) ||
1934             lenlim > TCP_LRO_LENGTH_MAX)
1935                 return EINVAL;
1936
1937         NV_LOCK(sc);
1938         hn_set_lro_lenlim(sc, lenlim);
1939         NV_UNLOCK(sc);
1940         return 0;
1941 }
1942
1943 static int
1944 hn_lro_ackcnt_sysctl(SYSCTL_HANDLER_ARGS)
1945 {
1946         struct hn_softc *sc = arg1;
1947         int ackcnt, error, i;
1948
1949         /*
1950          * lro_ackcnt_lim is append count limit,
1951          * +1 to turn it into aggregation limit.
1952          */
1953         ackcnt = sc->hn_rx_ring[0].hn_lro.lro_ackcnt_lim + 1;
1954         error = sysctl_handle_int(oidp, &ackcnt, 0, req);
1955         if (error || req->newptr == NULL)
1956                 return error;
1957
1958         if (ackcnt < 2 || ackcnt > (TCP_LRO_ACKCNT_MAX + 1))
1959                 return EINVAL;
1960
1961         /*
1962          * Convert aggregation limit back to append
1963          * count limit.
1964          */
1965         --ackcnt;
1966         NV_LOCK(sc);
1967         for (i = 0; i < sc->hn_rx_ring_inuse; ++i)
1968                 sc->hn_rx_ring[i].hn_lro.lro_ackcnt_lim = ackcnt;
1969         NV_UNLOCK(sc);
1970         return 0;
1971 }
1972
1973 #endif
1974
1975 static int
1976 hn_trust_hcsum_sysctl(SYSCTL_HANDLER_ARGS)
1977 {
1978         struct hn_softc *sc = arg1;
1979         int hcsum = arg2;
1980         int on, error, i;
1981
1982         on = 0;
1983         if (sc->hn_rx_ring[0].hn_trust_hcsum & hcsum)
1984                 on = 1;
1985
1986         error = sysctl_handle_int(oidp, &on, 0, req);
1987         if (error || req->newptr == NULL)
1988                 return error;
1989
1990         NV_LOCK(sc);
1991         for (i = 0; i < sc->hn_rx_ring_inuse; ++i) {
1992                 struct hn_rx_ring *rxr = &sc->hn_rx_ring[i];
1993
1994                 if (on)
1995                         rxr->hn_trust_hcsum |= hcsum;
1996                 else
1997                         rxr->hn_trust_hcsum &= ~hcsum;
1998         }
1999         NV_UNLOCK(sc);
2000         return 0;
2001 }
2002
2003 static int
2004 hn_chim_size_sysctl(SYSCTL_HANDLER_ARGS)
2005 {
2006         struct hn_softc *sc = arg1;
2007         int chim_size, error;
2008
2009         chim_size = sc->hn_tx_ring[0].hn_chim_size;
2010         error = sysctl_handle_int(oidp, &chim_size, 0, req);
2011         if (error || req->newptr == NULL)
2012                 return error;
2013
2014         if (chim_size > sc->hn_chim_szmax || chim_size <= 0)
2015                 return EINVAL;
2016
2017         hn_set_chim_size(sc, chim_size);
2018         return 0;
2019 }
2020
2021 #if __FreeBSD_version < 1100095
2022 static int
2023 hn_rx_stat_int_sysctl(SYSCTL_HANDLER_ARGS)
2024 {
2025         struct hn_softc *sc = arg1;
2026         int ofs = arg2, i, error;
2027         struct hn_rx_ring *rxr;
2028         uint64_t stat;
2029
2030         stat = 0;
2031         for (i = 0; i < sc->hn_rx_ring_inuse; ++i) {
2032                 rxr = &sc->hn_rx_ring[i];
2033                 stat += *((int *)((uint8_t *)rxr + ofs));
2034         }
2035
2036         error = sysctl_handle_64(oidp, &stat, 0, req);
2037         if (error || req->newptr == NULL)
2038                 return error;
2039
2040         /* Zero out this stat. */
2041         for (i = 0; i < sc->hn_rx_ring_inuse; ++i) {
2042                 rxr = &sc->hn_rx_ring[i];
2043                 *((int *)((uint8_t *)rxr + ofs)) = 0;
2044         }
2045         return 0;
2046 }
2047 #else
2048 static int
2049 hn_rx_stat_u64_sysctl(SYSCTL_HANDLER_ARGS)
2050 {
2051         struct hn_softc *sc = arg1;
2052         int ofs = arg2, i, error;
2053         struct hn_rx_ring *rxr;
2054         uint64_t stat;
2055
2056         stat = 0;
2057         for (i = 0; i < sc->hn_rx_ring_inuse; ++i) {
2058                 rxr = &sc->hn_rx_ring[i];
2059                 stat += *((uint64_t *)((uint8_t *)rxr + ofs));
2060         }
2061
2062         error = sysctl_handle_64(oidp, &stat, 0, req);
2063         if (error || req->newptr == NULL)
2064                 return error;
2065
2066         /* Zero out this stat. */
2067         for (i = 0; i < sc->hn_rx_ring_inuse; ++i) {
2068                 rxr = &sc->hn_rx_ring[i];
2069                 *((uint64_t *)((uint8_t *)rxr + ofs)) = 0;
2070         }
2071         return 0;
2072 }
2073
2074 #endif
2075
2076 static int
2077 hn_rx_stat_ulong_sysctl(SYSCTL_HANDLER_ARGS)
2078 {
2079         struct hn_softc *sc = arg1;
2080         int ofs = arg2, i, error;
2081         struct hn_rx_ring *rxr;
2082         u_long stat;
2083
2084         stat = 0;
2085         for (i = 0; i < sc->hn_rx_ring_cnt; ++i) {
2086                 rxr = &sc->hn_rx_ring[i];
2087                 stat += *((u_long *)((uint8_t *)rxr + ofs));
2088         }
2089
2090         error = sysctl_handle_long(oidp, &stat, 0, req);
2091         if (error || req->newptr == NULL)
2092                 return error;
2093
2094         /* Zero out this stat. */
2095         for (i = 0; i < sc->hn_rx_ring_cnt; ++i) {
2096                 rxr = &sc->hn_rx_ring[i];
2097                 *((u_long *)((uint8_t *)rxr + ofs)) = 0;
2098         }
2099         return 0;
2100 }
2101
2102 static int
2103 hn_tx_stat_ulong_sysctl(SYSCTL_HANDLER_ARGS)
2104 {
2105         struct hn_softc *sc = arg1;
2106         int ofs = arg2, i, error;
2107         struct hn_tx_ring *txr;
2108         u_long stat;
2109
2110         stat = 0;
2111         for (i = 0; i < sc->hn_tx_ring_inuse; ++i) {
2112                 txr = &sc->hn_tx_ring[i];
2113                 stat += *((u_long *)((uint8_t *)txr + ofs));
2114         }
2115
2116         error = sysctl_handle_long(oidp, &stat, 0, req);
2117         if (error || req->newptr == NULL)
2118                 return error;
2119
2120         /* Zero out this stat. */
2121         for (i = 0; i < sc->hn_tx_ring_inuse; ++i) {
2122                 txr = &sc->hn_tx_ring[i];
2123                 *((u_long *)((uint8_t *)txr + ofs)) = 0;
2124         }
2125         return 0;
2126 }
2127
2128 static int
2129 hn_tx_conf_int_sysctl(SYSCTL_HANDLER_ARGS)
2130 {
2131         struct hn_softc *sc = arg1;
2132         int ofs = arg2, i, error, conf;
2133         struct hn_tx_ring *txr;
2134
2135         txr = &sc->hn_tx_ring[0];
2136         conf = *((int *)((uint8_t *)txr + ofs));
2137
2138         error = sysctl_handle_int(oidp, &conf, 0, req);
2139         if (error || req->newptr == NULL)
2140                 return error;
2141
2142         NV_LOCK(sc);
2143         for (i = 0; i < sc->hn_tx_ring_inuse; ++i) {
2144                 txr = &sc->hn_tx_ring[i];
2145                 *((int *)((uint8_t *)txr + ofs)) = conf;
2146         }
2147         NV_UNLOCK(sc);
2148
2149         return 0;
2150 }
2151
2152 static int
2153 hn_ndis_version_sysctl(SYSCTL_HANDLER_ARGS)
2154 {
2155         struct hn_softc *sc = arg1;
2156         char verstr[16];
2157
2158         snprintf(verstr, sizeof(verstr), "%u.%u",
2159             NDIS_VERSION_MAJOR(sc->hn_ndis_ver),
2160             NDIS_VERSION_MINOR(sc->hn_ndis_ver));
2161         return sysctl_handle_string(oidp, verstr, sizeof(verstr), req);
2162 }
2163
2164 static int
2165 hn_check_iplen(const struct mbuf *m, int hoff)
2166 {
2167         const struct ip *ip;
2168         int len, iphlen, iplen;
2169         const struct tcphdr *th;
2170         int thoff;                              /* TCP data offset */
2171
2172         len = hoff + sizeof(struct ip);
2173
2174         /* The packet must be at least the size of an IP header. */
2175         if (m->m_pkthdr.len < len)
2176                 return IPPROTO_DONE;
2177
2178         /* The fixed IP header must reside completely in the first mbuf. */
2179         if (m->m_len < len)
2180                 return IPPROTO_DONE;
2181
2182         ip = mtodo(m, hoff);
2183
2184         /* Bound check the packet's stated IP header length. */
2185         iphlen = ip->ip_hl << 2;
2186         if (iphlen < sizeof(struct ip))         /* minimum header length */
2187                 return IPPROTO_DONE;
2188
2189         /* The full IP header must reside completely in the one mbuf. */
2190         if (m->m_len < hoff + iphlen)
2191                 return IPPROTO_DONE;
2192
2193         iplen = ntohs(ip->ip_len);
2194
2195         /*
2196          * Check that the amount of data in the buffers is as
2197          * at least much as the IP header would have us expect.
2198          */
2199         if (m->m_pkthdr.len < hoff + iplen)
2200                 return IPPROTO_DONE;
2201
2202         /*
2203          * Ignore IP fragments.
2204          */
2205         if (ntohs(ip->ip_off) & (IP_OFFMASK | IP_MF))
2206                 return IPPROTO_DONE;
2207
2208         /*
2209          * The TCP/IP or UDP/IP header must be entirely contained within
2210          * the first fragment of a packet.
2211          */
2212         switch (ip->ip_p) {
2213         case IPPROTO_TCP:
2214                 if (iplen < iphlen + sizeof(struct tcphdr))
2215                         return IPPROTO_DONE;
2216                 if (m->m_len < hoff + iphlen + sizeof(struct tcphdr))
2217                         return IPPROTO_DONE;
2218                 th = (const struct tcphdr *)((const uint8_t *)ip + iphlen);
2219                 thoff = th->th_off << 2;
2220                 if (thoff < sizeof(struct tcphdr) || thoff + iphlen > iplen)
2221                         return IPPROTO_DONE;
2222                 if (m->m_len < hoff + iphlen + thoff)
2223                         return IPPROTO_DONE;
2224                 break;
2225         case IPPROTO_UDP:
2226                 if (iplen < iphlen + sizeof(struct udphdr))
2227                         return IPPROTO_DONE;
2228                 if (m->m_len < hoff + iphlen + sizeof(struct udphdr))
2229                         return IPPROTO_DONE;
2230                 break;
2231         default:
2232                 if (iplen < iphlen)
2233                         return IPPROTO_DONE;
2234                 break;
2235         }
2236         return ip->ip_p;
2237 }
2238
2239 static int
2240 hn_create_rx_data(struct hn_softc *sc, int ring_cnt)
2241 {
2242         struct sysctl_oid_list *child;
2243         struct sysctl_ctx_list *ctx;
2244         device_t dev = sc->hn_dev;
2245 #if defined(INET) || defined(INET6)
2246 #if __FreeBSD_version >= 1100095
2247         int lroent_cnt;
2248 #endif
2249 #endif
2250         int i;
2251
2252         /*
2253          * Create RXBUF for reception.
2254          *
2255          * NOTE:
2256          * - It is shared by all channels.
2257          * - A large enough buffer is allocated, certain version of NVSes
2258          *   may further limit the usable space.
2259          */
2260         sc->hn_rxbuf = hyperv_dmamem_alloc(bus_get_dma_tag(dev),
2261             PAGE_SIZE, 0, NETVSC_RECEIVE_BUFFER_SIZE, &sc->hn_rxbuf_dma,
2262             BUS_DMA_WAITOK | BUS_DMA_ZERO);
2263         if (sc->hn_rxbuf == NULL) {
2264                 device_printf(sc->hn_dev, "allocate rxbuf failed\n");
2265                 return (ENOMEM);
2266         }
2267
2268         sc->hn_rx_ring_cnt = ring_cnt;
2269         sc->hn_rx_ring_inuse = sc->hn_rx_ring_cnt;
2270
2271         sc->hn_rx_ring = malloc(sizeof(struct hn_rx_ring) * sc->hn_rx_ring_cnt,
2272             M_NETVSC, M_WAITOK | M_ZERO);
2273
2274 #if defined(INET) || defined(INET6)
2275 #if __FreeBSD_version >= 1100095
2276         lroent_cnt = hn_lro_entry_count;
2277         if (lroent_cnt < TCP_LRO_ENTRIES)
2278                 lroent_cnt = TCP_LRO_ENTRIES;
2279         device_printf(dev, "LRO: entry count %d\n", lroent_cnt);
2280 #endif
2281 #endif  /* INET || INET6 */
2282
2283         ctx = device_get_sysctl_ctx(dev);
2284         child = SYSCTL_CHILDREN(device_get_sysctl_tree(dev));
2285
2286         /* Create dev.hn.UNIT.rx sysctl tree */
2287         sc->hn_rx_sysctl_tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "rx",
2288             CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "");
2289
2290         for (i = 0; i < sc->hn_rx_ring_cnt; ++i) {
2291                 struct hn_rx_ring *rxr = &sc->hn_rx_ring[i];
2292
2293                 if (hn_trust_hosttcp)
2294                         rxr->hn_trust_hcsum |= HN_TRUST_HCSUM_TCP;
2295                 if (hn_trust_hostudp)
2296                         rxr->hn_trust_hcsum |= HN_TRUST_HCSUM_UDP;
2297                 if (hn_trust_hostip)
2298                         rxr->hn_trust_hcsum |= HN_TRUST_HCSUM_IP;
2299                 rxr->hn_ifp = sc->hn_ifp;
2300                 if (i < sc->hn_tx_ring_cnt)
2301                         rxr->hn_txr = &sc->hn_tx_ring[i];
2302                 rxr->hn_rdbuf = malloc(NETVSC_PACKET_SIZE, M_NETVSC, M_WAITOK);
2303                 rxr->hn_rx_idx = i;
2304                 rxr->hn_rxbuf = sc->hn_rxbuf;
2305
2306                 /*
2307                  * Initialize LRO.
2308                  */
2309 #if defined(INET) || defined(INET6)
2310 #if __FreeBSD_version >= 1100095
2311                 tcp_lro_init_args(&rxr->hn_lro, sc->hn_ifp, lroent_cnt,
2312                     hn_lro_mbufq_depth);
2313 #else
2314                 tcp_lro_init(&rxr->hn_lro);
2315                 rxr->hn_lro.ifp = sc->hn_ifp;
2316 #endif
2317 #if __FreeBSD_version >= 1100099
2318                 rxr->hn_lro.lro_length_lim = HN_LRO_LENLIM_DEF;
2319                 rxr->hn_lro.lro_ackcnt_lim = HN_LRO_ACKCNT_DEF;
2320 #endif
2321 #endif  /* INET || INET6 */
2322
2323                 if (sc->hn_rx_sysctl_tree != NULL) {
2324                         char name[16];
2325
2326                         /*
2327                          * Create per RX ring sysctl tree:
2328                          * dev.hn.UNIT.rx.RINGID
2329                          */
2330                         snprintf(name, sizeof(name), "%d", i);
2331                         rxr->hn_rx_sysctl_tree = SYSCTL_ADD_NODE(ctx,
2332                             SYSCTL_CHILDREN(sc->hn_rx_sysctl_tree),
2333                             OID_AUTO, name, CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "");
2334
2335                         if (rxr->hn_rx_sysctl_tree != NULL) {
2336                                 SYSCTL_ADD_ULONG(ctx,
2337                                     SYSCTL_CHILDREN(rxr->hn_rx_sysctl_tree),
2338                                     OID_AUTO, "packets", CTLFLAG_RW,
2339                                     &rxr->hn_pkts, "# of packets received");
2340                                 SYSCTL_ADD_ULONG(ctx,
2341                                     SYSCTL_CHILDREN(rxr->hn_rx_sysctl_tree),
2342                                     OID_AUTO, "rss_pkts", CTLFLAG_RW,
2343                                     &rxr->hn_rss_pkts,
2344                                     "# of packets w/ RSS info received");
2345                         }
2346                 }
2347         }
2348
2349         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "lro_queued",
2350             CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2351             __offsetof(struct hn_rx_ring, hn_lro.lro_queued),
2352 #if __FreeBSD_version < 1100095
2353             hn_rx_stat_int_sysctl,
2354 #else
2355             hn_rx_stat_u64_sysctl,
2356 #endif
2357             "LU", "LRO queued");
2358         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "lro_flushed",
2359             CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2360             __offsetof(struct hn_rx_ring, hn_lro.lro_flushed),
2361 #if __FreeBSD_version < 1100095
2362             hn_rx_stat_int_sysctl,
2363 #else
2364             hn_rx_stat_u64_sysctl,
2365 #endif
2366             "LU", "LRO flushed");
2367         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "lro_tried",
2368             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2369             __offsetof(struct hn_rx_ring, hn_lro_tried),
2370             hn_rx_stat_ulong_sysctl, "LU", "# of LRO tries");
2371 #if __FreeBSD_version >= 1100099
2372         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "lro_length_lim",
2373             CTLTYPE_UINT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc, 0,
2374             hn_lro_lenlim_sysctl, "IU",
2375             "Max # of data bytes to be aggregated by LRO");
2376         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "lro_ackcnt_lim",
2377             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc, 0,
2378             hn_lro_ackcnt_sysctl, "I",
2379             "Max # of ACKs to be aggregated by LRO");
2380 #endif
2381         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "trust_hosttcp",
2382             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc, HN_TRUST_HCSUM_TCP,
2383             hn_trust_hcsum_sysctl, "I",
2384             "Trust tcp segement verification on host side, "
2385             "when csum info is missing");
2386         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "trust_hostudp",
2387             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc, HN_TRUST_HCSUM_UDP,
2388             hn_trust_hcsum_sysctl, "I",
2389             "Trust udp datagram verification on host side, "
2390             "when csum info is missing");
2391         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "trust_hostip",
2392             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc, HN_TRUST_HCSUM_IP,
2393             hn_trust_hcsum_sysctl, "I",
2394             "Trust ip packet verification on host side, "
2395             "when csum info is missing");
2396         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "csum_ip",
2397             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2398             __offsetof(struct hn_rx_ring, hn_csum_ip),
2399             hn_rx_stat_ulong_sysctl, "LU", "RXCSUM IP");
2400         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "csum_tcp",
2401             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2402             __offsetof(struct hn_rx_ring, hn_csum_tcp),
2403             hn_rx_stat_ulong_sysctl, "LU", "RXCSUM TCP");
2404         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "csum_udp",
2405             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2406             __offsetof(struct hn_rx_ring, hn_csum_udp),
2407             hn_rx_stat_ulong_sysctl, "LU", "RXCSUM UDP");
2408         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "csum_trusted",
2409             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2410             __offsetof(struct hn_rx_ring, hn_csum_trusted),
2411             hn_rx_stat_ulong_sysctl, "LU",
2412             "# of packets that we trust host's csum verification");
2413         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "small_pkts",
2414             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2415             __offsetof(struct hn_rx_ring, hn_small_pkts),
2416             hn_rx_stat_ulong_sysctl, "LU", "# of small packets received");
2417         SYSCTL_ADD_INT(ctx, child, OID_AUTO, "rx_ring_cnt",
2418             CTLFLAG_RD, &sc->hn_rx_ring_cnt, 0, "# created RX rings");
2419         SYSCTL_ADD_INT(ctx, child, OID_AUTO, "rx_ring_inuse",
2420             CTLFLAG_RD, &sc->hn_rx_ring_inuse, 0, "# used RX rings");
2421
2422         return (0);
2423 }
2424
2425 static void
2426 hn_destroy_rx_data(struct hn_softc *sc)
2427 {
2428         int i;
2429
2430         if (sc->hn_rxbuf != NULL) {
2431                 hyperv_dmamem_free(&sc->hn_rxbuf_dma, sc->hn_rxbuf);
2432                 sc->hn_rxbuf = NULL;
2433         }
2434
2435         if (sc->hn_rx_ring_cnt == 0)
2436                 return;
2437
2438         for (i = 0; i < sc->hn_rx_ring_cnt; ++i) {
2439                 struct hn_rx_ring *rxr = &sc->hn_rx_ring[i];
2440
2441 #if defined(INET) || defined(INET6)
2442                 tcp_lro_free(&rxr->hn_lro);
2443 #endif
2444                 free(rxr->hn_rdbuf, M_NETVSC);
2445         }
2446         free(sc->hn_rx_ring, M_NETVSC);
2447         sc->hn_rx_ring = NULL;
2448
2449         sc->hn_rx_ring_cnt = 0;
2450         sc->hn_rx_ring_inuse = 0;
2451 }
2452
2453 static int
2454 hn_create_tx_ring(struct hn_softc *sc, int id)
2455 {
2456         struct hn_tx_ring *txr = &sc->hn_tx_ring[id];
2457         device_t dev = sc->hn_dev;
2458         bus_dma_tag_t parent_dtag;
2459         int error, i;
2460         uint32_t version;
2461
2462         txr->hn_sc = sc;
2463         txr->hn_tx_idx = id;
2464
2465 #ifndef HN_USE_TXDESC_BUFRING
2466         mtx_init(&txr->hn_txlist_spin, "hn txlist", NULL, MTX_SPIN);
2467 #endif
2468         mtx_init(&txr->hn_tx_lock, "hn tx", NULL, MTX_DEF);
2469
2470         txr->hn_txdesc_cnt = HN_TX_DESC_CNT;
2471         txr->hn_txdesc = malloc(sizeof(struct hn_txdesc) * txr->hn_txdesc_cnt,
2472             M_NETVSC, M_WAITOK | M_ZERO);
2473 #ifndef HN_USE_TXDESC_BUFRING
2474         SLIST_INIT(&txr->hn_txlist);
2475 #else
2476         txr->hn_txdesc_br = buf_ring_alloc(txr->hn_txdesc_cnt, M_NETVSC,
2477             M_WAITOK, &txr->hn_tx_lock);
2478 #endif
2479
2480         txr->hn_tx_taskq = sc->hn_tx_taskq;
2481
2482         if (hn_use_if_start) {
2483                 txr->hn_txeof = hn_start_txeof;
2484                 TASK_INIT(&txr->hn_tx_task, 0, hn_start_taskfunc, txr);
2485                 TASK_INIT(&txr->hn_txeof_task, 0, hn_start_txeof_taskfunc, txr);
2486         } else {
2487                 int br_depth;
2488
2489                 txr->hn_txeof = hn_xmit_txeof;
2490                 TASK_INIT(&txr->hn_tx_task, 0, hn_xmit_taskfunc, txr);
2491                 TASK_INIT(&txr->hn_txeof_task, 0, hn_xmit_txeof_taskfunc, txr);
2492
2493                 br_depth = hn_get_txswq_depth(txr);
2494                 txr->hn_mbuf_br = buf_ring_alloc(br_depth, M_NETVSC,
2495                     M_WAITOK, &txr->hn_tx_lock);
2496         }
2497
2498         txr->hn_direct_tx_size = hn_direct_tx_size;
2499         version = VMBUS_GET_VERSION(device_get_parent(dev), dev);
2500         if (version >= VMBUS_VERSION_WIN8_1) {
2501                 txr->hn_csum_assist = HN_CSUM_ASSIST;
2502         } else {
2503                 txr->hn_csum_assist = HN_CSUM_ASSIST_WIN8;
2504                 if (id == 0) {
2505                         device_printf(dev, "bus version %u.%u, "
2506                             "no UDP checksum offloading\n",
2507                             VMBUS_VERSION_MAJOR(version),
2508                             VMBUS_VERSION_MINOR(version));
2509                 }
2510         }
2511
2512         /*
2513          * Always schedule transmission instead of trying to do direct
2514          * transmission.  This one gives the best performance so far.
2515          */
2516         txr->hn_sched_tx = 1;
2517
2518         parent_dtag = bus_get_dma_tag(dev);
2519
2520         /* DMA tag for RNDIS messages. */
2521         error = bus_dma_tag_create(parent_dtag, /* parent */
2522             HN_RNDIS_MSG_ALIGN,         /* alignment */
2523             HN_RNDIS_MSG_BOUNDARY,      /* boundary */
2524             BUS_SPACE_MAXADDR,          /* lowaddr */
2525             BUS_SPACE_MAXADDR,          /* highaddr */
2526             NULL, NULL,                 /* filter, filterarg */
2527             HN_RNDIS_MSG_LEN,           /* maxsize */
2528             1,                          /* nsegments */
2529             HN_RNDIS_MSG_LEN,           /* maxsegsize */
2530             0,                          /* flags */
2531             NULL,                       /* lockfunc */
2532             NULL,                       /* lockfuncarg */
2533             &txr->hn_tx_rndis_dtag);
2534         if (error) {
2535                 device_printf(dev, "failed to create rndis dmatag\n");
2536                 return error;
2537         }
2538
2539         /* DMA tag for data. */
2540         error = bus_dma_tag_create(parent_dtag, /* parent */
2541             1,                          /* alignment */
2542             HN_TX_DATA_BOUNDARY,        /* boundary */
2543             BUS_SPACE_MAXADDR,          /* lowaddr */
2544             BUS_SPACE_MAXADDR,          /* highaddr */
2545             NULL, NULL,                 /* filter, filterarg */
2546             HN_TX_DATA_MAXSIZE,         /* maxsize */
2547             HN_TX_DATA_SEGCNT_MAX,      /* nsegments */
2548             HN_TX_DATA_SEGSIZE,         /* maxsegsize */
2549             0,                          /* flags */
2550             NULL,                       /* lockfunc */
2551             NULL,                       /* lockfuncarg */
2552             &txr->hn_tx_data_dtag);
2553         if (error) {
2554                 device_printf(dev, "failed to create data dmatag\n");
2555                 return error;
2556         }
2557
2558         for (i = 0; i < txr->hn_txdesc_cnt; ++i) {
2559                 struct hn_txdesc *txd = &txr->hn_txdesc[i];
2560
2561                 txd->txr = txr;
2562
2563                 /*
2564                  * Allocate and load RNDIS messages.
2565                  */
2566                 error = bus_dmamem_alloc(txr->hn_tx_rndis_dtag,
2567                     (void **)&txd->rndis_msg,
2568                     BUS_DMA_WAITOK | BUS_DMA_COHERENT,
2569                     &txd->rndis_msg_dmap);
2570                 if (error) {
2571                         device_printf(dev,
2572                             "failed to allocate rndis_msg, %d\n", i);
2573                         return error;
2574                 }
2575
2576                 error = bus_dmamap_load(txr->hn_tx_rndis_dtag,
2577                     txd->rndis_msg_dmap,
2578                     txd->rndis_msg, HN_RNDIS_MSG_LEN,
2579                     hyperv_dma_map_paddr, &txd->rndis_msg_paddr,
2580                     BUS_DMA_NOWAIT);
2581                 if (error) {
2582                         device_printf(dev,
2583                             "failed to load rndis_msg, %d\n", i);
2584                         bus_dmamem_free(txr->hn_tx_rndis_dtag,
2585                             txd->rndis_msg, txd->rndis_msg_dmap);
2586                         return error;
2587                 }
2588
2589                 /* DMA map for TX data. */
2590                 error = bus_dmamap_create(txr->hn_tx_data_dtag, 0,
2591                     &txd->data_dmap);
2592                 if (error) {
2593                         device_printf(dev,
2594                             "failed to allocate tx data dmamap\n");
2595                         bus_dmamap_unload(txr->hn_tx_rndis_dtag,
2596                             txd->rndis_msg_dmap);
2597                         bus_dmamem_free(txr->hn_tx_rndis_dtag,
2598                             txd->rndis_msg, txd->rndis_msg_dmap);
2599                         return error;
2600                 }
2601
2602                 /* All set, put it to list */
2603                 txd->flags |= HN_TXD_FLAG_ONLIST;
2604 #ifndef HN_USE_TXDESC_BUFRING
2605                 SLIST_INSERT_HEAD(&txr->hn_txlist, txd, link);
2606 #else
2607                 buf_ring_enqueue(txr->hn_txdesc_br, txd);
2608 #endif
2609         }
2610         txr->hn_txdesc_avail = txr->hn_txdesc_cnt;
2611
2612         if (sc->hn_tx_sysctl_tree != NULL) {
2613                 struct sysctl_oid_list *child;
2614                 struct sysctl_ctx_list *ctx;
2615                 char name[16];
2616
2617                 /*
2618                  * Create per TX ring sysctl tree:
2619                  * dev.hn.UNIT.tx.RINGID
2620                  */
2621                 ctx = device_get_sysctl_ctx(dev);
2622                 child = SYSCTL_CHILDREN(sc->hn_tx_sysctl_tree);
2623
2624                 snprintf(name, sizeof(name), "%d", id);
2625                 txr->hn_tx_sysctl_tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO,
2626                     name, CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "");
2627
2628                 if (txr->hn_tx_sysctl_tree != NULL) {
2629                         child = SYSCTL_CHILDREN(txr->hn_tx_sysctl_tree);
2630
2631                         SYSCTL_ADD_INT(ctx, child, OID_AUTO, "txdesc_avail",
2632                             CTLFLAG_RD, &txr->hn_txdesc_avail, 0,
2633                             "# of available TX descs");
2634                         if (!hn_use_if_start) {
2635                                 SYSCTL_ADD_INT(ctx, child, OID_AUTO, "oactive",
2636                                     CTLFLAG_RD, &txr->hn_oactive, 0,
2637                                     "over active");
2638                         }
2639                         SYSCTL_ADD_ULONG(ctx, child, OID_AUTO, "packets",
2640                             CTLFLAG_RW, &txr->hn_pkts,
2641                             "# of packets transmitted");
2642                 }
2643         }
2644
2645         return 0;
2646 }
2647
2648 static void
2649 hn_txdesc_dmamap_destroy(struct hn_txdesc *txd)
2650 {
2651         struct hn_tx_ring *txr = txd->txr;
2652
2653         KASSERT(txd->m == NULL, ("still has mbuf installed"));
2654         KASSERT((txd->flags & HN_TXD_FLAG_DMAMAP) == 0, ("still dma mapped"));
2655
2656         bus_dmamap_unload(txr->hn_tx_rndis_dtag, txd->rndis_msg_dmap);
2657         bus_dmamem_free(txr->hn_tx_rndis_dtag, txd->rndis_msg,
2658             txd->rndis_msg_dmap);
2659         bus_dmamap_destroy(txr->hn_tx_data_dtag, txd->data_dmap);
2660 }
2661
2662 static void
2663 hn_destroy_tx_ring(struct hn_tx_ring *txr)
2664 {
2665         struct hn_txdesc *txd;
2666
2667         if (txr->hn_txdesc == NULL)
2668                 return;
2669
2670 #ifndef HN_USE_TXDESC_BUFRING
2671         while ((txd = SLIST_FIRST(&txr->hn_txlist)) != NULL) {
2672                 SLIST_REMOVE_HEAD(&txr->hn_txlist, link);
2673                 hn_txdesc_dmamap_destroy(txd);
2674         }
2675 #else
2676         mtx_lock(&txr->hn_tx_lock);
2677         while ((txd = buf_ring_dequeue_sc(txr->hn_txdesc_br)) != NULL)
2678                 hn_txdesc_dmamap_destroy(txd);
2679         mtx_unlock(&txr->hn_tx_lock);
2680 #endif
2681
2682         if (txr->hn_tx_data_dtag != NULL)
2683                 bus_dma_tag_destroy(txr->hn_tx_data_dtag);
2684         if (txr->hn_tx_rndis_dtag != NULL)
2685                 bus_dma_tag_destroy(txr->hn_tx_rndis_dtag);
2686
2687 #ifdef HN_USE_TXDESC_BUFRING
2688         buf_ring_free(txr->hn_txdesc_br, M_NETVSC);
2689 #endif
2690
2691         free(txr->hn_txdesc, M_NETVSC);
2692         txr->hn_txdesc = NULL;
2693
2694         if (txr->hn_mbuf_br != NULL)
2695                 buf_ring_free(txr->hn_mbuf_br, M_NETVSC);
2696
2697 #ifndef HN_USE_TXDESC_BUFRING
2698         mtx_destroy(&txr->hn_txlist_spin);
2699 #endif
2700         mtx_destroy(&txr->hn_tx_lock);
2701 }
2702
2703 static int
2704 hn_create_tx_data(struct hn_softc *sc, int ring_cnt)
2705 {
2706         struct sysctl_oid_list *child;
2707         struct sysctl_ctx_list *ctx;
2708         int i;
2709
2710         /*
2711          * Create TXBUF for chimney sending.
2712          *
2713          * NOTE: It is shared by all channels.
2714          */
2715         sc->hn_chim = hyperv_dmamem_alloc(bus_get_dma_tag(sc->hn_dev),
2716             PAGE_SIZE, 0, NETVSC_SEND_BUFFER_SIZE, &sc->hn_chim_dma,
2717             BUS_DMA_WAITOK | BUS_DMA_ZERO);
2718         if (sc->hn_chim == NULL) {
2719                 device_printf(sc->hn_dev, "allocate txbuf failed\n");
2720                 return (ENOMEM);
2721         }
2722
2723         sc->hn_tx_ring_cnt = ring_cnt;
2724         sc->hn_tx_ring_inuse = sc->hn_tx_ring_cnt;
2725
2726         sc->hn_tx_ring = malloc(sizeof(struct hn_tx_ring) * sc->hn_tx_ring_cnt,
2727             M_NETVSC, M_WAITOK | M_ZERO);
2728
2729         ctx = device_get_sysctl_ctx(sc->hn_dev);
2730         child = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->hn_dev));
2731
2732         /* Create dev.hn.UNIT.tx sysctl tree */
2733         sc->hn_tx_sysctl_tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "tx",
2734             CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "");
2735
2736         for (i = 0; i < sc->hn_tx_ring_cnt; ++i) {
2737                 int error;
2738
2739                 error = hn_create_tx_ring(sc, i);
2740                 if (error)
2741                         return error;
2742         }
2743
2744         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "no_txdescs",
2745             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2746             __offsetof(struct hn_tx_ring, hn_no_txdescs),
2747             hn_tx_stat_ulong_sysctl, "LU", "# of times short of TX descs");
2748         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "send_failed",
2749             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2750             __offsetof(struct hn_tx_ring, hn_send_failed),
2751             hn_tx_stat_ulong_sysctl, "LU", "# of hyper-v sending failure");
2752         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "txdma_failed",
2753             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2754             __offsetof(struct hn_tx_ring, hn_txdma_failed),
2755             hn_tx_stat_ulong_sysctl, "LU", "# of TX DMA failure");
2756         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "tx_collapsed",
2757             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2758             __offsetof(struct hn_tx_ring, hn_tx_collapsed),
2759             hn_tx_stat_ulong_sysctl, "LU", "# of TX mbuf collapsed");
2760         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "tx_chimney",
2761             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2762             __offsetof(struct hn_tx_ring, hn_tx_chimney),
2763             hn_tx_stat_ulong_sysctl, "LU", "# of chimney send");
2764         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "tx_chimney_tried",
2765             CTLTYPE_ULONG | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2766             __offsetof(struct hn_tx_ring, hn_tx_chimney_tried),
2767             hn_tx_stat_ulong_sysctl, "LU", "# of chimney send tries");
2768         SYSCTL_ADD_INT(ctx, child, OID_AUTO, "txdesc_cnt",
2769             CTLFLAG_RD, &sc->hn_tx_ring[0].hn_txdesc_cnt, 0,
2770             "# of total TX descs");
2771         SYSCTL_ADD_INT(ctx, child, OID_AUTO, "tx_chimney_max",
2772             CTLFLAG_RD, &sc->hn_chim_szmax, 0,
2773             "Chimney send packet size upper boundary");
2774         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "tx_chimney_size",
2775             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc, 0,
2776             hn_chim_size_sysctl, "I", "Chimney send packet size limit");
2777         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "direct_tx_size",
2778             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2779             __offsetof(struct hn_tx_ring, hn_direct_tx_size),
2780             hn_tx_conf_int_sysctl, "I",
2781             "Size of the packet for direct transmission");
2782         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "sched_tx",
2783             CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, sc,
2784             __offsetof(struct hn_tx_ring, hn_sched_tx),
2785             hn_tx_conf_int_sysctl, "I",
2786             "Always schedule transmission "
2787             "instead of doing direct transmission");
2788         SYSCTL_ADD_INT(ctx, child, OID_AUTO, "tx_ring_cnt",
2789             CTLFLAG_RD, &sc->hn_tx_ring_cnt, 0, "# created TX rings");
2790         SYSCTL_ADD_INT(ctx, child, OID_AUTO, "tx_ring_inuse",
2791             CTLFLAG_RD, &sc->hn_tx_ring_inuse, 0, "# used TX rings");
2792
2793         return 0;
2794 }
2795
2796 static void
2797 hn_set_chim_size(struct hn_softc *sc, int chim_size)
2798 {
2799         int i;
2800
2801         NV_LOCK(sc);
2802         for (i = 0; i < sc->hn_tx_ring_inuse; ++i)
2803                 sc->hn_tx_ring[i].hn_chim_size = chim_size;
2804         NV_UNLOCK(sc);
2805 }
2806
2807 static void
2808 hn_destroy_tx_data(struct hn_softc *sc)
2809 {
2810         int i;
2811
2812         if (sc->hn_chim != NULL) {
2813                 hyperv_dmamem_free(&sc->hn_chim_dma, sc->hn_chim);
2814                 sc->hn_chim = NULL;
2815         }
2816
2817         if (sc->hn_tx_ring_cnt == 0)
2818                 return;
2819
2820         for (i = 0; i < sc->hn_tx_ring_cnt; ++i)
2821                 hn_destroy_tx_ring(&sc->hn_tx_ring[i]);
2822
2823         free(sc->hn_tx_ring, M_NETVSC);
2824         sc->hn_tx_ring = NULL;
2825
2826         sc->hn_tx_ring_cnt = 0;
2827         sc->hn_tx_ring_inuse = 0;
2828 }
2829
2830 static void
2831 hn_start_taskfunc(void *xtxr, int pending __unused)
2832 {
2833         struct hn_tx_ring *txr = xtxr;
2834
2835         mtx_lock(&txr->hn_tx_lock);
2836         hn_start_locked(txr, 0);
2837         mtx_unlock(&txr->hn_tx_lock);
2838 }
2839
2840 static void
2841 hn_start_txeof_taskfunc(void *xtxr, int pending __unused)
2842 {
2843         struct hn_tx_ring *txr = xtxr;
2844
2845         mtx_lock(&txr->hn_tx_lock);
2846         atomic_clear_int(&txr->hn_sc->hn_ifp->if_drv_flags, IFF_DRV_OACTIVE);
2847         hn_start_locked(txr, 0);
2848         mtx_unlock(&txr->hn_tx_lock);
2849 }
2850
2851 static void
2852 hn_stop_tx_tasks(struct hn_softc *sc)
2853 {
2854         int i;
2855
2856         for (i = 0; i < sc->hn_tx_ring_inuse; ++i) {
2857                 struct hn_tx_ring *txr = &sc->hn_tx_ring[i];
2858
2859                 taskqueue_drain(txr->hn_tx_taskq, &txr->hn_tx_task);
2860                 taskqueue_drain(txr->hn_tx_taskq, &txr->hn_txeof_task);
2861         }
2862 }
2863
2864 static int
2865 hn_xmit(struct hn_tx_ring *txr, int len)
2866 {
2867         struct hn_softc *sc = txr->hn_sc;
2868         struct ifnet *ifp = sc->hn_ifp;
2869         struct mbuf *m_head;
2870
2871         mtx_assert(&txr->hn_tx_lock, MA_OWNED);
2872         KASSERT(hn_use_if_start == 0,
2873             ("hn_xmit is called, when if_start is enabled"));
2874
2875         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 || txr->hn_oactive)
2876                 return 0;
2877
2878         while ((m_head = drbr_peek(ifp, txr->hn_mbuf_br)) != NULL) {
2879                 struct hn_txdesc *txd;
2880                 int error;
2881
2882                 if (len > 0 && m_head->m_pkthdr.len > len) {
2883                         /*
2884                          * This sending could be time consuming; let callers
2885                          * dispatch this packet sending (and sending of any
2886                          * following up packets) to tx taskqueue.
2887                          */
2888                         drbr_putback(ifp, txr->hn_mbuf_br, m_head);
2889                         return 1;
2890                 }
2891
2892                 txd = hn_txdesc_get(txr);
2893                 if (txd == NULL) {
2894                         txr->hn_no_txdescs++;
2895                         drbr_putback(ifp, txr->hn_mbuf_br, m_head);
2896                         txr->hn_oactive = 1;
2897                         break;
2898                 }
2899
2900                 error = hn_encap(txr, txd, &m_head);
2901                 if (error) {
2902                         /* Both txd and m_head are freed; discard */
2903                         drbr_advance(ifp, txr->hn_mbuf_br);
2904                         continue;
2905                 }
2906
2907                 error = hn_send_pkt(ifp, txr, txd);
2908                 if (__predict_false(error)) {
2909                         /* txd is freed, but m_head is not */
2910                         drbr_putback(ifp, txr->hn_mbuf_br, m_head);
2911                         txr->hn_oactive = 1;
2912                         break;
2913                 }
2914
2915                 /* Sent */
2916                 drbr_advance(ifp, txr->hn_mbuf_br);
2917         }
2918         return 0;
2919 }
2920
2921 static int
2922 hn_transmit(struct ifnet *ifp, struct mbuf *m)
2923 {
2924         struct hn_softc *sc = ifp->if_softc;
2925         struct hn_tx_ring *txr;
2926         int error, idx = 0;
2927
2928         /*
2929          * Select the TX ring based on flowid
2930          */
2931         if (M_HASHTYPE_GET(m) != M_HASHTYPE_NONE)
2932                 idx = m->m_pkthdr.flowid % sc->hn_tx_ring_inuse;
2933         txr = &sc->hn_tx_ring[idx];
2934
2935         error = drbr_enqueue(ifp, txr->hn_mbuf_br, m);
2936         if (error) {
2937                 if_inc_counter(ifp, IFCOUNTER_OQDROPS, 1);
2938                 return error;
2939         }
2940
2941         if (txr->hn_oactive)
2942                 return 0;
2943
2944         if (txr->hn_sched_tx)
2945                 goto do_sched;
2946
2947         if (mtx_trylock(&txr->hn_tx_lock)) {
2948                 int sched;
2949
2950                 sched = hn_xmit(txr, txr->hn_direct_tx_size);
2951                 mtx_unlock(&txr->hn_tx_lock);
2952                 if (!sched)
2953                         return 0;
2954         }
2955 do_sched:
2956         taskqueue_enqueue(txr->hn_tx_taskq, &txr->hn_tx_task);
2957         return 0;
2958 }
2959
2960 static void
2961 hn_xmit_qflush(struct ifnet *ifp)
2962 {
2963         struct hn_softc *sc = ifp->if_softc;
2964         int i;
2965
2966         for (i = 0; i < sc->hn_tx_ring_inuse; ++i) {
2967                 struct hn_tx_ring *txr = &sc->hn_tx_ring[i];
2968                 struct mbuf *m;
2969
2970                 mtx_lock(&txr->hn_tx_lock);
2971                 while ((m = buf_ring_dequeue_sc(txr->hn_mbuf_br)) != NULL)
2972                         m_freem(m);
2973                 mtx_unlock(&txr->hn_tx_lock);
2974         }
2975         if_qflush(ifp);
2976 }
2977
2978 static void
2979 hn_xmit_txeof(struct hn_tx_ring *txr)
2980 {
2981
2982         if (txr->hn_sched_tx)
2983                 goto do_sched;
2984
2985         if (mtx_trylock(&txr->hn_tx_lock)) {
2986                 int sched;
2987
2988                 txr->hn_oactive = 0;
2989                 sched = hn_xmit(txr, txr->hn_direct_tx_size);
2990                 mtx_unlock(&txr->hn_tx_lock);
2991                 if (sched) {
2992                         taskqueue_enqueue(txr->hn_tx_taskq,
2993                             &txr->hn_tx_task);
2994                 }
2995         } else {
2996 do_sched:
2997                 /*
2998                  * Release the oactive earlier, with the hope, that
2999                  * others could catch up.  The task will clear the
3000                  * oactive again with the hn_tx_lock to avoid possible
3001                  * races.
3002                  */
3003                 txr->hn_oactive = 0;
3004                 taskqueue_enqueue(txr->hn_tx_taskq, &txr->hn_txeof_task);
3005         }
3006 }
3007
3008 static void
3009 hn_xmit_taskfunc(void *xtxr, int pending __unused)
3010 {
3011         struct hn_tx_ring *txr = xtxr;
3012
3013         mtx_lock(&txr->hn_tx_lock);
3014         hn_xmit(txr, 0);
3015         mtx_unlock(&txr->hn_tx_lock);
3016 }
3017
3018 static void
3019 hn_xmit_txeof_taskfunc(void *xtxr, int pending __unused)
3020 {
3021         struct hn_tx_ring *txr = xtxr;
3022
3023         mtx_lock(&txr->hn_tx_lock);
3024         txr->hn_oactive = 0;
3025         hn_xmit(txr, 0);
3026         mtx_unlock(&txr->hn_tx_lock);
3027 }
3028
3029 static void
3030 hn_channel_attach(struct hn_softc *sc, struct vmbus_channel *chan)
3031 {
3032         struct hn_rx_ring *rxr;
3033         int idx;
3034
3035         idx = vmbus_chan_subidx(chan);
3036
3037         KASSERT(idx >= 0 && idx < sc->hn_rx_ring_inuse,
3038             ("invalid channel index %d, should > 0 && < %d",
3039              idx, sc->hn_rx_ring_inuse));
3040         rxr = &sc->hn_rx_ring[idx];
3041         KASSERT((rxr->hn_rx_flags & HN_RX_FLAG_ATTACHED) == 0,
3042             ("RX ring %d already attached", idx));
3043         rxr->hn_rx_flags |= HN_RX_FLAG_ATTACHED;
3044
3045         if (bootverbose) {
3046                 if_printf(sc->hn_ifp, "link RX ring %d to channel%u\n",
3047                     idx, vmbus_chan_id(chan));
3048         }
3049
3050         if (idx < sc->hn_tx_ring_inuse) {
3051                 struct hn_tx_ring *txr = &sc->hn_tx_ring[idx];
3052
3053                 KASSERT((txr->hn_tx_flags & HN_TX_FLAG_ATTACHED) == 0,
3054                     ("TX ring %d already attached", idx));
3055                 txr->hn_tx_flags |= HN_TX_FLAG_ATTACHED;
3056
3057                 txr->hn_chan = chan;
3058                 if (bootverbose) {
3059                         if_printf(sc->hn_ifp, "link TX ring %d to channel%u\n",
3060                             idx, vmbus_chan_id(chan));
3061                 }
3062         }
3063
3064         /* Bind channel to a proper CPU */
3065         vmbus_chan_cpu_set(chan, (sc->hn_cpu + idx) % mp_ncpus);
3066 }
3067
3068 static void
3069 hn_subchan_attach(struct hn_softc *sc, struct vmbus_channel *chan)
3070 {
3071
3072         KASSERT(!vmbus_chan_is_primary(chan),
3073             ("subchannel callback on primary channel"));
3074         hn_channel_attach(sc, chan);
3075 }
3076
3077 static void
3078 hn_subchan_setup(struct hn_softc *sc)
3079 {
3080         struct vmbus_channel **subchans;
3081         int subchan_cnt = sc->hn_rx_ring_inuse - 1;
3082         int i;
3083
3084         /* Wait for sub-channels setup to complete. */
3085         subchans = vmbus_subchan_get(sc->hn_prichan, subchan_cnt);
3086
3087         /* Attach the sub-channels. */
3088         for (i = 0; i < subchan_cnt; ++i) {
3089                 struct vmbus_channel *subchan = subchans[i];
3090
3091                 /* NOTE: Calling order is critical. */
3092                 hn_subchan_attach(sc, subchan);
3093                 hv_nv_subchan_attach(subchan,
3094                     &sc->hn_rx_ring[vmbus_chan_subidx(subchan)]);
3095         }
3096
3097         /* Release the sub-channels */
3098         vmbus_subchan_rel(subchans, subchan_cnt);
3099         if_printf(sc->hn_ifp, "%d sub-channels setup done\n", subchan_cnt);
3100 }
3101
3102 static void
3103 hn_tx_taskq_create(void *arg __unused)
3104 {
3105         if (!hn_share_tx_taskq)
3106                 return;
3107
3108         hn_tx_taskq = taskqueue_create("hn_tx", M_WAITOK,
3109             taskqueue_thread_enqueue, &hn_tx_taskq);
3110         taskqueue_start_threads(&hn_tx_taskq, 1, PI_NET, "hn tx");
3111         if (hn_bind_tx_taskq >= 0) {
3112                 int cpu = hn_bind_tx_taskq;
3113                 struct task cpuset_task;
3114                 cpuset_t cpu_set;
3115
3116                 if (cpu > mp_ncpus - 1)
3117                         cpu = mp_ncpus - 1;
3118                 CPU_SETOF(cpu, &cpu_set);
3119                 TASK_INIT(&cpuset_task, 0, hn_cpuset_setthread_task, &cpu_set);
3120                 taskqueue_enqueue(hn_tx_taskq, &cpuset_task);
3121                 taskqueue_drain(hn_tx_taskq, &cpuset_task);
3122         }
3123 }
3124 SYSINIT(hn_txtq_create, SI_SUB_DRIVERS, SI_ORDER_FIRST,
3125     hn_tx_taskq_create, NULL);
3126
3127 static void
3128 hn_tx_taskq_destroy(void *arg __unused)
3129 {
3130         if (hn_tx_taskq != NULL)
3131                 taskqueue_free(hn_tx_taskq);
3132 }
3133 SYSUNINIT(hn_txtq_destroy, SI_SUB_DRIVERS, SI_ORDER_FIRST,
3134     hn_tx_taskq_destroy, NULL);
3135
3136 static device_method_t netvsc_methods[] = {
3137         /* Device interface */
3138         DEVMETHOD(device_probe,         netvsc_probe),
3139         DEVMETHOD(device_attach,        netvsc_attach),
3140         DEVMETHOD(device_detach,        netvsc_detach),
3141         DEVMETHOD(device_shutdown,      netvsc_shutdown),
3142
3143         { 0, 0 }
3144 };
3145
3146 static driver_t netvsc_driver = {
3147         NETVSC_DEVNAME,
3148         netvsc_methods,
3149         sizeof(hn_softc_t)
3150 };
3151
3152 static devclass_t netvsc_devclass;
3153
3154 DRIVER_MODULE(hn, vmbus, netvsc_driver, netvsc_devclass, 0, 0);
3155 MODULE_VERSION(hn, 1);
3156 MODULE_DEPEND(hn, vmbus, 1, 1, 1);