xref: /titanic_50/usr/src/uts/sun4v/io/vnet.c (revision 210938ebfcf386cf4819f16c23979173b0d78097)
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License (the "License").
6  * You may not use this file except in compliance with the License.
7  *
8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9  * or http://www.opensolaris.org/os/licensing.
10  * See the License for the specific language governing permissions
11  * and limitations under the License.
12  *
13  * When distributing Covered Code, include this CDDL HEADER in each
14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15  * If applicable, add the following below this CDDL HEADER, with the
16  * fields enclosed by brackets "[]" replaced with your own identifying
17  * information: Portions Copyright [yyyy] [name of copyright owner]
18  *
19  * CDDL HEADER END
20  */
21 
22 /*
23  * Copyright 2006 Sun Microsystems, Inc.  All rights reserved.
24  * Use is subject to license terms.
25  */
26 
27 #pragma ident	"%Z%%M%	%I%	%E% SMI"
28 
29 #include <sys/types.h>
30 #include <sys/errno.h>
31 #include <sys/param.h>
32 #include <sys/stream.h>
33 #include <sys/kmem.h>
34 #include <sys/conf.h>
35 #include <sys/devops.h>
36 #include <sys/ksynch.h>
37 #include <sys/stat.h>
38 #include <sys/modctl.h>
39 #include <sys/debug.h>
40 #include <sys/ethernet.h>
41 #include <sys/dlpi.h>
42 #include <net/if.h>
43 #include <sys/mac.h>
44 #include <sys/mac_ether.h>
45 #include <sys/ddi.h>
46 #include <sys/sunddi.h>
47 #include <sys/strsun.h>
48 #include <sys/note.h>
49 #include <sys/vnet.h>
50 
51 /*
52  * Function prototypes.
53  */
54 
55 /* DDI entrypoints */
56 static int vnetdevinfo(dev_info_t *, ddi_info_cmd_t, void *, void **);
57 static int vnetattach(dev_info_t *, ddi_attach_cmd_t);
58 static int vnetdetach(dev_info_t *, ddi_detach_cmd_t);
59 
60 /* MAC entrypoints  */
61 static int vnet_m_stat(void *, uint_t, uint64_t *);
62 static int vnet_m_start(void *);
63 static void vnet_m_stop(void *);
64 static int vnet_m_promisc(void *, boolean_t);
65 static int vnet_m_multicst(void *, boolean_t, const uint8_t *);
66 static int vnet_m_unicst(void *, const uint8_t *);
67 mblk_t *vnet_m_tx(void *, mblk_t *);
68 
69 /* vnet internal functions */
70 static int vnet_mac_register(vnet_t *);
71 static int vnet_read_mac_address(vnet_t *vnetp);
72 static void vnet_add_vptl(vnet_t *vnetp, vp_tl_t *vp_tlp);
73 static void vnet_del_vptl(vnet_t *vnetp, vp_tl_t *vp_tlp);
74 static vp_tl_t *vnet_get_vptl(vnet_t *vnetp, const char *devname);
75 static fdb_t *vnet_lookup_fdb(fdb_fanout_t *fdbhp, uint8_t *macaddr);
76 
77 /* exported functions */
78 void vnet_add_fdb(void *arg, uint8_t *macaddr, mac_tx_t m_tx, void *txarg);
79 void vnet_del_fdb(void *arg, uint8_t *macaddr);
80 void vnet_modify_fdb(void *arg, uint8_t *macaddr, mac_tx_t m_tx, void *txarg);
81 void vnet_add_def_rte(void *arg, mac_tx_t m_tx, void *txarg);
82 void vnet_del_def_rte(void *arg);
83 void vnet_rx(void *arg, mac_resource_handle_t mrh, mblk_t *mp);
84 void vnet_tx_update(void *arg);
85 
86 /* externs */
87 extern int vgen_init(void *vnetp, dev_info_t *vnetdip, const uint8_t *macaddr,
88 	mac_register_t **vgenmacp);
89 extern int vgen_uninit(void *arg);
90 
91 static mac_callbacks_t vnet_m_callbacks = {
92 	0,
93 	vnet_m_stat,
94 	vnet_m_start,
95 	vnet_m_stop,
96 	vnet_m_promisc,
97 	vnet_m_multicst,
98 	vnet_m_unicst,
99 	vnet_m_tx,
100 	NULL,
101 	NULL,
102 	NULL
103 };
104 
105 /*
106  * Linked list of "vnet_t" structures - one per instance.
107  */
108 static vnet_t	*vnet_headp = NULL;
109 static krwlock_t vnet_rw;
110 
111 /* Tunables */
112 uint32_t vnet_ntxds = VNET_NTXDS;	/* power of 2 transmit descriptors */
113 uint32_t vnet_reclaim_lowat = VNET_RECLAIM_LOWAT;  /* tx recl low watermark */
114 uint32_t vnet_reclaim_hiwat = VNET_RECLAIM_HIWAT;  /* tx recl high watermark */
115 uint32_t vnet_ldcwd_interval = VNET_LDCWD_INTERVAL; /* watchdog freq in msec */
116 uint32_t vnet_ldcwd_txtimeout = VNET_LDCWD_TXTIMEOUT;  /* tx timeout in msec */
117 uint32_t vnet_ldc_mtu = VNET_LDC_MTU;		/* ldc mtu */
118 uint32_t vnet_nfdb_hash = VNET_NFDB_HASH;	/* size of fdb hash table */
119 uint32_t vnet_nrbufs = VNET_NRBUFS;	/* number of receive buffers */
120 
121 /*
122  * Property names
123  */
124 static char macaddr_propname[] = "local-mac-address";
125 
126 /*
127  * This is the string displayed by modinfo(1m).
128  */
129 static char vnet_ident[] = "vnet driver v%I%";
130 extern struct mod_ops mod_driverops;
131 static struct cb_ops cb_vnetops = {
132 	nulldev,		/* cb_open */
133 	nulldev,		/* cb_close */
134 	nodev,			/* cb_strategy */
135 	nodev,			/* cb_print */
136 	nodev,			/* cb_dump */
137 	nodev,			/* cb_read */
138 	nodev,			/* cb_write */
139 	nodev,			/* cb_ioctl */
140 	nodev,			/* cb_devmap */
141 	nodev,			/* cb_mmap */
142 	nodev,			/* cb_segmap */
143 	nochpoll,		/* cb_chpoll */
144 	ddi_prop_op,		/* cb_prop_op */
145 	NULL,			/* cb_stream */
146 	(int)(D_MP)		/* cb_flag */
147 };
148 
149 static struct dev_ops vnetops = {
150 	DEVO_REV,		/* devo_rev */
151 	0,			/* devo_refcnt */
152 	NULL,			/* devo_getinfo */
153 	nulldev,		/* devo_identify */
154 	nulldev,		/* devo_probe */
155 	vnetattach,		/* devo_attach */
156 	vnetdetach,		/* devo_detach */
157 	nodev,			/* devo_reset */
158 	&cb_vnetops,		/* devo_cb_ops */
159 	(struct bus_ops *)NULL	/* devo_bus_ops */
160 };
161 
162 static struct modldrv modldrv = {
163 	&mod_driverops,		/* Type of module.  This one is a driver */
164 	vnet_ident,		/* ID string */
165 	&vnetops		/* driver specific ops */
166 };
167 
168 static struct modlinkage modlinkage = {
169 	MODREV_1, (void *)&modldrv, NULL
170 };
171 
172 
173 /*
174  * Print debug messages - set to 0xf to enable all msgs
175  */
176 int _vnet_dbglevel = 0x8;
177 
178 void
179 _vnetdebug_printf(void *arg, const char *fmt, ...)
180 {
181 	char    buf[512];
182 	va_list ap;
183 	vnet_t *vnetp = (vnet_t *)arg;
184 
185 	va_start(ap, fmt);
186 	(void) vsprintf(buf, fmt, ap);
187 	va_end(ap);
188 
189 	if (vnetp == NULL)
190 		cmn_err(CE_CONT, "%s\n", buf);
191 	else
192 		cmn_err(CE_CONT, "vnet%d: %s\n", vnetp->instance, buf);
193 }
194 
195 #ifdef DEBUG
196 
197 /*
198  * XXX: any changes to the definitions below need corresponding changes in
199  * vnet_gen.c
200  */
201 
202 /*
203  * debug levels:
204  * DBG_LEVEL1:	Function entry/exit tracing
205  * DBG_LEVEL2:	Info messages
206  * DBG_LEVEL3:	Warning messages
207  * DBG_LEVEL4:	Error messages
208  */
209 
210 enum	{ DBG_LEVEL1 = 0x01, DBG_LEVEL2 = 0x02, DBG_LEVEL3 = 0x04,
211 	    DBG_LEVEL4 = 0x08 };
212 
213 #define	DBG1(_s)	do {						\
214 			    if ((_vnet_dbglevel & DBG_LEVEL1) != 0) {	\
215 					_vnetdebug_printf _s;		\
216 			    }					\
217 			_NOTE(CONSTCOND) } while (0)
218 
219 #define	DBG2(_s)	do {						\
220 			    if ((_vnet_dbglevel & DBG_LEVEL2) != 0) {	\
221 					_vnetdebug_printf _s;		\
222 			    }					\
223 			_NOTE(CONSTCOND) } while (0)
224 
225 #define	DWARN(_s)	do {						\
226 			    if ((_vnet_dbglevel & DBG_LEVEL3) != 0) {	\
227 					_vnetdebug_printf _s;		\
228 			    }					\
229 			_NOTE(CONSTCOND) } while (0)
230 
231 #define	DERR(_s)	do {						\
232 			    if ((_vnet_dbglevel & DBG_LEVEL4) != 0) {	\
233 					_vnetdebug_printf _s;		\
234 			    }					\
235 			_NOTE(CONSTCOND) } while (0)
236 
237 #else
238 
239 #define	DBG1(_s)	if (0)	_vnetdebug_printf _s
240 #define	DBG2(_s)	if (0)	_vnetdebug_printf _s
241 #define	DWARN(_s)	if (0)	_vnetdebug_printf _s
242 #define	DERR(_s)	if (0)	_vnetdebug_printf _s
243 
244 #endif
245 
246 /* _init(9E): initialize the loadable module */
247 int
248 _init(void)
249 {
250 	int status;
251 
252 	DBG1((NULL, "_init: enter\n"));
253 
254 	mac_init_ops(&vnetops, "vnet");
255 	status = mod_install(&modlinkage);
256 	if (status != 0) {
257 		mac_fini_ops(&vnetops);
258 	}
259 
260 	DBG1((NULL, "_init: exit\n"));
261 	return (status);
262 }
263 
264 /* _fini(9E): prepare the module for unloading. */
265 int
266 _fini(void)
267 {
268 	int status;
269 
270 	DBG1((NULL, "_fini: enter\n"));
271 
272 	status = mod_remove(&modlinkage);
273 	if (status != 0)
274 		return (status);
275 	mac_fini_ops(&vnetops);
276 
277 	DBG1((NULL, "_fini: exit\n"));
278 	return (status);
279 }
280 
281 /* _info(9E): return information about the loadable module */
282 int
283 _info(struct modinfo *modinfop)
284 {
285 	return (mod_info(&modlinkage, modinfop));
286 }
287 
288 /*
289  * attach(9E): attach a device to the system.
290  * called once for each instance of the device on the system.
291  */
292 static int
293 vnetattach(dev_info_t *dip, ddi_attach_cmd_t cmd)
294 {
295 	vnet_t		*vnetp;
296 	vp_tl_t		*vp_tlp;
297 	int		instance;
298 	int		status;
299 	enum		{ AST_init = 0x0, AST_vnet_alloc = 0x1,
300 			    AST_mac_alloc = 0x2, AST_read_macaddr = 0x4,
301 			    AST_vgen_init = 0x8, AST_vptl_alloc = 0x10,
302 			    AST_fdbh_alloc = 0x20 }
303 			attach_state;
304 	mac_register_t	*vgenmacp = NULL;
305 	uint32_t	nfdbh = 0;
306 
307 	attach_state = AST_init;
308 
309 	switch (cmd) {
310 	case DDI_ATTACH:
311 		break;
312 	case DDI_RESUME:
313 	case DDI_PM_RESUME:
314 	default:
315 		goto vnet_attach_fail;
316 	}
317 
318 	instance = ddi_get_instance(dip);
319 	DBG1((NULL, "vnetattach: instance(%d) enter\n", instance));
320 
321 	/* allocate vnet_t and mac_t structures */
322 	vnetp = kmem_zalloc(sizeof (vnet_t), KM_SLEEP);
323 	attach_state |= AST_vnet_alloc;
324 
325 	/* setup links to vnet_t from both devinfo and mac_t */
326 	ddi_set_driver_private(dip, (caddr_t)vnetp);
327 	vnetp->dip = dip;
328 	vnetp->instance = instance;
329 
330 	/* read the mac address */
331 	status = vnet_read_mac_address(vnetp);
332 	if (status != DDI_SUCCESS) {
333 		goto vnet_attach_fail;
334 	}
335 	attach_state |= AST_read_macaddr;
336 
337 	/*
338 	 * Initialize the generic vnet proxy transport. This is the first
339 	 * and default transport used by vnet. The generic transport
340 	 * is provided by using sun4v LDC (logical domain channel). On success,
341 	 * vgen_init() provides a pointer to mac_t of generic transport.
342 	 * Currently, this generic layer provides network connectivity to other
343 	 * vnets within ldoms and also to remote hosts oustide ldoms through
344 	 * the virtual switch (vsw) device on domain0. In the future, when
345 	 * physical adapters that are able to share their resources (such as
346 	 * dma channels) with guest domains become available, the vnet device
347 	 * will use hardware specific driver to communicate directly over the
348 	 * physical device to reach remote hosts without going through vswitch.
349 	 */
350 	status = vgen_init(vnetp, vnetp->dip, (uint8_t *)vnetp->curr_macaddr,
351 	    &vgenmacp);
352 	if (status != DDI_SUCCESS) {
353 		DERR((vnetp, "vgen_init() failed\n"));
354 		goto vnet_attach_fail;
355 	}
356 	attach_state |= AST_vgen_init;
357 
358 	vp_tlp = kmem_zalloc(sizeof (vp_tl_t), KM_SLEEP);
359 	vp_tlp->macp = vgenmacp;
360 	(void) snprintf(vp_tlp->name, MAXNAMELEN, "%s%u", "vgen", instance);
361 	(void) strcpy(vnetp->vgen_name, vp_tlp->name);
362 
363 	/* add generic transport to the list of vnet proxy transports */
364 	vnet_add_vptl(vnetp, vp_tlp);
365 	attach_state |= AST_vptl_alloc;
366 
367 	nfdbh = vnet_nfdb_hash;
368 	if ((nfdbh < VNET_NFDB_HASH) || (nfdbh > VNET_NFDB_HASH_MAX)) {
369 		vnetp->nfdb_hash = VNET_NFDB_HASH;
370 	}
371 	else
372 		vnetp->nfdb_hash = nfdbh;
373 
374 	/* allocate fdb hash table, with an extra slot for default route */
375 	vnetp->fdbhp = kmem_zalloc(sizeof (fdb_fanout_t) *
376 	    (vnetp->nfdb_hash + 1), KM_SLEEP);
377 	attach_state |= AST_fdbh_alloc;
378 
379 	/* register with MAC layer */
380 	status = vnet_mac_register(vnetp);
381 	if (status != DDI_SUCCESS) {
382 		goto vnet_attach_fail;
383 	}
384 
385 	/* add to the list of vnet devices */
386 	WRITE_ENTER(&vnet_rw);
387 	vnetp->nextp = vnet_headp;
388 	vnet_headp = vnetp;
389 	RW_EXIT(&vnet_rw);
390 
391 	DBG1((NULL, "vnetattach: instance(%d) exit\n", instance));
392 	return (DDI_SUCCESS);
393 
394 vnet_attach_fail:
395 	if (attach_state & AST_fdbh_alloc) {
396 		kmem_free(vnetp->fdbhp,
397 		    sizeof (fdb_fanout_t) * (vnetp->nfdb_hash + 1));
398 	}
399 	if (attach_state & AST_vptl_alloc) {
400 		WRITE_ENTER(&vnetp->trwlock);
401 		vnet_del_vptl(vnetp, vp_tlp);
402 		RW_EXIT(&vnetp->trwlock);
403 	}
404 	if (attach_state & AST_vgen_init) {
405 		(void) vgen_uninit(vgenmacp->m_driver);
406 	}
407 	if (attach_state & AST_vnet_alloc) {
408 		KMEM_FREE(vnetp);
409 	}
410 	return (DDI_FAILURE);
411 }
412 
413 /*
414  * detach(9E): detach a device from the system.
415  */
416 static int
417 vnetdetach(dev_info_t *dip, ddi_detach_cmd_t cmd)
418 {
419 	vnet_t		*vnetp;
420 	vnet_t		**vnetpp;
421 	vp_tl_t		*vp_tlp;
422 	int		instance;
423 	int		rv;
424 
425 	instance = ddi_get_instance(dip);
426 	DBG1((NULL, "vnetdetach: instance(%d) enter\n", instance));
427 
428 	vnetp = ddi_get_driver_private(dip);
429 	if (vnetp == NULL) {
430 		goto vnet_detach_fail;
431 	}
432 
433 	switch (cmd) {
434 	case DDI_DETACH:
435 		break;
436 	case DDI_SUSPEND:
437 	case DDI_PM_SUSPEND:
438 	default:
439 		goto vnet_detach_fail;
440 	}
441 
442 	/* uninit and free vnet proxy transports */
443 	WRITE_ENTER(&vnetp->trwlock);
444 	while ((vp_tlp = vnetp->tlp) != NULL) {
445 		if (strcmp(vnetp->vgen_name, vp_tlp->name) == 0) {
446 			/* uninitialize generic transport */
447 			rv = vgen_uninit(vp_tlp->macp->m_driver);
448 			if (rv != DDI_SUCCESS) {
449 				RW_EXIT(&vnetp->trwlock);
450 				goto vnet_detach_fail;
451 			}
452 		}
453 		vnet_del_vptl(vnetp, vp_tlp);
454 	}
455 	RW_EXIT(&vnetp->trwlock);
456 
457 	/*
458 	 * Unregister from the MAC subsystem.  This can fail, in
459 	 * particular if there are DLPI style-2 streams still open -
460 	 * in which case we just return failure.
461 	 */
462 	if (mac_unregister(vnetp->mh) != 0)
463 		goto vnet_detach_fail;
464 
465 	/* unlink from instance(vnet_t) list */
466 	WRITE_ENTER(&vnet_rw);
467 	for (vnetpp = &vnet_headp; *vnetpp; vnetpp = &(*vnetpp)->nextp) {
468 		if (*vnetpp == vnetp) {
469 			*vnetpp = vnetp->nextp;
470 			break;
471 		}
472 	}
473 	RW_EXIT(&vnet_rw);
474 
475 	KMEM_FREE(vnetp);
476 
477 	return (DDI_SUCCESS);
478 
479 vnet_detach_fail:
480 	return (DDI_FAILURE);
481 }
482 
483 /* enable the device for transmit/receive */
484 static int
485 vnet_m_start(void *arg)
486 {
487 	vnet_t		*vnetp = arg;
488 	vp_tl_t		*vp_tlp;
489 	mac_register_t	*vp_macp;
490 	mac_callbacks_t	*cbp;
491 
492 	DBG1((vnetp, "vnet_m_start: enter\n"));
493 
494 	/*
495 	 * XXX
496 	 * Currently, we only have generic transport. m_start() invokes
497 	 * vgen_start() which enables ports/channels in vgen and
498 	 * initiates handshake with peer vnets and vsw. In the future when we
499 	 * have support for hardware specific transports, this information
500 	 * needs to be propagted back to vnet from vgen and we need to revisit
501 	 * this code (see comments in vnet_attach()).
502 	 *
503 	 */
504 	WRITE_ENTER(&vnetp->trwlock);
505 	for (vp_tlp = vnetp->tlp; vp_tlp != NULL; vp_tlp = vp_tlp->nextp) {
506 		vp_macp = vp_tlp->macp;
507 		cbp = vp_macp->m_callbacks;
508 		cbp->mc_start(vp_macp->m_driver);
509 	}
510 	RW_EXIT(&vnetp->trwlock);
511 
512 	DBG1((vnetp, "vnet_m_start: exit\n"));
513 	return (VNET_SUCCESS);
514 
515 }
516 
517 /* stop transmit/receive for the device */
518 static void
519 vnet_m_stop(void *arg)
520 {
521 	vnet_t		*vnetp = arg;
522 	vp_tl_t		*vp_tlp;
523 	mac_register_t	*vp_macp;
524 	mac_callbacks_t	*cbp;
525 
526 	DBG1((vnetp, "vnet_m_stop: enter\n"));
527 
528 	WRITE_ENTER(&vnetp->trwlock);
529 	for (vp_tlp = vnetp->tlp; vp_tlp != NULL; vp_tlp = vp_tlp->nextp) {
530 		vp_macp = vp_tlp->macp;
531 		cbp = vp_macp->m_callbacks;
532 		cbp->mc_stop(vp_macp->m_driver);
533 	}
534 	RW_EXIT(&vnetp->trwlock);
535 
536 	DBG1((vnetp, "vnet_m_stop: exit\n"));
537 }
538 
539 /* set the unicast mac address of the device */
540 static int
541 vnet_m_unicst(void *arg, const uint8_t *macaddr)
542 {
543 	_NOTE(ARGUNUSED(macaddr))
544 
545 	vnet_t *vnetp = arg;
546 
547 	DBG1((vnetp, "vnet_m_unicst: enter\n"));
548 	/*
549 	 * XXX: setting mac address dynamically is not supported.
550 	 */
551 	DBG1((vnetp, "vnet_m_unicst: exit\n"));
552 
553 	return (VNET_FAILURE);
554 }
555 
556 /* enable/disable a multicast address */
557 static int
558 vnet_m_multicst(void *arg, boolean_t add, const uint8_t *mca)
559 {
560 	_NOTE(ARGUNUSED(add, mca))
561 
562 	vnet_t *vnetp = arg;
563 	vp_tl_t		*vp_tlp;
564 	mac_register_t	*vp_macp;
565 	mac_callbacks_t	*cbp;
566 	int rv = VNET_SUCCESS;
567 
568 	DBG1((vnetp, "vnet_m_multicst: enter\n"));
569 	READ_ENTER(&vnetp->trwlock);
570 	for (vp_tlp = vnetp->tlp; vp_tlp != NULL; vp_tlp = vp_tlp->nextp) {
571 		if (strcmp(vnetp->vgen_name, vp_tlp->name) == 0) {
572 			vp_macp = vp_tlp->macp;
573 			cbp = vp_macp->m_callbacks;
574 			rv = cbp->mc_multicst(vp_macp->m_driver, add, mca);
575 			break;
576 		}
577 	}
578 	RW_EXIT(&vnetp->trwlock);
579 	DBG1((vnetp, "vnet_m_multicst: exit\n"));
580 	return (rv);
581 }
582 
583 /* set or clear promiscuous mode on the device */
584 static int
585 vnet_m_promisc(void *arg, boolean_t on)
586 {
587 	_NOTE(ARGUNUSED(on))
588 
589 	vnet_t *vnetp = arg;
590 	DBG1((vnetp, "vnet_m_promisc: enter\n"));
591 	/*
592 	 * XXX: setting promiscuous mode is not supported, just return success.
593 	 */
594 	DBG1((vnetp, "vnet_m_promisc: exit\n"));
595 	return (VNET_SUCCESS);
596 }
597 
598 /*
599  * Transmit a chain of packets. This function provides switching functionality
600  * based on the destination mac address to reach other guests (within ldoms) or
601  * external hosts.
602  */
603 mblk_t *
604 vnet_m_tx(void *arg, mblk_t *mp)
605 {
606 	vnet_t *vnetp;
607 	mblk_t *next;
608 	uint32_t fdbhash;
609 	fdb_t *fdbp;
610 	fdb_fanout_t *fdbhp;
611 	struct ether_header *ehp;
612 	uint8_t *macaddr;
613 	mblk_t *resid_mp;
614 
615 	vnetp = (vnet_t *)arg;
616 	DBG1((vnetp, "vnet_m_tx: enter\n"));
617 	ASSERT(mp != NULL);
618 
619 	while (mp != NULL) {
620 		next = mp->b_next;
621 		mp->b_next = NULL;
622 
623 		/* get the destination mac address in the eth header */
624 		ehp = (struct ether_header *)mp->b_rptr;
625 		macaddr = (uint8_t *)&ehp->ether_dhost;
626 
627 		/* Calculate hash value and fdb fanout */
628 		fdbhash = MACHASH(macaddr, vnetp->nfdb_hash);
629 		fdbhp = &(vnetp->fdbhp[fdbhash]);
630 
631 		READ_ENTER(&fdbhp->rwlock);
632 		fdbp = vnet_lookup_fdb(fdbhp, macaddr);
633 		if (fdbp) {
634 			/*
635 			 * If the destination is in FDB, the destination is
636 			 * a vnet device within ldoms and directly reachable,
637 			 * invoke the tx function in the fdb entry.
638 			 */
639 			resid_mp = fdbp->m_tx(fdbp->txarg, mp);
640 			if (resid_mp != NULL) {
641 				/* m_tx failed */
642 				mp->b_next = next;
643 				RW_EXIT(&fdbhp->rwlock);
644 				break;
645 			}
646 			RW_EXIT(&fdbhp->rwlock);
647 		} else {
648 			/* destination is not in FDB */
649 			RW_EXIT(&fdbhp->rwlock);
650 			/*
651 			 * If the destination is broadcast/multicast
652 			 * or an unknown unicast address, forward the
653 			 * packet to vsw, using the last slot in fdb which is
654 			 * reserved for default route.
655 			 */
656 			fdbhp = &(vnetp->fdbhp[vnetp->nfdb_hash]);
657 			READ_ENTER(&fdbhp->rwlock);
658 			fdbp = fdbhp->headp;
659 			if (fdbp) {
660 				resid_mp = fdbp->m_tx(fdbp->txarg, mp);
661 				if (resid_mp != NULL) {
662 					/* m_tx failed */
663 					mp->b_next = next;
664 					RW_EXIT(&fdbhp->rwlock);
665 					break;
666 				}
667 			} else {
668 				/* drop the packet */
669 				freemsg(mp);
670 			}
671 			RW_EXIT(&fdbhp->rwlock);
672 		}
673 
674 		mp = next;
675 	}
676 
677 	DBG1((vnetp, "vnet_m_tx: exit\n"));
678 	return (mp);
679 }
680 
681 /* get statistics from the device */
682 int
683 vnet_m_stat(void *arg, uint_t stat, uint64_t *val)
684 {
685 	vnet_t *vnetp = arg;
686 	vp_tl_t	*vp_tlp;
687 	mac_register_t	*vp_macp;
688 	mac_callbacks_t	*cbp;
689 	uint64_t val_total = 0;
690 
691 	DBG1((vnetp, "vnet_m_stat: enter\n"));
692 
693 	/*
694 	 * get the specified statistic from each transport and return the
695 	 * aggregate val.  This obviously only works for counters.
696 	 */
697 	if ((IS_MAC_STAT(stat) && !MAC_STAT_ISACOUNTER(stat)) ||
698 	    (IS_MACTYPE_STAT(stat) && !ETHER_STAT_ISACOUNTER(stat))) {
699 		return (ENOTSUP);
700 	}
701 	READ_ENTER(&vnetp->trwlock);
702 	for (vp_tlp = vnetp->tlp; vp_tlp != NULL; vp_tlp = vp_tlp->nextp) {
703 		vp_macp = vp_tlp->macp;
704 		cbp = vp_macp->m_callbacks;
705 		if (cbp->mc_getstat(vp_macp->m_driver, stat, val) == 0)
706 			val_total += *val;
707 	}
708 	RW_EXIT(&vnetp->trwlock);
709 
710 	*val = val_total;
711 
712 	DBG1((vnetp, "vnet_m_stat: exit\n"));
713 	return (0);
714 }
715 
716 /* wrapper function for mac_register() */
717 static int
718 vnet_mac_register(vnet_t *vnetp)
719 {
720 	mac_register_t	*macp;
721 	int		err;
722 
723 	if ((macp = mac_alloc(MAC_VERSION)) == NULL)
724 		return (DDI_FAILURE);
725 	macp->m_type_ident = MAC_PLUGIN_IDENT_ETHER;
726 	macp->m_driver = vnetp;
727 	macp->m_dip = vnetp->dip;
728 	macp->m_src_addr = vnetp->curr_macaddr;
729 	macp->m_callbacks = &vnet_m_callbacks;
730 	macp->m_min_sdu = 0;
731 	macp->m_max_sdu = ETHERMTU;
732 
733 	/*
734 	 * Finally, we're ready to register ourselves with the MAC layer
735 	 * interface; if this succeeds, we're all ready to start()
736 	 */
737 	err = mac_register(macp, &vnetp->mh);
738 	mac_free(macp);
739 	return (err == 0 ? DDI_SUCCESS : DDI_FAILURE);
740 }
741 
742 /* add vp_tl to the list */
743 static void
744 vnet_add_vptl(vnet_t *vnetp, vp_tl_t *vp_tlp)
745 {
746 	vp_tl_t *ttlp;
747 
748 	WRITE_ENTER(&vnetp->trwlock);
749 	if (vnetp->tlp == NULL) {
750 		vnetp->tlp = vp_tlp;
751 	} else {
752 		ttlp = vnetp->tlp;
753 		while (ttlp->nextp)
754 			ttlp = ttlp->nextp;
755 		ttlp->nextp = vp_tlp;
756 	}
757 	RW_EXIT(&vnetp->trwlock);
758 }
759 
760 /* remove vp_tl from the list */
761 static void
762 vnet_del_vptl(vnet_t *vnetp, vp_tl_t *vp_tlp)
763 {
764 	vp_tl_t *ttlp, **pretlp;
765 	boolean_t found = B_FALSE;
766 
767 	pretlp = &vnetp->tlp;
768 	ttlp = *pretlp;
769 	while (ttlp) {
770 		if (ttlp == vp_tlp) {
771 			found = B_TRUE;
772 			(*pretlp) = ttlp->nextp;
773 			ttlp->nextp = NULL;
774 			break;
775 		}
776 		pretlp = &(ttlp->nextp);
777 		ttlp = *pretlp;
778 	}
779 
780 	if (found) {
781 		KMEM_FREE(vp_tlp);
782 	}
783 }
784 
785 /* get vp_tl corresponding to the given name */
786 static vp_tl_t *
787 vnet_get_vptl(vnet_t *vnetp, const char *name)
788 {
789 	vp_tl_t *tlp;
790 
791 	tlp = vnetp->tlp;
792 	while (tlp) {
793 		if (strcmp(tlp->name, name) == 0) {
794 			return (tlp);
795 		}
796 		tlp = tlp->nextp;
797 	}
798 	DWARN((vnetp,
799 	    "vnet_get_vptl: can't find vp_tl with name (%s)\n", name));
800 	return (NULL);
801 }
802 
803 /* read the mac address of the device */
804 static int
805 vnet_read_mac_address(vnet_t *vnetp)
806 {
807 	uchar_t 	*macaddr;
808 	uint32_t 	size;
809 	int 		rv;
810 
811 	rv = ddi_prop_lookup_byte_array(DDI_DEV_T_ANY, vnetp->dip,
812 		DDI_PROP_DONTPASS, macaddr_propname, &macaddr, &size);
813 	if ((rv != DDI_PROP_SUCCESS) || (size != ETHERADDRL)) {
814 		DWARN((vnetp,
815 		"vnet_read_mac_address: prop_lookup failed (%s) err (%d)\n",
816 		macaddr_propname, rv));
817 		return (DDI_FAILURE);
818 	}
819 	bcopy(macaddr, (caddr_t)vnetp->vendor_addr, ETHERADDRL);
820 	bcopy(macaddr, (caddr_t)vnetp->curr_macaddr, ETHERADDRL);
821 	ddi_prop_free(macaddr);
822 
823 	return (DDI_SUCCESS);
824 }
825 
826 
827 /*
828  * Functions below are called only by generic transport to add/remove/modify
829  * entries in forwarding database. See comments in vgen_port_init(vnet_gen.c).
830  */
831 
832 /* add an entry into the forwarding database */
833 void
834 vnet_add_fdb(void *arg, uint8_t *macaddr, mac_tx_t m_tx, void *txarg)
835 {
836 	vnet_t *vnetp = (vnet_t *)arg;
837 	uint32_t fdbhash;
838 	fdb_t *fdbp;
839 	fdb_fanout_t *fdbhp;
840 
841 	/* Calculate hash value and fdb fanout */
842 	fdbhash = MACHASH(macaddr, vnetp->nfdb_hash);
843 	fdbhp = &(vnetp->fdbhp[fdbhash]);
844 
845 	WRITE_ENTER(&fdbhp->rwlock);
846 
847 	fdbp = kmem_zalloc(sizeof (fdb_t), KM_NOSLEEP);
848 	if (fdbp == NULL) {
849 		RW_EXIT(&fdbhp->rwlock);
850 		return;
851 	}
852 	bcopy(macaddr, (caddr_t)fdbp->macaddr, ETHERADDRL);
853 	fdbp->m_tx = m_tx;
854 	fdbp->txarg = txarg;
855 	fdbp->nextp = fdbhp->headp;
856 	fdbhp->headp = fdbp;
857 
858 	RW_EXIT(&fdbhp->rwlock);
859 }
860 
861 /* delete an entry from the forwarding database */
862 void
863 vnet_del_fdb(void *arg, uint8_t *macaddr)
864 {
865 	vnet_t *vnetp = (vnet_t *)arg;
866 	uint32_t fdbhash;
867 	fdb_t *fdbp;
868 	fdb_t **pfdbp;
869 	fdb_fanout_t *fdbhp;
870 
871 	/* Calculate hash value and fdb fanout */
872 	fdbhash = MACHASH(macaddr, vnetp->nfdb_hash);
873 	fdbhp = &(vnetp->fdbhp[fdbhash]);
874 
875 	WRITE_ENTER(&fdbhp->rwlock);
876 
877 	for (pfdbp = &fdbhp->headp; (fdbp  = *pfdbp) != NULL;
878 	    pfdbp = &fdbp->nextp) {
879 		if (bcmp(fdbp->macaddr, macaddr, ETHERADDRL) == 0) {
880 			/* Unlink it from the list */
881 			*pfdbp = fdbp->nextp;
882 			KMEM_FREE(fdbp);
883 			break;
884 		}
885 	}
886 
887 	RW_EXIT(&fdbhp->rwlock);
888 }
889 
890 /* modify an existing entry in the forwarding database */
891 void
892 vnet_modify_fdb(void *arg, uint8_t *macaddr, mac_tx_t m_tx, void *txarg)
893 {
894 	vnet_t *vnetp = (vnet_t *)arg;
895 	uint32_t fdbhash;
896 	fdb_t *fdbp;
897 	fdb_fanout_t *fdbhp;
898 
899 	/* Calculate hash value and fdb fanout */
900 	fdbhash = MACHASH(macaddr, vnetp->nfdb_hash);
901 	fdbhp = &(vnetp->fdbhp[fdbhash]);
902 
903 	WRITE_ENTER(&fdbhp->rwlock);
904 
905 	for (fdbp = fdbhp->headp; fdbp != NULL; fdbp = fdbp->nextp) {
906 		if (bcmp(fdbp->macaddr, macaddr, ETHERADDRL) == 0) {
907 			/* change the entry to have new tx params */
908 			fdbp->m_tx = m_tx;
909 			fdbp->txarg = txarg;
910 			break;
911 		}
912 	}
913 
914 	RW_EXIT(&fdbhp->rwlock);
915 }
916 
917 /* look up an fdb entry based on the mac address, caller holds lock */
918 static fdb_t *
919 vnet_lookup_fdb(fdb_fanout_t *fdbhp, uint8_t *macaddr)
920 {
921 	fdb_t *fdbp = NULL;
922 
923 	for (fdbp = fdbhp->headp; fdbp != NULL; fdbp = fdbp->nextp) {
924 		if (bcmp(fdbp->macaddr, macaddr, ETHERADDRL) == 0) {
925 			break;
926 		}
927 	}
928 
929 	return (fdbp);
930 }
931 
932 /* add default route entry into the forwarding database */
933 void
934 vnet_add_def_rte(void *arg, mac_tx_t m_tx, void *txarg)
935 {
936 	vnet_t *vnetp = (vnet_t *)arg;
937 	fdb_t *fdbp;
938 	fdb_fanout_t *fdbhp;
939 
940 	/*
941 	 * The last hash list is reserved for default route entry,
942 	 * and for now, we have only one entry in this list.
943 	 */
944 	fdbhp = &(vnetp->fdbhp[vnetp->nfdb_hash]);
945 
946 	WRITE_ENTER(&fdbhp->rwlock);
947 
948 	if (fdbhp->headp) {
949 		DWARN((vnetp,
950 		    "vnet_add_def_rte: default rte already exists\n"));
951 		RW_EXIT(&fdbhp->rwlock);
952 		return;
953 	}
954 	fdbp = kmem_zalloc(sizeof (fdb_t), KM_NOSLEEP);
955 	if (fdbp == NULL) {
956 		RW_EXIT(&fdbhp->rwlock);
957 		return;
958 	}
959 	bzero(fdbp->macaddr, ETHERADDRL);
960 	fdbp->m_tx = m_tx;
961 	fdbp->txarg = txarg;
962 	fdbp->nextp = NULL;
963 	fdbhp->headp = fdbp;
964 
965 	RW_EXIT(&fdbhp->rwlock);
966 }
967 
968 /* delete default route entry from the forwarding database */
969 void
970 vnet_del_def_rte(void *arg)
971 {
972 	vnet_t *vnetp = (vnet_t *)arg;
973 	fdb_t *fdbp;
974 	fdb_fanout_t *fdbhp;
975 
976 	/*
977 	 * The last hash list is reserved for default route entry,
978 	 * and for now, we have only one entry in this list.
979 	 */
980 	fdbhp = &(vnetp->fdbhp[vnetp->nfdb_hash]);
981 
982 	WRITE_ENTER(&fdbhp->rwlock);
983 
984 	if (fdbhp->headp == NULL) {
985 		RW_EXIT(&fdbhp->rwlock);
986 		return;
987 	}
988 	fdbp = fdbhp->headp;
989 	KMEM_FREE(fdbp);
990 	fdbhp->headp = NULL;
991 
992 	RW_EXIT(&fdbhp->rwlock);
993 }
994 
995 void
996 vnet_rx(void *arg, mac_resource_handle_t mrh, mblk_t *mp)
997 {
998 	vnet_t *vnetp = arg;
999 	mac_rx(vnetp->mh, mrh, mp);
1000 }
1001 
1002 void
1003 vnet_tx_update(void *arg)
1004 {
1005 	vnet_t *vnetp = arg;
1006 	mac_tx_update(vnetp->mh);
1007 }
1008