xref: /titanic_50/usr/src/uts/sun4v/io/vsw.c (revision cd997836b08639dc4d44a032cadd0c7d526f960c)
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 2009 Sun Microsystems, Inc.  All rights reserved.
24  * Use is subject to license terms.
25  */
26 
27 #include <sys/types.h>
28 #include <sys/errno.h>
29 #include <sys/debug.h>
30 #include <sys/time.h>
31 #include <sys/sysmacros.h>
32 #include <sys/systm.h>
33 #include <sys/user.h>
34 #include <sys/stropts.h>
35 #include <sys/stream.h>
36 #include <sys/strlog.h>
37 #include <sys/strsubr.h>
38 #include <sys/cmn_err.h>
39 #include <sys/cpu.h>
40 #include <sys/kmem.h>
41 #include <sys/conf.h>
42 #include <sys/ddi.h>
43 #include <sys/sunddi.h>
44 #include <sys/ksynch.h>
45 #include <sys/stat.h>
46 #include <sys/kstat.h>
47 #include <sys/vtrace.h>
48 #include <sys/strsun.h>
49 #include <sys/dlpi.h>
50 #include <sys/ethernet.h>
51 #include <net/if.h>
52 #include <sys/varargs.h>
53 #include <sys/machsystm.h>
54 #include <sys/modctl.h>
55 #include <sys/modhash.h>
56 #include <sys/mac_provider.h>
57 #include <sys/mac_ether.h>
58 #include <sys/taskq.h>
59 #include <sys/note.h>
60 #include <sys/mach_descrip.h>
61 #include <sys/mac_provider.h>
62 #include <sys/mdeg.h>
63 #include <sys/ldc.h>
64 #include <sys/vsw_fdb.h>
65 #include <sys/vsw.h>
66 #include <sys/vio_mailbox.h>
67 #include <sys/vnet_mailbox.h>
68 #include <sys/vnet_common.h>
69 #include <sys/vio_util.h>
70 #include <sys/sdt.h>
71 #include <sys/atomic.h>
72 #include <sys/callb.h>
73 #include <sys/vlan.h>
74 
75 /*
76  * Function prototypes.
77  */
78 static	int vsw_attach(dev_info_t *, ddi_attach_cmd_t);
79 static	int vsw_detach(dev_info_t *, ddi_detach_cmd_t);
80 static	int vsw_unattach(vsw_t *vswp);
81 static	int vsw_get_md_physname(vsw_t *, md_t *, mde_cookie_t, char *);
82 static	int vsw_get_md_smodes(vsw_t *, md_t *, mde_cookie_t, uint8_t *);
83 static	int vsw_mod_cleanup(void);
84 
85 /* MDEG routines */
86 static	int vsw_mdeg_register(vsw_t *vswp);
87 static	void vsw_mdeg_unregister(vsw_t *vswp);
88 static	int vsw_mdeg_cb(void *cb_argp, mdeg_result_t *);
89 static	int vsw_port_mdeg_cb(void *cb_argp, mdeg_result_t *);
90 static	int vsw_get_initial_md_properties(vsw_t *vswp, md_t *, mde_cookie_t);
91 static	int vsw_read_mdprops(vsw_t *vswp);
92 static	void vsw_vlan_read_ids(void *arg, int type, md_t *mdp,
93 	mde_cookie_t node, uint16_t *pvidp, vsw_vlanid_t **vidspp,
94 	uint16_t *nvidsp, uint16_t *default_idp);
95 static	int vsw_port_read_props(vsw_port_t *portp, vsw_t *vswp,
96 	md_t *mdp, mde_cookie_t *node);
97 static	void vsw_read_pri_eth_types(vsw_t *vswp, md_t *mdp,
98 	mde_cookie_t node);
99 static	void vsw_mtu_read(vsw_t *vswp, md_t *mdp, mde_cookie_t node,
100 	uint32_t *mtu);
101 static	int vsw_mtu_update(vsw_t *vswp, uint32_t mtu);
102 static	void vsw_linkprop_read(vsw_t *vswp, md_t *mdp, mde_cookie_t node,
103 	boolean_t *pls);
104 static	void vsw_update_md_prop(vsw_t *, md_t *, mde_cookie_t);
105 static void vsw_save_lmacaddr(vsw_t *vswp, uint64_t macaddr);
106 static boolean_t vsw_cmp_vids(vsw_vlanid_t *vids1,
107 	vsw_vlanid_t *vids2, int nvids);
108 
109 /* Mac driver related routines */
110 static int vsw_mac_register(vsw_t *);
111 static int vsw_mac_unregister(vsw_t *);
112 static int vsw_m_stat(void *, uint_t, uint64_t *);
113 static void vsw_m_stop(void *arg);
114 static int vsw_m_start(void *arg);
115 static int vsw_m_unicst(void *arg, const uint8_t *);
116 static int vsw_m_multicst(void *arg, boolean_t, const uint8_t *);
117 static int vsw_m_promisc(void *arg, boolean_t);
118 static mblk_t *vsw_m_tx(void *arg, mblk_t *);
119 void vsw_mac_link_update(vsw_t *vswp, link_state_t link_state);
120 void vsw_mac_rx(vsw_t *vswp, mac_resource_handle_t mrh,
121     mblk_t *mp, vsw_macrx_flags_t flags);
122 void vsw_physlink_state_update(vsw_t *vswp);
123 
124 /*
125  * Functions imported from other files.
126  */
127 extern void vsw_setup_switching_thread(void *arg);
128 extern int vsw_setup_switching_start(vsw_t *vswp);
129 extern void vsw_setup_switching_stop(vsw_t *vswp);
130 extern int vsw_setup_switching(vsw_t *);
131 extern void vsw_switch_frame_nop(vsw_t *vswp, mblk_t *mp, int caller,
132     vsw_port_t *port, mac_resource_handle_t mrh);
133 extern int vsw_add_mcst(vsw_t *, uint8_t, uint64_t, void *);
134 extern int vsw_del_mcst(vsw_t *, uint8_t, uint64_t, void *);
135 extern void vsw_del_mcst_vsw(vsw_t *);
136 extern mcst_addr_t *vsw_del_addr(uint8_t devtype, void *arg, uint64_t addr);
137 extern void vsw_detach_ports(vsw_t *vswp);
138 extern int vsw_port_add(vsw_t *vswp, md_t *mdp, mde_cookie_t *node);
139 extern int vsw_port_detach(vsw_t *vswp, int p_instance);
140 static int vsw_port_update(vsw_t *vswp, md_t *curr_mdp, mde_cookie_t curr_mdex,
141 	md_t *prev_mdp, mde_cookie_t prev_mdex);
142 extern	int vsw_port_attach(vsw_port_t *port);
143 extern vsw_port_t *vsw_lookup_port(vsw_t *vswp, int p_instance);
144 extern int vsw_mac_open(vsw_t *vswp);
145 extern void vsw_mac_close(vsw_t *vswp);
146 extern void vsw_mac_cleanup_ports(vsw_t *vswp);
147 extern void vsw_unset_addrs(vsw_t *vswp);
148 extern void vsw_setup_switching_post_process(vsw_t *vswp);
149 extern void vsw_create_vlans(void *arg, int type);
150 extern void vsw_destroy_vlans(void *arg, int type);
151 extern void vsw_vlan_add_ids(void *arg, int type);
152 extern void vsw_vlan_remove_ids(void *arg, int type);
153 extern void vsw_vlan_unaware_port_reset(vsw_port_t *portp);
154 extern uint32_t vsw_vlan_frame_untag(void *arg, int type, mblk_t **np,
155 	mblk_t **npt);
156 extern mblk_t *vsw_vlan_frame_pretag(void *arg, int type, mblk_t *mp);
157 extern void vsw_hio_cleanup(vsw_t *vswp);
158 extern void vsw_hio_start_ports(vsw_t *vswp);
159 extern void vsw_hio_port_update(vsw_port_t *portp, boolean_t hio_enabled);
160 extern int vsw_mac_multicast_add(vsw_t *, vsw_port_t *, mcst_addr_t *, int);
161 extern void vsw_mac_multicast_remove(vsw_t *, vsw_port_t *, mcst_addr_t *, int);
162 extern void vsw_mac_port_reconfig_vlans(vsw_port_t *portp, uint16_t new_pvid,
163     vsw_vlanid_t *new_vids, int new_nvids);
164 extern int vsw_mac_client_init(vsw_t *vswp, vsw_port_t *port, int type);
165 extern void vsw_mac_client_cleanup(vsw_t *vswp, vsw_port_t *port, int type);
166 extern void vsw_if_mac_reconfig(vsw_t *vswp, boolean_t update_vlans,
167     uint16_t new_pvid, vsw_vlanid_t *new_vids, int new_nvids);
168 extern void vsw_reset_ports(vsw_t *vswp);
169 extern void vsw_port_reset(vsw_port_t *portp);
170 extern void vsw_physlink_update_ports(vsw_t *vswp);
171 void vsw_hio_port_update(vsw_port_t *portp, boolean_t hio_enabled);
172 
173 /*
174  * Internal tunables.
175  */
176 int	vsw_num_handshakes = VNET_NUM_HANDSHAKES; /* # of handshake attempts */
177 int	vsw_wretries = 100;		/* # of write attempts */
178 int	vsw_desc_delay = 0;		/* delay in us */
179 int	vsw_read_attempts = 5;		/* # of reads of descriptor */
180 int	vsw_setup_switching_delay = 3;	/* setup sw timeout interval in sec */
181 int	vsw_mac_open_retries = 300;	/* max # of mac_open() retries */
182 					/* 300*3 = 900sec(15min) of max tmout */
183 int	vsw_ldc_tx_delay = 5;		/* delay(ticks) for tx retries */
184 int	vsw_ldc_tx_retries = 10;	/* # of ldc tx retries */
185 int	vsw_ldc_retries = 5;		/* # of ldc_close() retries */
186 int	vsw_ldc_delay = 1000;		/* 1 ms delay for ldc_close() */
187 boolean_t vsw_ldc_rxthr_enabled = B_TRUE;	/* LDC Rx thread enabled */
188 boolean_t vsw_ldc_txthr_enabled = B_TRUE;	/* LDC Tx thread enabled */
189 
190 uint32_t	vsw_fdb_nchains = 8;	/* # of chains in fdb hash table */
191 uint32_t	vsw_vlan_nchains = 4;	/* # of chains in vlan id hash table */
192 uint32_t	vsw_ethermtu = 1500;	/* mtu of the device */
193 
194 /* delay in usec to wait for all references on a fdb entry to be dropped */
195 uint32_t vsw_fdbe_refcnt_delay = 10;
196 
197 /*
198  * Default vlan id. This is only used internally when the "default-vlan-id"
199  * property is not present in the MD device node. Therefore, this should not be
200  * used as a tunable; if this value is changed, the corresponding variable
201  * should be updated to the same value in all vnets connected to this vsw.
202  */
203 uint16_t	vsw_default_vlan_id = 1;
204 
205 /*
206  * Workaround for a version handshake bug in obp's vnet.
207  * If vsw initiates version negotiation starting from the highest version,
208  * obp sends a nack and terminates version handshake. To workaround
209  * this, we do not initiate version handshake when the channel comes up.
210  * Instead, we wait for the peer to send its version info msg and go through
211  * the version protocol exchange. If we successfully negotiate a version,
212  * before sending the ack, we send our version info msg to the peer
213  * using the <major,minor> version that we are about to ack.
214  */
215 boolean_t vsw_obp_ver_proto_workaround = B_TRUE;
216 
217 /*
218  * In the absence of "priority-ether-types" property in MD, the following
219  * internal tunable can be set to specify a single priority ethertype.
220  */
221 uint64_t vsw_pri_eth_type = 0;
222 
223 /*
224  * Number of transmit priority buffers that are preallocated per device.
225  * This number is chosen to be a small value to throttle transmission
226  * of priority packets. Note: Must be a power of 2 for vio_create_mblks().
227  */
228 uint32_t vsw_pri_tx_nmblks = 64;
229 
230 /*
231  * Number of RARP packets sent to announce macaddr to the physical switch,
232  * after vsw's physical device is changed dynamically or after a guest (client
233  * vnet) is live migrated in.
234  */
235 uint32_t vsw_publish_macaddr_count = 3;
236 
237 boolean_t vsw_hio_enabled = B_TRUE;	/* Enable/disable HybridIO */
238 int vsw_hio_max_cleanup_retries = 10;	/* Max retries for HybridIO cleanp */
239 int vsw_hio_cleanup_delay = 10000;	/* 10ms */
240 
241 /* Number of transmit descriptors -  must be power of 2 */
242 uint32_t vsw_ntxds = VSW_RING_NUM_EL;
243 
244 /*
245  * Max number of mblks received in one receive operation.
246  */
247 uint32_t vsw_chain_len = (VSW_NUM_MBLKS * 0.6);
248 
249 /*
250  * Internal tunables for receive buffer pools, that is,  the size and number of
251  * mblks for each pool. At least 3 sizes must be specified if these are used.
252  * The sizes must be specified in increasing order. Non-zero value of the first
253  * size will be used as a hint to use these values instead of the algorithm
254  * that determines the sizes based on MTU.
255  */
256 uint32_t vsw_mblk_size1 = 0;
257 uint32_t vsw_mblk_size2 = 0;
258 uint32_t vsw_mblk_size3 = 0;
259 uint32_t vsw_mblk_size4 = 0;
260 uint32_t vsw_num_mblks1 = VSW_NUM_MBLKS;	/* number of mblks for pool1 */
261 uint32_t vsw_num_mblks2 = VSW_NUM_MBLKS;	/* number of mblks for pool2 */
262 uint32_t vsw_num_mblks3 = VSW_NUM_MBLKS;	/* number of mblks for pool3 */
263 uint32_t vsw_num_mblks4 = VSW_NUM_MBLKS;	/* number of mblks for pool4 */
264 
265 /*
266  * Set this to non-zero to enable additional internal receive buffer pools
267  * based on the MTU of the device for better performance at the cost of more
268  * memory consumption. This is turned off by default, to use allocb(9F) for
269  * receive buffer allocations of sizes > 2K.
270  */
271 boolean_t vsw_jumbo_rxpools = B_FALSE;
272 
273 /*
274  * vsw_max_tx_qcount is the maximum # of packets that can be queued
275  * before the tx worker thread begins processing the queue. Its value
276  * is chosen to be 4x the default length of tx descriptor ring.
277  */
278 uint32_t vsw_max_tx_qcount = 4 * VSW_RING_NUM_EL;
279 
280 /*
281  * MAC callbacks
282  */
283 static	mac_callbacks_t	vsw_m_callbacks = {
284 	0,
285 	vsw_m_stat,
286 	vsw_m_start,
287 	vsw_m_stop,
288 	vsw_m_promisc,
289 	vsw_m_multicst,
290 	vsw_m_unicst,
291 	vsw_m_tx,
292 	NULL,
293 	NULL,
294 	NULL
295 };
296 
297 static	struct	cb_ops	vsw_cb_ops = {
298 	nulldev,			/* cb_open */
299 	nulldev,			/* cb_close */
300 	nodev,				/* cb_strategy */
301 	nodev,				/* cb_print */
302 	nodev,				/* cb_dump */
303 	nodev,				/* cb_read */
304 	nodev,				/* cb_write */
305 	nodev,				/* cb_ioctl */
306 	nodev,				/* cb_devmap */
307 	nodev,				/* cb_mmap */
308 	nodev,				/* cb_segmap */
309 	nochpoll,			/* cb_chpoll */
310 	ddi_prop_op,			/* cb_prop_op */
311 	NULL,				/* cb_stream */
312 	D_MP,				/* cb_flag */
313 	CB_REV,				/* rev */
314 	nodev,				/* int (*cb_aread)() */
315 	nodev				/* int (*cb_awrite)() */
316 };
317 
318 static	struct	dev_ops	vsw_ops = {
319 	DEVO_REV,		/* devo_rev */
320 	0,			/* devo_refcnt */
321 	NULL,			/* devo_getinfo */
322 	nulldev,		/* devo_identify */
323 	nulldev,		/* devo_probe */
324 	vsw_attach,		/* devo_attach */
325 	vsw_detach,		/* devo_detach */
326 	nodev,			/* devo_reset */
327 	&vsw_cb_ops,		/* devo_cb_ops */
328 	(struct bus_ops *)NULL,	/* devo_bus_ops */
329 	ddi_power		/* devo_power */
330 };
331 
332 extern	struct	mod_ops	mod_driverops;
333 static struct modldrv vswmodldrv = {
334 	&mod_driverops,
335 	"sun4v Virtual Switch",
336 	&vsw_ops,
337 };
338 
339 #define	LDC_ENTER_LOCK(ldcp)	\
340 				mutex_enter(&((ldcp)->ldc_cblock));\
341 				mutex_enter(&((ldcp)->ldc_rxlock));\
342 				mutex_enter(&((ldcp)->ldc_txlock));
343 #define	LDC_EXIT_LOCK(ldcp)	\
344 				mutex_exit(&((ldcp)->ldc_txlock));\
345 				mutex_exit(&((ldcp)->ldc_rxlock));\
346 				mutex_exit(&((ldcp)->ldc_cblock));
347 
348 /* Driver soft state ptr  */
349 static void	*vsw_state;
350 
351 /*
352  * Linked list of "vsw_t" structures - one per instance.
353  */
354 vsw_t		*vsw_head = NULL;
355 vio_mblk_pool_t	*vsw_rx_poolp = NULL;
356 krwlock_t	vsw_rw;
357 
358 /*
359  * Property names
360  */
361 static char vdev_propname[] = "virtual-device";
362 static char vsw_propname[] = "virtual-network-switch";
363 static char physdev_propname[] = "vsw-phys-dev";
364 static char smode_propname[] = "vsw-switch-mode";
365 static char macaddr_propname[] = "local-mac-address";
366 static char remaddr_propname[] = "remote-mac-address";
367 static char ldcids_propname[] = "ldc-ids";
368 static char chan_propname[] = "channel-endpoint";
369 static char id_propname[] = "id";
370 static char reg_propname[] = "reg";
371 static char pri_types_propname[] = "priority-ether-types";
372 static char vsw_pvid_propname[] = "port-vlan-id";
373 static char vsw_vid_propname[] = "vlan-id";
374 static char vsw_dvid_propname[] = "default-vlan-id";
375 static char port_pvid_propname[] = "remote-port-vlan-id";
376 static char port_vid_propname[] = "remote-vlan-id";
377 static char hybrid_propname[] = "hybrid";
378 static char vsw_mtu_propname[] = "mtu";
379 static char vsw_linkprop_propname[] = "linkprop";
380 
381 /*
382  * Matching criteria passed to the MDEG to register interest
383  * in changes to 'virtual-device-port' nodes identified by their
384  * 'id' property.
385  */
386 static md_prop_match_t vport_prop_match[] = {
387 	{ MDET_PROP_VAL,    "id"   },
388 	{ MDET_LIST_END,    NULL    }
389 };
390 
391 static mdeg_node_match_t vport_match = { "virtual-device-port",
392 						vport_prop_match };
393 
394 /*
395  * Matching criteria passed to the MDEG to register interest
396  * in changes to 'virtual-device' nodes (i.e. vsw nodes) identified
397  * by their 'name' and 'cfg-handle' properties.
398  */
399 static md_prop_match_t vdev_prop_match[] = {
400 	{ MDET_PROP_STR,    "name"   },
401 	{ MDET_PROP_VAL,    "cfg-handle" },
402 	{ MDET_LIST_END,    NULL    }
403 };
404 
405 static mdeg_node_match_t vdev_match = { "virtual-device",
406 						vdev_prop_match };
407 
408 
409 /*
410  * Specification of an MD node passed to the MDEG to filter any
411  * 'vport' nodes that do not belong to the specified node. This
412  * template is copied for each vsw instance and filled in with
413  * the appropriate 'cfg-handle' value before being passed to the MDEG.
414  */
415 static mdeg_prop_spec_t vsw_prop_template[] = {
416 	{ MDET_PROP_STR,    "name",		vsw_propname },
417 	{ MDET_PROP_VAL,    "cfg-handle",	NULL	},
418 	{ MDET_LIST_END,    NULL,		NULL	}
419 };
420 
421 #define	VSW_SET_MDEG_PROP_INST(specp, val)	(specp)[1].ps_val = (val);
422 
423 #ifdef	DEBUG
424 /*
425  * Print debug messages - set to 0x1f to enable all msgs
426  * or 0x0 to turn all off.
427  */
428 int vswdbg = 0x0;
429 
430 /*
431  * debug levels:
432  * 0x01:	Function entry/exit tracing
433  * 0x02:	Internal function messages
434  * 0x04:	Verbose internal messages
435  * 0x08:	Warning messages
436  * 0x10:	Error messages
437  */
438 
439 void
440 vswdebug(vsw_t *vswp, const char *fmt, ...)
441 {
442 	char buf[512];
443 	va_list ap;
444 
445 	va_start(ap, fmt);
446 	(void) vsprintf(buf, fmt, ap);
447 	va_end(ap);
448 
449 	if (vswp == NULL)
450 		cmn_err(CE_CONT, "%s\n", buf);
451 	else
452 		cmn_err(CE_CONT, "vsw%d: %s\n", vswp->instance, buf);
453 }
454 
455 #endif	/* DEBUG */
456 
457 static struct modlinkage modlinkage = {
458 	MODREV_1,
459 	&vswmodldrv,
460 	NULL
461 };
462 
463 int
464 _init(void)
465 {
466 	int status;
467 
468 	rw_init(&vsw_rw, NULL, RW_DRIVER, NULL);
469 
470 	status = ddi_soft_state_init(&vsw_state, sizeof (vsw_t), 1);
471 	if (status != 0) {
472 		return (status);
473 	}
474 
475 	mac_init_ops(&vsw_ops, DRV_NAME);
476 	status = mod_install(&modlinkage);
477 	if (status != 0) {
478 		ddi_soft_state_fini(&vsw_state);
479 	}
480 	return (status);
481 }
482 
483 int
484 _fini(void)
485 {
486 	int status;
487 
488 	status = vsw_mod_cleanup();
489 	if (status != 0)
490 		return (status);
491 
492 	status = mod_remove(&modlinkage);
493 	if (status != 0)
494 		return (status);
495 	mac_fini_ops(&vsw_ops);
496 	ddi_soft_state_fini(&vsw_state);
497 
498 	rw_destroy(&vsw_rw);
499 
500 	return (status);
501 }
502 
503 int
504 _info(struct modinfo *modinfop)
505 {
506 	return (mod_info(&modlinkage, modinfop));
507 }
508 
509 static int
510 vsw_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
511 {
512 	vsw_t			*vswp;
513 	int			instance;
514 	char			hashname[MAXNAMELEN];
515 	char			qname[TASKQ_NAMELEN];
516 	vsw_attach_progress_t	progress = PROG_init;
517 	int			rv;
518 
519 	switch (cmd) {
520 	case DDI_ATTACH:
521 		break;
522 	case DDI_RESUME:
523 		/* nothing to do for this non-device */
524 		return (DDI_SUCCESS);
525 	case DDI_PM_RESUME:
526 	default:
527 		return (DDI_FAILURE);
528 	}
529 
530 	instance = ddi_get_instance(dip);
531 	if (ddi_soft_state_zalloc(vsw_state, instance) != DDI_SUCCESS) {
532 		DERR(NULL, "vsw%d: ddi_soft_state_zalloc failed", instance);
533 		return (DDI_FAILURE);
534 	}
535 	vswp = ddi_get_soft_state(vsw_state, instance);
536 
537 	if (vswp == NULL) {
538 		DERR(NULL, "vsw%d: ddi_get_soft_state failed", instance);
539 		goto vsw_attach_fail;
540 	}
541 
542 	vswp->dip = dip;
543 	vswp->instance = instance;
544 	vswp->phys_link_state = LINK_STATE_UNKNOWN;
545 	ddi_set_driver_private(dip, (caddr_t)vswp);
546 
547 	mutex_init(&vswp->mac_lock, NULL, MUTEX_DRIVER, NULL);
548 	mutex_init(&vswp->mca_lock, NULL, MUTEX_DRIVER, NULL);
549 	mutex_init(&vswp->sw_thr_lock, NULL, MUTEX_DRIVER, NULL);
550 	cv_init(&vswp->sw_thr_cv, NULL, CV_DRIVER, NULL);
551 	rw_init(&vswp->maccl_rwlock, NULL, RW_DRIVER, NULL);
552 	rw_init(&vswp->if_lockrw, NULL, RW_DRIVER, NULL);
553 	rw_init(&vswp->mfdbrw, NULL, RW_DRIVER, NULL);
554 	rw_init(&vswp->plist.lockrw, NULL, RW_DRIVER, NULL);
555 
556 	progress |= PROG_locks;
557 
558 	rv = vsw_read_mdprops(vswp);
559 	if (rv != 0)
560 		goto vsw_attach_fail;
561 
562 	progress |= PROG_readmd;
563 
564 	/* setup the unicast forwarding database  */
565 	(void) snprintf(hashname, MAXNAMELEN, "vsw_unicst_table-%d",
566 	    vswp->instance);
567 	D2(vswp, "creating unicast hash table (%s)...", hashname);
568 	vswp->fdb_nchains = vsw_fdb_nchains;
569 	vswp->fdb_hashp = mod_hash_create_ptrhash(hashname, vswp->fdb_nchains,
570 	    mod_hash_null_valdtor, sizeof (void *));
571 	vsw_create_vlans((void *)vswp, VSW_LOCALDEV);
572 	progress |= PROG_fdb;
573 
574 	/* setup the multicast fowarding database */
575 	(void) snprintf(hashname, MAXNAMELEN, "vsw_mcst_table-%d",
576 	    vswp->instance);
577 	D2(vswp, "creating multicast hash table %s)...", hashname);
578 	vswp->mfdb = mod_hash_create_ptrhash(hashname, vsw_fdb_nchains,
579 	    mod_hash_null_valdtor, sizeof (void *));
580 
581 	progress |= PROG_mfdb;
582 
583 	/*
584 	 * Create the taskq which will process all the VIO
585 	 * control messages.
586 	 */
587 	(void) snprintf(qname, TASKQ_NAMELEN, "vsw_taskq%d", vswp->instance);
588 	if ((vswp->taskq_p = ddi_taskq_create(vswp->dip, qname, 1,
589 	    TASKQ_DEFAULTPRI, 0)) == NULL) {
590 		cmn_err(CE_WARN, "!vsw%d: Unable to create task queue",
591 		    vswp->instance);
592 		goto vsw_attach_fail;
593 	}
594 
595 	progress |= PROG_taskq;
596 
597 	/* prevent auto-detaching */
598 	if (ddi_prop_update_int(DDI_DEV_T_NONE, vswp->dip,
599 	    DDI_NO_AUTODETACH, 1) != DDI_SUCCESS) {
600 		cmn_err(CE_NOTE, "!Unable to set \"%s\" property for "
601 		    "instance %u", DDI_NO_AUTODETACH, instance);
602 	}
603 
604 	/*
605 	 * The null switching function is set to avoid panic until
606 	 * switch mode is setup.
607 	 */
608 	vswp->vsw_switch_frame = vsw_switch_frame_nop;
609 
610 	/*
611 	 * Setup the required switching mode, based on the mdprops that we read
612 	 * earlier. We start a thread to do this, to avoid calling mac_open()
613 	 * directly from attach().
614 	 */
615 	rv = vsw_setup_switching_start(vswp);
616 	if (rv != 0) {
617 		goto vsw_attach_fail;
618 	}
619 
620 	progress |= PROG_swmode;
621 
622 	/* Register with mac layer as a provider */
623 	rv = vsw_mac_register(vswp);
624 	if (rv != 0)
625 		goto vsw_attach_fail;
626 
627 	progress |= PROG_macreg;
628 
629 	/*
630 	 * Now we have everything setup, register an interest in
631 	 * specific MD nodes.
632 	 *
633 	 * The callback is invoked in 2 cases, firstly if upon mdeg
634 	 * registration there are existing nodes which match our specified
635 	 * criteria, and secondly if the MD is changed (and again, there
636 	 * are nodes which we are interested in present within it. Note
637 	 * that our callback will be invoked even if our specified nodes
638 	 * have not actually changed).
639 	 *
640 	 */
641 	rv = vsw_mdeg_register(vswp);
642 	if (rv != 0)
643 		goto vsw_attach_fail;
644 
645 	progress |= PROG_mdreg;
646 
647 	vswp->attach_progress = progress;
648 
649 	WRITE_ENTER(&vsw_rw);
650 	vswp->next = vsw_head;
651 	vsw_head = vswp;
652 	RW_EXIT(&vsw_rw);
653 
654 	ddi_report_dev(vswp->dip);
655 	return (DDI_SUCCESS);
656 
657 vsw_attach_fail:
658 	DERR(NULL, "vsw_attach: failed");
659 
660 	vswp->attach_progress = progress;
661 	(void) vsw_unattach(vswp);
662 	ddi_soft_state_free(vsw_state, instance);
663 	return (DDI_FAILURE);
664 }
665 
666 static int
667 vsw_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
668 {
669 	vsw_t			**vswpp, *vswp;
670 	int 			instance;
671 
672 	instance = ddi_get_instance(dip);
673 	vswp = ddi_get_soft_state(vsw_state, instance);
674 
675 	if (vswp == NULL) {
676 		return (DDI_FAILURE);
677 	}
678 
679 	switch (cmd) {
680 	case DDI_DETACH:
681 		break;
682 	case DDI_SUSPEND:
683 	case DDI_PM_SUSPEND:
684 	default:
685 		return (DDI_FAILURE);
686 	}
687 
688 	D2(vswp, "detaching instance %d", instance);
689 
690 	if (vsw_unattach(vswp) != 0) {
691 		return (DDI_FAILURE);
692 	}
693 
694 	ddi_remove_minor_node(dip, NULL);
695 
696 	WRITE_ENTER(&vsw_rw);
697 	for (vswpp = &vsw_head; *vswpp; vswpp = &(*vswpp)->next) {
698 		if (*vswpp == vswp) {
699 			*vswpp = vswp->next;
700 			break;
701 		}
702 	}
703 	RW_EXIT(&vsw_rw);
704 
705 	ddi_soft_state_free(vsw_state, instance);
706 
707 	return (DDI_SUCCESS);
708 }
709 
710 /*
711  * Common routine to handle vsw_attach() failure and vsw_detach(). Note that
712  * the only reason this function could fail is if mac_unregister() fails.
713  * Otherwise, this function must ensure that all resources are freed and return
714  * success.
715  */
716 static int
717 vsw_unattach(vsw_t *vswp)
718 {
719 	vio_mblk_pool_t		*poolp, *npoolp;
720 	vsw_attach_progress_t	progress;
721 
722 	progress = vswp->attach_progress;
723 
724 	/*
725 	 * Unregister from the gldv3 subsystem. This can fail, in particular
726 	 * if there are still any open references to this mac device; in which
727 	 * case we just return failure without continuing to detach further.
728 	 */
729 	if (progress & PROG_macreg) {
730 		if (vsw_mac_unregister(vswp) != 0) {
731 			cmn_err(CE_WARN, "!vsw%d: Unable to detach from "
732 			    "MAC layer", vswp->instance);
733 			return (1);
734 		}
735 		progress &= ~PROG_macreg;
736 	}
737 
738 	/*
739 	 * Now that we have unregistered from gldv3, we must finish all other
740 	 * steps and successfully return from this function; otherwise we will
741 	 * end up leaving the device in a broken/unusable state.
742 	 *
743 	 * If we have registered with mdeg, unregister now to stop further
744 	 * callbacks to this vsw device and/or its ports. Then, detach any
745 	 * existing ports.
746 	 */
747 	if (progress & PROG_mdreg) {
748 		vsw_mdeg_unregister(vswp);
749 		vsw_detach_ports(vswp);
750 
751 		/*
752 		 * At this point, we attempt to free receive mblk pools that
753 		 * couldn't be destroyed when the ports were detached; if this
754 		 * attempt also fails, we hook up the pool(s) to the module so
755 		 * they can be cleaned up in _fini().
756 		 */
757 		poolp = vswp->rxh;
758 		while (poolp != NULL) {
759 			npoolp = vswp->rxh = poolp->nextp;
760 			if (vio_destroy_mblks(poolp) != 0) {
761 				WRITE_ENTER(&vsw_rw);
762 				poolp->nextp = vsw_rx_poolp;
763 				vsw_rx_poolp = poolp;
764 				RW_EXIT(&vsw_rw);
765 			}
766 			poolp = npoolp;
767 		}
768 		progress &= ~PROG_mdreg;
769 	}
770 
771 	/*
772 	 * If we have started a thread to setup the switching mode, stop it, if
773 	 * it is still running. If it has finished setting up the switching
774 	 * mode, then we need to clean up some additional things if we are
775 	 * running in L2 mode: first free up any hybrid resources; then stop
776 	 * and close the underlying physical device. Note that we would have
777 	 * already released all per mac_client resources (ucast, mcast addrs,
778 	 * hio-shares etc) as all the ports are detached and if the vsw device
779 	 * itself was in use as an interface, it has been unplumbed (otherwise
780 	 * mac_unregister() above would fail).
781 	 */
782 	if (progress & PROG_swmode) {
783 
784 		vsw_setup_switching_stop(vswp);
785 
786 		if (vswp->hio_capable == B_TRUE) {
787 			vsw_hio_cleanup(vswp);
788 			vswp->hio_capable = B_FALSE;
789 		}
790 
791 		mutex_enter(&vswp->mac_lock);
792 		vsw_mac_close(vswp);
793 		mutex_exit(&vswp->mac_lock);
794 
795 		progress &= ~PROG_swmode;
796 	}
797 
798 	/*
799 	 * By now any pending tasks have finished and the underlying
800 	 * ldc's have been destroyed, so its safe to delete the control
801 	 * message taskq.
802 	 */
803 	if (progress & PROG_taskq) {
804 		ddi_taskq_destroy(vswp->taskq_p);
805 		progress &= ~PROG_taskq;
806 	}
807 
808 	/* Destroy the multicast hash table */
809 	if (progress & PROG_mfdb) {
810 		mod_hash_destroy_hash(vswp->mfdb);
811 		progress &= ~PROG_mfdb;
812 	}
813 
814 	/* Destroy the vlan hash table and fdb */
815 	if (progress & PROG_fdb) {
816 		vsw_destroy_vlans(vswp, VSW_LOCALDEV);
817 		mod_hash_destroy_hash(vswp->fdb_hashp);
818 		progress &= ~PROG_fdb;
819 	}
820 
821 	if (progress & PROG_readmd) {
822 		if (VSW_PRI_ETH_DEFINED(vswp)) {
823 			kmem_free(vswp->pri_types,
824 			    sizeof (uint16_t) * vswp->pri_num_types);
825 			(void) vio_destroy_mblks(vswp->pri_tx_vmp);
826 		}
827 		progress &= ~PROG_readmd;
828 	}
829 
830 	if (progress & PROG_locks) {
831 		rw_destroy(&vswp->plist.lockrw);
832 		rw_destroy(&vswp->mfdbrw);
833 		rw_destroy(&vswp->if_lockrw);
834 		rw_destroy(&vswp->maccl_rwlock);
835 		cv_destroy(&vswp->sw_thr_cv);
836 		mutex_destroy(&vswp->sw_thr_lock);
837 		mutex_destroy(&vswp->mca_lock);
838 		mutex_destroy(&vswp->mac_lock);
839 		progress &= ~PROG_locks;
840 	}
841 
842 	vswp->attach_progress = progress;
843 
844 	return (0);
845 }
846 
847 /*
848  * one time cleanup.
849  */
850 static int
851 vsw_mod_cleanup(void)
852 {
853 	vio_mblk_pool_t		*poolp, *npoolp;
854 
855 	/*
856 	 * If any rx mblk pools are still in use, return
857 	 * error and stop the module from unloading.
858 	 */
859 	WRITE_ENTER(&vsw_rw);
860 	poolp = vsw_rx_poolp;
861 	while (poolp != NULL) {
862 		npoolp = vsw_rx_poolp = poolp->nextp;
863 		if (vio_destroy_mblks(poolp) != 0) {
864 			vsw_rx_poolp = poolp;
865 			RW_EXIT(&vsw_rw);
866 			return (EBUSY);
867 		}
868 		poolp = npoolp;
869 	}
870 	RW_EXIT(&vsw_rw);
871 
872 	return (0);
873 }
874 
875 /*
876  * Get the value of the "vsw-phys-dev" property in the specified
877  * node. This property is the name of the physical device that
878  * the virtual switch will use to talk to the outside world.
879  *
880  * Note it is valid for this property to be NULL (but the property
881  * itself must exist). Callers of this routine should verify that
882  * the value returned is what they expected (i.e. either NULL or non NULL).
883  *
884  * On success returns value of the property in region pointed to by
885  * the 'name' argument, and with return value of 0. Otherwise returns 1.
886  */
887 static int
888 vsw_get_md_physname(vsw_t *vswp, md_t *mdp, mde_cookie_t node, char *name)
889 {
890 	int		len = 0;
891 	int		instance;
892 	char		*physname = NULL;
893 	char		*dev;
894 	const char	*dev_name;
895 	char		myname[MAXNAMELEN];
896 
897 	dev_name = ddi_driver_name(vswp->dip);
898 	instance = ddi_get_instance(vswp->dip);
899 	(void) snprintf(myname, MAXNAMELEN, "%s%d", dev_name, instance);
900 
901 	if (md_get_prop_data(mdp, node, physdev_propname,
902 	    (uint8_t **)(&physname), &len) != 0) {
903 		cmn_err(CE_WARN, "!vsw%d: Unable to get name(s) of physical "
904 		    "device(s) from MD", vswp->instance);
905 		return (1);
906 	} else if ((strlen(physname) + 1) > LIFNAMSIZ) {
907 		cmn_err(CE_WARN, "!vsw%d: %s is too long a device name",
908 		    vswp->instance, physname);
909 		return (1);
910 	} else if (strcmp(myname, physname) == 0) {
911 		/*
912 		 * Prevent the vswitch from opening itself as the
913 		 * network device.
914 		 */
915 		cmn_err(CE_WARN, "!vsw%d: %s is an invalid device name",
916 		    vswp->instance, physname);
917 		return (1);
918 	} else {
919 		(void) strncpy(name, physname, strlen(physname) + 1);
920 		D2(vswp, "%s: using first device specified (%s)",
921 		    __func__, physname);
922 	}
923 
924 #ifdef DEBUG
925 	/*
926 	 * As a temporary measure to aid testing we check to see if there
927 	 * is a vsw.conf file present. If there is we use the value of the
928 	 * vsw_physname property in the file as the name of the physical
929 	 * device, overriding the value from the MD.
930 	 *
931 	 * There may be multiple devices listed, but for the moment
932 	 * we just use the first one.
933 	 */
934 	if (ddi_prop_lookup_string(DDI_DEV_T_ANY, vswp->dip, 0,
935 	    "vsw_physname", &dev) == DDI_PROP_SUCCESS) {
936 		if ((strlen(dev) + 1) > LIFNAMSIZ) {
937 			cmn_err(CE_WARN, "vsw%d: %s is too long a device name",
938 			    vswp->instance, dev);
939 			ddi_prop_free(dev);
940 			return (1);
941 		} else {
942 			cmn_err(CE_NOTE, "vsw%d: Using device name (%s) from "
943 			    "config file", vswp->instance, dev);
944 
945 			(void) strncpy(name, dev, strlen(dev) + 1);
946 		}
947 
948 		ddi_prop_free(dev);
949 	}
950 #endif
951 
952 	return (0);
953 }
954 
955 /*
956  * Read the 'vsw-switch-mode' property from the specified MD node.
957  *
958  * Returns 0 on success, otherwise returns 1.
959  */
960 static int
961 vsw_get_md_smodes(vsw_t *vswp, md_t *mdp, mde_cookie_t node, uint8_t *mode)
962 {
963 	int		len = 0;
964 	char		*smode = NULL;
965 	char		*curr_mode = NULL;
966 
967 	D1(vswp, "%s: enter", __func__);
968 
969 	/*
970 	 * Get the switch-mode property. The modes are listed in
971 	 * decreasing order of preference, i.e. prefered mode is
972 	 * first item in list.
973 	 */
974 	len = 0;
975 	if (md_get_prop_data(mdp, node, smode_propname,
976 	    (uint8_t **)(&smode), &len) != 0) {
977 		/*
978 		 * Unable to get switch-mode property from MD, nothing
979 		 * more we can do.
980 		 */
981 		cmn_err(CE_WARN, "!vsw%d: Unable to get switch mode property"
982 		    " from the MD", vswp->instance);
983 		return (1);
984 	}
985 
986 	curr_mode = smode;
987 	/*
988 	 * Modes of operation:
989 	 * 'switched'	 - layer 2 switching, underlying HW in
990 	 *			programmed mode.
991 	 * 'promiscuous' - layer 2 switching, underlying HW in
992 	 *			promiscuous mode.
993 	 * 'routed'	 - layer 3 (i.e. IP) routing, underlying HW
994 	 *			in non-promiscuous mode.
995 	 */
996 	while (curr_mode < (smode + len)) {
997 		D2(vswp, "%s: curr_mode = [%s]", __func__, curr_mode);
998 		if (strcmp(curr_mode, "switched") == 0) {
999 			*mode = VSW_LAYER2;
1000 		} else if (strcmp(curr_mode, "promiscuous") == 0) {
1001 			*mode = VSW_LAYER2 | VSW_LAYER2_PROMISC;
1002 		} else if (strcmp(curr_mode, "routed") == 0) {
1003 			*mode = VSW_LAYER3;
1004 		} else {
1005 			cmn_err(CE_WARN, "!vsw%d: Unknown switch mode %s, "
1006 			    "setting to default switched mode",
1007 			    vswp->instance, curr_mode);
1008 			*mode = VSW_LAYER2;
1009 		}
1010 		curr_mode += strlen(curr_mode) + 1;
1011 	}
1012 
1013 	D2(vswp, "%s: %d mode", __func__, *mode);
1014 
1015 	D1(vswp, "%s: exit", __func__);
1016 
1017 	return (0);
1018 }
1019 
1020 /*
1021  * Register with the MAC layer as a network device, so we
1022  * can be plumbed if necessary.
1023  */
1024 static int
1025 vsw_mac_register(vsw_t *vswp)
1026 {
1027 	mac_register_t	*macp;
1028 	int		rv;
1029 
1030 	D1(vswp, "%s: enter", __func__);
1031 
1032 	if ((macp = mac_alloc(MAC_VERSION)) == NULL)
1033 		return (EINVAL);
1034 	macp->m_type_ident = MAC_PLUGIN_IDENT_ETHER;
1035 	macp->m_driver = vswp;
1036 	macp->m_dip = vswp->dip;
1037 	macp->m_src_addr = (uint8_t *)&vswp->if_addr;
1038 	macp->m_callbacks = &vsw_m_callbacks;
1039 	macp->m_min_sdu = 0;
1040 	macp->m_max_sdu = vswp->mtu;
1041 	macp->m_margin = VLAN_TAGSZ;
1042 	rv = mac_register(macp, &vswp->if_mh);
1043 	mac_free(macp);
1044 	if (rv != 0) {
1045 		/*
1046 		 * Treat this as a non-fatal error as we may be
1047 		 * able to operate in some other mode.
1048 		 */
1049 		cmn_err(CE_NOTE, "!vsw%d: Unable to register as "
1050 		    "a provider with MAC layer", vswp->instance);
1051 		return (rv);
1052 	}
1053 
1054 	vswp->if_state |= VSW_IF_REG;
1055 
1056 	D1(vswp, "%s: exit", __func__);
1057 
1058 	return (rv);
1059 }
1060 
1061 static int
1062 vsw_mac_unregister(vsw_t *vswp)
1063 {
1064 	int		rv = 0;
1065 
1066 	D1(vswp, "%s: enter", __func__);
1067 
1068 	WRITE_ENTER(&vswp->if_lockrw);
1069 
1070 	if (vswp->if_state & VSW_IF_REG) {
1071 		rv = mac_unregister(vswp->if_mh);
1072 		if (rv != 0) {
1073 			DWARN(vswp, "%s: unable to unregister from MAC "
1074 			    "framework", __func__);
1075 
1076 			RW_EXIT(&vswp->if_lockrw);
1077 			D1(vswp, "%s: fail exit", __func__);
1078 			return (rv);
1079 		}
1080 
1081 		/* mark i/f as down and unregistered */
1082 		vswp->if_state &= ~(VSW_IF_UP | VSW_IF_REG);
1083 	}
1084 	RW_EXIT(&vswp->if_lockrw);
1085 
1086 	D1(vswp, "%s: exit", __func__);
1087 
1088 	return (rv);
1089 }
1090 
1091 static int
1092 vsw_m_stat(void *arg, uint_t stat, uint64_t *val)
1093 {
1094 	vsw_t			*vswp = (vsw_t *)arg;
1095 
1096 	D1(vswp, "%s: enter", __func__);
1097 
1098 	mutex_enter(&vswp->mac_lock);
1099 	if (vswp->mh == NULL) {
1100 		mutex_exit(&vswp->mac_lock);
1101 		return (EINVAL);
1102 	}
1103 
1104 	/* return stats from underlying device */
1105 	*val = mac_stat_get(vswp->mh, stat);
1106 
1107 	mutex_exit(&vswp->mac_lock);
1108 
1109 	return (0);
1110 }
1111 
1112 static void
1113 vsw_m_stop(void *arg)
1114 {
1115 	vsw_t	*vswp = (vsw_t *)arg;
1116 
1117 	D1(vswp, "%s: enter", __func__);
1118 
1119 	WRITE_ENTER(&vswp->if_lockrw);
1120 	vswp->if_state &= ~VSW_IF_UP;
1121 	RW_EXIT(&vswp->if_lockrw);
1122 
1123 	/* Cleanup and close the mac client */
1124 	vsw_mac_client_cleanup(vswp, NULL, VSW_LOCALDEV);
1125 
1126 	D1(vswp, "%s: exit (state = %d)", __func__, vswp->if_state);
1127 }
1128 
1129 static int
1130 vsw_m_start(void *arg)
1131 {
1132 	int		rv;
1133 	vsw_t		*vswp = (vsw_t *)arg;
1134 
1135 	D1(vswp, "%s: enter", __func__);
1136 
1137 	WRITE_ENTER(&vswp->if_lockrw);
1138 
1139 	vswp->if_state |= VSW_IF_UP;
1140 
1141 	if (vswp->switching_setup_done == B_FALSE) {
1142 		/*
1143 		 * If the switching mode has not been setup yet, just
1144 		 * return. The unicast address will be programmed
1145 		 * after the physical device is successfully setup by the
1146 		 * timeout handler.
1147 		 */
1148 		RW_EXIT(&vswp->if_lockrw);
1149 		return (0);
1150 	}
1151 
1152 	/* if in layer2 mode, program unicast address. */
1153 	if (vswp->mh != NULL) {
1154 		/* Init a mac client and program addresses */
1155 		rv = vsw_mac_client_init(vswp, NULL, VSW_LOCALDEV);
1156 		if (rv != 0) {
1157 			cmn_err(CE_NOTE,
1158 			    "!vsw%d: failed to program interface "
1159 			    "unicast address\n", vswp->instance);
1160 		}
1161 	}
1162 
1163 	RW_EXIT(&vswp->if_lockrw);
1164 
1165 	D1(vswp, "%s: exit (state = %d)", __func__, vswp->if_state);
1166 	return (0);
1167 }
1168 
1169 /*
1170  * Change the local interface address.
1171  *
1172  * Note: we don't support this entry point. The local
1173  * mac address of the switch can only be changed via its
1174  * MD node properties.
1175  */
1176 static int
1177 vsw_m_unicst(void *arg, const uint8_t *macaddr)
1178 {
1179 	_NOTE(ARGUNUSED(arg, macaddr))
1180 
1181 	return (DDI_FAILURE);
1182 }
1183 
1184 static int
1185 vsw_m_multicst(void *arg, boolean_t add, const uint8_t *mca)
1186 {
1187 	vsw_t		*vswp = (vsw_t *)arg;
1188 	mcst_addr_t	*mcst_p = NULL;
1189 	uint64_t	addr = 0x0;
1190 	int		i, ret = 0;
1191 
1192 	D1(vswp, "%s: enter", __func__);
1193 
1194 	/*
1195 	 * Convert address into form that can be used
1196 	 * as hash table key.
1197 	 */
1198 	for (i = 0; i < ETHERADDRL; i++) {
1199 		addr = (addr << 8) | mca[i];
1200 	}
1201 
1202 	D2(vswp, "%s: addr = 0x%llx", __func__, addr);
1203 
1204 	if (add) {
1205 		D2(vswp, "%s: adding multicast", __func__);
1206 		if (vsw_add_mcst(vswp, VSW_LOCALDEV, addr, NULL) == 0) {
1207 			/*
1208 			 * Update the list of multicast addresses
1209 			 * contained within the vsw_t structure to
1210 			 * include this new one.
1211 			 */
1212 			mcst_p = kmem_zalloc(sizeof (mcst_addr_t), KM_NOSLEEP);
1213 			if (mcst_p == NULL) {
1214 				DERR(vswp, "%s unable to alloc mem", __func__);
1215 				(void) vsw_del_mcst(vswp,
1216 				    VSW_LOCALDEV, addr, NULL);
1217 				return (1);
1218 			}
1219 			mcst_p->addr = addr;
1220 			ether_copy(mca, &mcst_p->mca);
1221 
1222 			/*
1223 			 * Call into the underlying driver to program the
1224 			 * address into HW.
1225 			 */
1226 			ret = vsw_mac_multicast_add(vswp, NULL, mcst_p,
1227 			    VSW_LOCALDEV);
1228 			if (ret != 0) {
1229 				(void) vsw_del_mcst(vswp,
1230 				    VSW_LOCALDEV, addr, NULL);
1231 				kmem_free(mcst_p, sizeof (*mcst_p));
1232 				return (ret);
1233 			}
1234 
1235 			mutex_enter(&vswp->mca_lock);
1236 			mcst_p->nextp = vswp->mcap;
1237 			vswp->mcap = mcst_p;
1238 			mutex_exit(&vswp->mca_lock);
1239 		} else {
1240 			cmn_err(CE_WARN, "!vsw%d: unable to add multicast "
1241 			    "address", vswp->instance);
1242 		}
1243 		return (ret);
1244 	}
1245 
1246 	D2(vswp, "%s: removing multicast", __func__);
1247 	/*
1248 	 * Remove the address from the hash table..
1249 	 */
1250 	if (vsw_del_mcst(vswp, VSW_LOCALDEV, addr, NULL) == 0) {
1251 
1252 		/*
1253 		 * ..and then from the list maintained in the
1254 		 * vsw_t structure.
1255 		 */
1256 		mcst_p = vsw_del_addr(VSW_LOCALDEV, vswp, addr);
1257 		ASSERT(mcst_p != NULL);
1258 
1259 		vsw_mac_multicast_remove(vswp, NULL, mcst_p, VSW_LOCALDEV);
1260 		kmem_free(mcst_p, sizeof (*mcst_p));
1261 	}
1262 
1263 	D1(vswp, "%s: exit", __func__);
1264 
1265 	return (0);
1266 }
1267 
1268 static int
1269 vsw_m_promisc(void *arg, boolean_t on)
1270 {
1271 	vsw_t		*vswp = (vsw_t *)arg;
1272 
1273 	D1(vswp, "%s: enter", __func__);
1274 
1275 	WRITE_ENTER(&vswp->if_lockrw);
1276 	if (on)
1277 		vswp->if_state |= VSW_IF_PROMISC;
1278 	else
1279 		vswp->if_state &= ~VSW_IF_PROMISC;
1280 	RW_EXIT(&vswp->if_lockrw);
1281 
1282 	D1(vswp, "%s: exit", __func__);
1283 
1284 	return (0);
1285 }
1286 
1287 static mblk_t *
1288 vsw_m_tx(void *arg, mblk_t *mp)
1289 {
1290 	vsw_t		*vswp = (vsw_t *)arg;
1291 
1292 	D1(vswp, "%s: enter", __func__);
1293 
1294 	mp = vsw_vlan_frame_pretag(vswp, VSW_LOCALDEV, mp);
1295 
1296 	if (mp == NULL) {
1297 		return (NULL);
1298 	}
1299 
1300 	vswp->vsw_switch_frame(vswp, mp, VSW_LOCALDEV, NULL, NULL);
1301 
1302 	D1(vswp, "%s: exit", __func__);
1303 
1304 	return (NULL);
1305 }
1306 
1307 /*
1308  * Register for machine description (MD) updates.
1309  *
1310  * Returns 0 on success, 1 on failure.
1311  */
1312 static int
1313 vsw_mdeg_register(vsw_t *vswp)
1314 {
1315 	mdeg_prop_spec_t	*pspecp;
1316 	mdeg_node_spec_t	*inst_specp;
1317 	mdeg_handle_t		mdeg_hdl, mdeg_port_hdl;
1318 	size_t			templatesz;
1319 	int			rv;
1320 
1321 	D1(vswp, "%s: enter", __func__);
1322 
1323 	/*
1324 	 * Allocate and initialize a per-instance copy
1325 	 * of the global property spec array that will
1326 	 * uniquely identify this vsw instance.
1327 	 */
1328 	templatesz = sizeof (vsw_prop_template);
1329 	pspecp = kmem_zalloc(templatesz, KM_SLEEP);
1330 
1331 	bcopy(vsw_prop_template, pspecp, templatesz);
1332 
1333 	VSW_SET_MDEG_PROP_INST(pspecp, vswp->regprop);
1334 
1335 	/* initialize the complete prop spec structure */
1336 	inst_specp = kmem_zalloc(sizeof (mdeg_node_spec_t), KM_SLEEP);
1337 	inst_specp->namep = "virtual-device";
1338 	inst_specp->specp = pspecp;
1339 
1340 	D2(vswp, "%s: instance %d registering with mdeg", __func__,
1341 	    vswp->regprop);
1342 	/*
1343 	 * Register an interest in 'virtual-device' nodes with a
1344 	 * 'name' property of 'virtual-network-switch'
1345 	 */
1346 	rv = mdeg_register(inst_specp, &vdev_match, vsw_mdeg_cb,
1347 	    (void *)vswp, &mdeg_hdl);
1348 	if (rv != MDEG_SUCCESS) {
1349 		DERR(vswp, "%s: mdeg_register failed (%d) for vsw node",
1350 		    __func__, rv);
1351 		goto mdeg_reg_fail;
1352 	}
1353 
1354 	/*
1355 	 * Register an interest in 'vsw-port' nodes.
1356 	 */
1357 	rv = mdeg_register(inst_specp, &vport_match, vsw_port_mdeg_cb,
1358 	    (void *)vswp, &mdeg_port_hdl);
1359 	if (rv != MDEG_SUCCESS) {
1360 		DERR(vswp, "%s: mdeg_register failed (%d)\n", __func__, rv);
1361 		(void) mdeg_unregister(mdeg_hdl);
1362 		goto mdeg_reg_fail;
1363 	}
1364 
1365 	/* save off data that will be needed later */
1366 	vswp->inst_spec = inst_specp;
1367 	vswp->mdeg_hdl = mdeg_hdl;
1368 	vswp->mdeg_port_hdl = mdeg_port_hdl;
1369 
1370 	D1(vswp, "%s: exit", __func__);
1371 	return (0);
1372 
1373 mdeg_reg_fail:
1374 	cmn_err(CE_WARN, "!vsw%d: Unable to register MDEG callbacks",
1375 	    vswp->instance);
1376 	kmem_free(pspecp, templatesz);
1377 	kmem_free(inst_specp, sizeof (mdeg_node_spec_t));
1378 
1379 	vswp->mdeg_hdl = NULL;
1380 	vswp->mdeg_port_hdl = NULL;
1381 
1382 	return (1);
1383 }
1384 
1385 static void
1386 vsw_mdeg_unregister(vsw_t *vswp)
1387 {
1388 	D1(vswp, "vsw_mdeg_unregister: enter");
1389 
1390 	if (vswp->mdeg_hdl != NULL)
1391 		(void) mdeg_unregister(vswp->mdeg_hdl);
1392 
1393 	if (vswp->mdeg_port_hdl != NULL)
1394 		(void) mdeg_unregister(vswp->mdeg_port_hdl);
1395 
1396 	if (vswp->inst_spec != NULL) {
1397 		if (vswp->inst_spec->specp != NULL) {
1398 			(void) kmem_free(vswp->inst_spec->specp,
1399 			    sizeof (vsw_prop_template));
1400 			vswp->inst_spec->specp = NULL;
1401 		}
1402 
1403 		(void) kmem_free(vswp->inst_spec, sizeof (mdeg_node_spec_t));
1404 		vswp->inst_spec = NULL;
1405 	}
1406 
1407 	D1(vswp, "vsw_mdeg_unregister: exit");
1408 }
1409 
1410 /*
1411  * Mdeg callback invoked for the vsw node itself.
1412  */
1413 static int
1414 vsw_mdeg_cb(void *cb_argp, mdeg_result_t *resp)
1415 {
1416 	vsw_t		*vswp;
1417 	md_t		*mdp;
1418 	mde_cookie_t	node;
1419 	uint64_t	inst;
1420 	char		*node_name = NULL;
1421 
1422 	if (resp == NULL)
1423 		return (MDEG_FAILURE);
1424 
1425 	vswp = (vsw_t *)cb_argp;
1426 
1427 	D1(vswp, "%s: added %d : removed %d : curr matched %d"
1428 	    " : prev matched %d", __func__, resp->added.nelem,
1429 	    resp->removed.nelem, resp->match_curr.nelem,
1430 	    resp->match_prev.nelem);
1431 
1432 	/*
1433 	 * We get an initial callback for this node as 'added'
1434 	 * after registering with mdeg. Note that we would have
1435 	 * already gathered information about this vsw node by
1436 	 * walking MD earlier during attach (in vsw_read_mdprops()).
1437 	 * So, there is a window where the properties of this
1438 	 * node might have changed when we get this initial 'added'
1439 	 * callback. We handle this as if an update occured
1440 	 * and invoke the same function which handles updates to
1441 	 * the properties of this vsw-node if any.
1442 	 *
1443 	 * A non-zero 'match' value indicates that the MD has been
1444 	 * updated and that a virtual-network-switch node is
1445 	 * present which may or may not have been updated. It is
1446 	 * up to the clients to examine their own nodes and
1447 	 * determine if they have changed.
1448 	 */
1449 	if (resp->added.nelem != 0) {
1450 
1451 		if (resp->added.nelem != 1) {
1452 			cmn_err(CE_NOTE, "!vsw%d: number of nodes added "
1453 			    "invalid: %d\n", vswp->instance, resp->added.nelem);
1454 			return (MDEG_FAILURE);
1455 		}
1456 
1457 		mdp = resp->added.mdp;
1458 		node = resp->added.mdep[0];
1459 
1460 	} else if (resp->match_curr.nelem != 0) {
1461 
1462 		if (resp->match_curr.nelem != 1) {
1463 			cmn_err(CE_NOTE, "!vsw%d: number of nodes updated "
1464 			    "invalid: %d\n", vswp->instance,
1465 			    resp->match_curr.nelem);
1466 			return (MDEG_FAILURE);
1467 		}
1468 
1469 		mdp = resp->match_curr.mdp;
1470 		node = resp->match_curr.mdep[0];
1471 
1472 	} else {
1473 		return (MDEG_FAILURE);
1474 	}
1475 
1476 	/* Validate name and instance */
1477 	if (md_get_prop_str(mdp, node, "name", &node_name) != 0) {
1478 		DERR(vswp, "%s: unable to get node name\n",  __func__);
1479 		return (MDEG_FAILURE);
1480 	}
1481 
1482 	/* is this a virtual-network-switch? */
1483 	if (strcmp(node_name, vsw_propname) != 0) {
1484 		DERR(vswp, "%s: Invalid node name: %s\n",
1485 		    __func__, node_name);
1486 		return (MDEG_FAILURE);
1487 	}
1488 
1489 	if (md_get_prop_val(mdp, node, "cfg-handle", &inst)) {
1490 		DERR(vswp, "%s: prop(cfg-handle) not found\n",
1491 		    __func__);
1492 		return (MDEG_FAILURE);
1493 	}
1494 
1495 	/* is this the right instance of vsw? */
1496 	if (inst != vswp->regprop) {
1497 		DERR(vswp, "%s: Invalid cfg-handle: %lx\n",
1498 		    __func__, inst);
1499 		return (MDEG_FAILURE);
1500 	}
1501 
1502 	vsw_update_md_prop(vswp, mdp, node);
1503 
1504 	return (MDEG_SUCCESS);
1505 }
1506 
1507 /*
1508  * Mdeg callback invoked for changes to the vsw-port nodes
1509  * under the vsw node.
1510  */
1511 static int
1512 vsw_port_mdeg_cb(void *cb_argp, mdeg_result_t *resp)
1513 {
1514 	vsw_t		*vswp;
1515 	int		idx;
1516 	md_t		*mdp;
1517 	mde_cookie_t	node;
1518 	uint64_t	inst;
1519 	int		rv;
1520 
1521 	if ((resp == NULL) || (cb_argp == NULL))
1522 		return (MDEG_FAILURE);
1523 
1524 	vswp = (vsw_t *)cb_argp;
1525 
1526 	D2(vswp, "%s: added %d : removed %d : curr matched %d"
1527 	    " : prev matched %d", __func__, resp->added.nelem,
1528 	    resp->removed.nelem, resp->match_curr.nelem,
1529 	    resp->match_prev.nelem);
1530 
1531 	/* process added ports */
1532 	for (idx = 0; idx < resp->added.nelem; idx++) {
1533 		mdp = resp->added.mdp;
1534 		node = resp->added.mdep[idx];
1535 
1536 		D2(vswp, "%s: adding node(%d) 0x%lx", __func__, idx, node);
1537 
1538 		if ((rv = vsw_port_add(vswp, mdp, &node)) != 0) {
1539 			cmn_err(CE_WARN, "!vsw%d: Unable to add new port "
1540 			    "(0x%lx), err=%d", vswp->instance, node, rv);
1541 		}
1542 	}
1543 
1544 	/* process removed ports */
1545 	for (idx = 0; idx < resp->removed.nelem; idx++) {
1546 		mdp = resp->removed.mdp;
1547 		node = resp->removed.mdep[idx];
1548 
1549 		if (md_get_prop_val(mdp, node, id_propname, &inst)) {
1550 			DERR(vswp, "%s: prop(%s) not found in port(%d)",
1551 			    __func__, id_propname, idx);
1552 			continue;
1553 		}
1554 
1555 		D2(vswp, "%s: removing node(%d) 0x%lx", __func__, idx, node);
1556 
1557 		if (vsw_port_detach(vswp, inst) != 0) {
1558 			cmn_err(CE_WARN, "!vsw%d: Unable to remove port %ld",
1559 			    vswp->instance, inst);
1560 		}
1561 	}
1562 
1563 	for (idx = 0; idx < resp->match_curr.nelem; idx++) {
1564 		(void) vsw_port_update(vswp, resp->match_curr.mdp,
1565 		    resp->match_curr.mdep[idx],
1566 		    resp->match_prev.mdp,
1567 		    resp->match_prev.mdep[idx]);
1568 	}
1569 
1570 	D1(vswp, "%s: exit", __func__);
1571 
1572 	return (MDEG_SUCCESS);
1573 }
1574 
1575 /*
1576  * Scan the machine description for this instance of vsw
1577  * and read its properties. Called only from vsw_attach().
1578  * Returns: 0 on success, 1 on failure.
1579  */
1580 static int
1581 vsw_read_mdprops(vsw_t *vswp)
1582 {
1583 	md_t		*mdp = NULL;
1584 	mde_cookie_t	rootnode;
1585 	mde_cookie_t	*listp = NULL;
1586 	uint64_t	inst;
1587 	uint64_t	cfgh;
1588 	char		*name;
1589 	int		rv = 1;
1590 	int		num_nodes = 0;
1591 	int		num_devs = 0;
1592 	int		listsz = 0;
1593 	int		i;
1594 
1595 	/*
1596 	 * In each 'virtual-device' node in the MD there is a
1597 	 * 'cfg-handle' property which is the MD's concept of
1598 	 * an instance number (this may be completely different from
1599 	 * the device drivers instance #). OBP reads that value and
1600 	 * stores it in the 'reg' property of the appropriate node in
1601 	 * the device tree. We first read this reg property and use this
1602 	 * to compare against the 'cfg-handle' property of vsw nodes
1603 	 * in MD to get to this specific vsw instance and then read
1604 	 * other properties that we are interested in.
1605 	 * We also cache the value of 'reg' property and use it later
1606 	 * to register callbacks with mdeg (see vsw_mdeg_register())
1607 	 */
1608 	inst = ddi_prop_get_int(DDI_DEV_T_ANY, vswp->dip,
1609 	    DDI_PROP_DONTPASS, reg_propname, -1);
1610 	if (inst == -1) {
1611 		cmn_err(CE_NOTE, "!vsw%d: Unable to read %s property from "
1612 		    "OBP device tree", vswp->instance, reg_propname);
1613 		return (rv);
1614 	}
1615 
1616 	vswp->regprop = inst;
1617 
1618 	if ((mdp = md_get_handle()) == NULL) {
1619 		DWARN(vswp, "%s: cannot init MD\n", __func__);
1620 		return (rv);
1621 	}
1622 
1623 	num_nodes = md_node_count(mdp);
1624 	ASSERT(num_nodes > 0);
1625 
1626 	listsz = num_nodes * sizeof (mde_cookie_t);
1627 	listp = (mde_cookie_t *)kmem_zalloc(listsz, KM_SLEEP);
1628 
1629 	rootnode = md_root_node(mdp);
1630 
1631 	/* search for all "virtual_device" nodes */
1632 	num_devs = md_scan_dag(mdp, rootnode,
1633 	    md_find_name(mdp, vdev_propname),
1634 	    md_find_name(mdp, "fwd"), listp);
1635 	if (num_devs <= 0) {
1636 		DWARN(vswp, "%s: invalid num_devs:%d\n", __func__, num_devs);
1637 		goto vsw_readmd_exit;
1638 	}
1639 
1640 	/*
1641 	 * Now loop through the list of virtual-devices looking for
1642 	 * devices with name "virtual-network-switch" and for each
1643 	 * such device compare its instance with what we have from
1644 	 * the 'reg' property to find the right node in MD and then
1645 	 * read all its properties.
1646 	 */
1647 	for (i = 0; i < num_devs; i++) {
1648 
1649 		if (md_get_prop_str(mdp, listp[i], "name", &name) != 0) {
1650 			DWARN(vswp, "%s: name property not found\n",
1651 			    __func__);
1652 			goto vsw_readmd_exit;
1653 		}
1654 
1655 		/* is this a virtual-network-switch? */
1656 		if (strcmp(name, vsw_propname) != 0)
1657 			continue;
1658 
1659 		if (md_get_prop_val(mdp, listp[i], "cfg-handle", &cfgh) != 0) {
1660 			DWARN(vswp, "%s: cfg-handle property not found\n",
1661 			    __func__);
1662 			goto vsw_readmd_exit;
1663 		}
1664 
1665 		/* is this the required instance of vsw? */
1666 		if (inst != cfgh)
1667 			continue;
1668 
1669 		/* now read all properties of this vsw instance */
1670 		rv = vsw_get_initial_md_properties(vswp, mdp, listp[i]);
1671 		break;
1672 	}
1673 
1674 vsw_readmd_exit:
1675 
1676 	kmem_free(listp, listsz);
1677 	(void) md_fini_handle(mdp);
1678 	return (rv);
1679 }
1680 
1681 /*
1682  * Read the initial start-of-day values from the specified MD node.
1683  */
1684 static int
1685 vsw_get_initial_md_properties(vsw_t *vswp, md_t *mdp, mde_cookie_t node)
1686 {
1687 	uint64_t	macaddr = 0;
1688 
1689 	D1(vswp, "%s: enter", __func__);
1690 
1691 	if (vsw_get_md_physname(vswp, mdp, node, vswp->physname) != 0) {
1692 		return (1);
1693 	}
1694 
1695 	/* mac address for vswitch device itself */
1696 	if (md_get_prop_val(mdp, node, macaddr_propname, &macaddr) != 0) {
1697 		cmn_err(CE_WARN, "!vsw%d: Unable to get MAC address from MD",
1698 		    vswp->instance);
1699 		return (1);
1700 	}
1701 
1702 	vsw_save_lmacaddr(vswp, macaddr);
1703 
1704 	if (vsw_get_md_smodes(vswp, mdp, node, &vswp->smode)) {
1705 		DWARN(vswp, "%s: Unable to read %s property from MD, "
1706 		    "defaulting to 'switched' mode",
1707 		    __func__, smode_propname);
1708 
1709 		vswp->smode = VSW_LAYER2;
1710 	}
1711 
1712 	/*
1713 	 * Read the 'linkprop' property to know if this
1714 	 * vsw device wants to get physical link updates.
1715 	 */
1716 	vsw_linkprop_read(vswp, mdp, node, &vswp->pls_update);
1717 
1718 	/* read mtu */
1719 	vsw_mtu_read(vswp, mdp, node, &vswp->mtu);
1720 	if (vswp->mtu < ETHERMTU || vswp->mtu > VNET_MAX_MTU) {
1721 		vswp->mtu = ETHERMTU;
1722 	}
1723 	vswp->max_frame_size = vswp->mtu + sizeof (struct ether_header) +
1724 	    VLAN_TAGSZ;
1725 
1726 	/* read vlan id properties of this vsw instance */
1727 	vsw_vlan_read_ids(vswp, VSW_LOCALDEV, mdp, node, &vswp->pvid,
1728 	    &vswp->vids, &vswp->nvids, &vswp->default_vlan_id);
1729 
1730 	/* read priority-ether-types */
1731 	vsw_read_pri_eth_types(vswp, mdp, node);
1732 
1733 	D1(vswp, "%s: exit", __func__);
1734 	return (0);
1735 }
1736 
1737 /*
1738  * Read vlan id properties of the given MD node.
1739  * Arguments:
1740  *   arg:          device argument(vsw device or a port)
1741  *   type:         type of arg; VSW_LOCALDEV(vsw device) or VSW_VNETPORT(port)
1742  *   mdp:          machine description
1743  *   node:         md node cookie
1744  *
1745  * Returns:
1746  *   pvidp:        port-vlan-id of the node
1747  *   vidspp:       list of vlan-ids of the node
1748  *   nvidsp:       # of vlan-ids in the list
1749  *   default_idp:  default-vlan-id of the node(if node is vsw device)
1750  */
1751 static void
1752 vsw_vlan_read_ids(void *arg, int type, md_t *mdp, mde_cookie_t node,
1753 	uint16_t *pvidp, vsw_vlanid_t **vidspp, uint16_t *nvidsp,
1754 	uint16_t *default_idp)
1755 {
1756 	vsw_t		*vswp;
1757 	vsw_port_t	*portp;
1758 	char		*pvid_propname;
1759 	char		*vid_propname;
1760 	uint_t		nvids = 0;
1761 	uint32_t	vids_size;
1762 	int		rv;
1763 	int		i;
1764 	uint64_t	*data;
1765 	uint64_t	val;
1766 	int		size;
1767 	int		inst;
1768 
1769 	if (type == VSW_LOCALDEV) {
1770 
1771 		vswp = (vsw_t *)arg;
1772 		pvid_propname = vsw_pvid_propname;
1773 		vid_propname = vsw_vid_propname;
1774 		inst = vswp->instance;
1775 
1776 	} else if (type == VSW_VNETPORT) {
1777 
1778 		portp = (vsw_port_t *)arg;
1779 		vswp = portp->p_vswp;
1780 		pvid_propname = port_pvid_propname;
1781 		vid_propname = port_vid_propname;
1782 		inst = portp->p_instance;
1783 
1784 	} else {
1785 		return;
1786 	}
1787 
1788 	if (type == VSW_LOCALDEV && default_idp != NULL) {
1789 		rv = md_get_prop_val(mdp, node, vsw_dvid_propname, &val);
1790 		if (rv != 0) {
1791 			DWARN(vswp, "%s: prop(%s) not found", __func__,
1792 			    vsw_dvid_propname);
1793 
1794 			*default_idp = vsw_default_vlan_id;
1795 		} else {
1796 			*default_idp = val & 0xFFF;
1797 			D2(vswp, "%s: %s(%d): (%d)\n", __func__,
1798 			    vsw_dvid_propname, inst, *default_idp);
1799 		}
1800 	}
1801 
1802 	rv = md_get_prop_val(mdp, node, pvid_propname, &val);
1803 	if (rv != 0) {
1804 		DWARN(vswp, "%s: prop(%s) not found", __func__, pvid_propname);
1805 		*pvidp = vsw_default_vlan_id;
1806 	} else {
1807 
1808 		*pvidp = val & 0xFFF;
1809 		D2(vswp, "%s: %s(%d): (%d)\n", __func__,
1810 		    pvid_propname, inst, *pvidp);
1811 	}
1812 
1813 	rv = md_get_prop_data(mdp, node, vid_propname, (uint8_t **)&data,
1814 	    &size);
1815 	if (rv != 0) {
1816 		D2(vswp, "%s: prop(%s) not found", __func__, vid_propname);
1817 		size = 0;
1818 	} else {
1819 		size /= sizeof (uint64_t);
1820 	}
1821 	nvids = size;
1822 
1823 	if (nvids != 0) {
1824 		D2(vswp, "%s: %s(%d): ", __func__, vid_propname, inst);
1825 		vids_size = sizeof (vsw_vlanid_t) * nvids;
1826 		*vidspp = kmem_zalloc(vids_size, KM_SLEEP);
1827 		for (i = 0; i < nvids; i++) {
1828 			(*vidspp)[i].vl_vid = data[i] & 0xFFFF;
1829 			(*vidspp)[i].vl_set = B_FALSE;
1830 			D2(vswp, " %d ", (*vidspp)[i].vl_vid);
1831 		}
1832 		D2(vswp, "\n");
1833 	}
1834 
1835 	*nvidsp = nvids;
1836 }
1837 
1838 /*
1839  * This function reads "priority-ether-types" property from md. This property
1840  * is used to enable support for priority frames. Applications which need
1841  * guaranteed and timely delivery of certain high priority frames to/from
1842  * a vnet or vsw within ldoms, should configure this property by providing
1843  * the ether type(s) for which the priority facility is needed.
1844  * Normal data frames are delivered over a ldc channel using the descriptor
1845  * ring mechanism which is constrained by factors such as descriptor ring size,
1846  * the rate at which the ring is processed at the peer ldc end point, etc.
1847  * The priority mechanism provides an Out-Of-Band path to send/receive frames
1848  * as raw pkt data (VIO_PKT_DATA) messages over the channel, avoiding the
1849  * descriptor ring path and enables a more reliable and timely delivery of
1850  * frames to the peer.
1851  */
1852 static void
1853 vsw_read_pri_eth_types(vsw_t *vswp, md_t *mdp, mde_cookie_t node)
1854 {
1855 	int		rv;
1856 	uint16_t	*types;
1857 	uint64_t	*data;
1858 	int		size;
1859 	int		i;
1860 	size_t		mblk_sz;
1861 
1862 	rv = md_get_prop_data(mdp, node, pri_types_propname,
1863 	    (uint8_t **)&data, &size);
1864 	if (rv != 0) {
1865 		/*
1866 		 * Property may not exist if we are running pre-ldoms1.1 f/w.
1867 		 * Check if 'vsw_pri_eth_type' has been set in that case.
1868 		 */
1869 		if (vsw_pri_eth_type != 0) {
1870 			size = sizeof (vsw_pri_eth_type);
1871 			data = &vsw_pri_eth_type;
1872 		} else {
1873 			D3(vswp, "%s: prop(%s) not found", __func__,
1874 			    pri_types_propname);
1875 			size = 0;
1876 		}
1877 	}
1878 
1879 	if (size == 0) {
1880 		vswp->pri_num_types = 0;
1881 		return;
1882 	}
1883 
1884 	/*
1885 	 * we have some priority-ether-types defined;
1886 	 * allocate a table of these types and also
1887 	 * allocate a pool of mblks to transmit these
1888 	 * priority packets.
1889 	 */
1890 	size /= sizeof (uint64_t);
1891 	vswp->pri_num_types = size;
1892 	vswp->pri_types = kmem_zalloc(size * sizeof (uint16_t), KM_SLEEP);
1893 	for (i = 0, types = vswp->pri_types; i < size; i++) {
1894 		types[i] = data[i] & 0xFFFF;
1895 	}
1896 	mblk_sz = (VIO_PKT_DATA_HDRSIZE + ETHERMAX + 7) & ~7;
1897 	(void) vio_create_mblks(vsw_pri_tx_nmblks, mblk_sz, &vswp->pri_tx_vmp);
1898 }
1899 
1900 static void
1901 vsw_mtu_read(vsw_t *vswp, md_t *mdp, mde_cookie_t node, uint32_t *mtu)
1902 {
1903 	int		rv;
1904 	int		inst;
1905 	uint64_t	val;
1906 	char		*mtu_propname;
1907 
1908 	mtu_propname = vsw_mtu_propname;
1909 	inst = vswp->instance;
1910 
1911 	rv = md_get_prop_val(mdp, node, mtu_propname, &val);
1912 	if (rv != 0) {
1913 		D3(vswp, "%s: prop(%s) not found", __func__, mtu_propname);
1914 		*mtu = vsw_ethermtu;
1915 	} else {
1916 
1917 		*mtu = val & 0xFFFF;
1918 		D2(vswp, "%s: %s(%d): (%d)\n", __func__,
1919 		    mtu_propname, inst, *mtu);
1920 	}
1921 }
1922 
1923 /*
1924  * Update the mtu of the vsw device. We first check if the device has been
1925  * plumbed and if so fail the mtu update. Otherwise, we continue to update the
1926  * new mtu and reset all ports to initiate handshake re-negotiation with peers
1927  * using the new mtu.
1928  */
1929 static int
1930 vsw_mtu_update(vsw_t *vswp, uint32_t mtu)
1931 {
1932 	int	rv;
1933 
1934 	WRITE_ENTER(&vswp->if_lockrw);
1935 
1936 	if (vswp->if_state & VSW_IF_UP) {
1937 
1938 		RW_EXIT(&vswp->if_lockrw);
1939 
1940 		cmn_err(CE_NOTE, "!vsw%d: Unable to process mtu update"
1941 		    " as the device is plumbed\n", vswp->instance);
1942 		return (EBUSY);
1943 
1944 	} else {
1945 
1946 		D2(vswp, "%s: curr_mtu(%d) new_mtu(%d)\n",
1947 		    __func__, vswp->mtu, mtu);
1948 
1949 		vswp->mtu = mtu;
1950 		vswp->max_frame_size = vswp->mtu +
1951 		    sizeof (struct ether_header) + VLAN_TAGSZ;
1952 
1953 		rv = mac_maxsdu_update(vswp->if_mh, mtu);
1954 		if (rv != 0) {
1955 			cmn_err(CE_NOTE,
1956 			    "!vsw%d: Unable to update mtu with mac"
1957 			    " layer\n", vswp->instance);
1958 		}
1959 
1960 		RW_EXIT(&vswp->if_lockrw);
1961 
1962 		/* Reset ports to renegotiate with the new mtu */
1963 		vsw_reset_ports(vswp);
1964 
1965 	}
1966 
1967 	return (0);
1968 }
1969 
1970 static void
1971 vsw_linkprop_read(vsw_t *vswp, md_t *mdp, mde_cookie_t node,
1972 	boolean_t *pls)
1973 {
1974 	int		rv;
1975 	uint64_t	val;
1976 	char		*linkpropname;
1977 
1978 	linkpropname = vsw_linkprop_propname;
1979 
1980 	rv = md_get_prop_val(mdp, node, linkpropname, &val);
1981 	if (rv != 0) {
1982 		D3(vswp, "%s: prop(%s) not found", __func__, linkpropname);
1983 		*pls = B_FALSE;
1984 	} else {
1985 
1986 		*pls = (val & 0x1) ? B_TRUE : B_FALSE;
1987 		D2(vswp, "%s: %s(%d): (%d)\n", __func__, linkpropname,
1988 		    vswp->instance, *pls);
1989 	}
1990 }
1991 
1992 void
1993 vsw_mac_link_update(vsw_t *vswp, link_state_t link_state)
1994 {
1995 	READ_ENTER(&vswp->if_lockrw);
1996 
1997 	if (vswp->if_state & VSW_IF_REG) {
1998 		mac_link_update(vswp->if_mh, link_state);
1999 	}
2000 
2001 	RW_EXIT(&vswp->if_lockrw);
2002 }
2003 
2004 void
2005 vsw_physlink_state_update(vsw_t *vswp)
2006 {
2007 	if (vswp->pls_update == B_TRUE) {
2008 		vsw_mac_link_update(vswp, vswp->phys_link_state);
2009 	}
2010 	vsw_physlink_update_ports(vswp);
2011 }
2012 
2013 /*
2014  * Check to see if the relevant properties in the specified node have
2015  * changed, and if so take the appropriate action.
2016  *
2017  * If any of the properties are missing or invalid we don't take
2018  * any action, as this function should only be invoked when modifications
2019  * have been made to what we assume is a working configuration, which
2020  * we leave active.
2021  *
2022  * Note it is legal for this routine to be invoked even if none of the
2023  * properties in the port node within the MD have actually changed.
2024  */
2025 static void
2026 vsw_update_md_prop(vsw_t *vswp, md_t *mdp, mde_cookie_t node)
2027 {
2028 	char		physname[LIFNAMSIZ];
2029 	char		drv[LIFNAMSIZ];
2030 	uint_t		ddi_instance;
2031 	uint8_t		new_smode;
2032 	int		i;
2033 	uint64_t 	macaddr = 0;
2034 	enum		{MD_init = 0x1,
2035 				MD_physname = 0x2,
2036 				MD_macaddr = 0x4,
2037 				MD_smode = 0x8,
2038 				MD_vlans = 0x10,
2039 				MD_mtu = 0x20,
2040 				MD_pls = 0x40} updated;
2041 	int		rv;
2042 	uint16_t	pvid;
2043 	vsw_vlanid_t	*vids;
2044 	uint16_t	nvids;
2045 	uint32_t	mtu;
2046 	boolean_t	pls_update;
2047 
2048 	updated = MD_init;
2049 
2050 	D1(vswp, "%s: enter", __func__);
2051 
2052 	/*
2053 	 * Check if name of physical device in MD has changed.
2054 	 */
2055 	if (vsw_get_md_physname(vswp, mdp, node, (char *)&physname) == 0) {
2056 		/*
2057 		 * Do basic sanity check on new device name/instance,
2058 		 * if its non NULL. It is valid for the device name to
2059 		 * have changed from a non NULL to a NULL value, i.e.
2060 		 * the vsw is being changed to 'routed' mode.
2061 		 */
2062 		if ((strlen(physname) != 0) &&
2063 		    (ddi_parse(physname, drv,
2064 		    &ddi_instance) != DDI_SUCCESS)) {
2065 			cmn_err(CE_WARN, "!vsw%d: physical device %s is not"
2066 			    " a valid device name/instance",
2067 			    vswp->instance, physname);
2068 			goto fail_reconf;
2069 		}
2070 
2071 		if (strcmp(physname, vswp->physname)) {
2072 			D2(vswp, "%s: device name changed from %s to %s",
2073 			    __func__, vswp->physname, physname);
2074 
2075 			updated |= MD_physname;
2076 		} else {
2077 			D2(vswp, "%s: device name unchanged at %s",
2078 			    __func__, vswp->physname);
2079 		}
2080 	} else {
2081 		cmn_err(CE_WARN, "!vsw%d: Unable to read name of physical "
2082 		    "device from updated MD.", vswp->instance);
2083 		goto fail_reconf;
2084 	}
2085 
2086 	/*
2087 	 * Check if MAC address has changed.
2088 	 */
2089 	if (md_get_prop_val(mdp, node, macaddr_propname, &macaddr) != 0) {
2090 		cmn_err(CE_WARN, "!vsw%d: Unable to get MAC address from MD",
2091 		    vswp->instance);
2092 		goto fail_reconf;
2093 	} else {
2094 		uint64_t maddr = macaddr;
2095 		READ_ENTER(&vswp->if_lockrw);
2096 		for (i = ETHERADDRL - 1; i >= 0; i--) {
2097 			if (vswp->if_addr.ether_addr_octet[i]
2098 			    != (macaddr & 0xFF)) {
2099 				D2(vswp, "%s: octet[%d] 0x%x != 0x%x",
2100 				    __func__, i,
2101 				    vswp->if_addr.ether_addr_octet[i],
2102 				    (macaddr & 0xFF));
2103 				updated |= MD_macaddr;
2104 				macaddr = maddr;
2105 				break;
2106 			}
2107 			macaddr >>= 8;
2108 		}
2109 		RW_EXIT(&vswp->if_lockrw);
2110 		if (updated & MD_macaddr) {
2111 			vsw_save_lmacaddr(vswp, macaddr);
2112 		}
2113 	}
2114 
2115 	/*
2116 	 * Check if switching modes have changed.
2117 	 */
2118 	if (vsw_get_md_smodes(vswp, mdp, node, &new_smode)) {
2119 		cmn_err(CE_WARN, "!vsw%d: Unable to read %s property from MD",
2120 		    vswp->instance, smode_propname);
2121 		goto fail_reconf;
2122 	} else {
2123 		if (new_smode != vswp->smode) {
2124 			D2(vswp, "%s: switching mode changed from %d to %d",
2125 			    __func__, vswp->smode, new_smode);
2126 
2127 			updated |= MD_smode;
2128 		}
2129 	}
2130 
2131 	/* Read the vlan ids */
2132 	vsw_vlan_read_ids(vswp, VSW_LOCALDEV, mdp, node, &pvid, &vids,
2133 	    &nvids, NULL);
2134 
2135 	/* Determine if there are any vlan id updates */
2136 	if ((pvid != vswp->pvid) ||		/* pvid changed? */
2137 	    (nvids != vswp->nvids) ||		/* # of vids changed? */
2138 	    ((nvids != 0) && (vswp->nvids != 0) &&	/* vids changed? */
2139 	    !vsw_cmp_vids(vids, vswp->vids, nvids))) {
2140 		updated |= MD_vlans;
2141 	}
2142 
2143 	/* Read mtu */
2144 	vsw_mtu_read(vswp, mdp, node, &mtu);
2145 	if (mtu != vswp->mtu) {
2146 		if (mtu >= ETHERMTU && mtu <= VNET_MAX_MTU) {
2147 			updated |= MD_mtu;
2148 		} else {
2149 			cmn_err(CE_NOTE, "!vsw%d: Unable to process mtu update"
2150 			    " as the specified value:%d is invalid\n",
2151 			    vswp->instance, mtu);
2152 		}
2153 	}
2154 
2155 	/*
2156 	 * Read the 'linkprop' property.
2157 	 */
2158 	vsw_linkprop_read(vswp, mdp, node, &pls_update);
2159 	if (pls_update != vswp->pls_update) {
2160 		updated |= MD_pls;
2161 	}
2162 
2163 	/*
2164 	 * Now make any changes which are needed...
2165 	 */
2166 	if (updated & MD_pls) {
2167 
2168 		/* save the updated property. */
2169 		vswp->pls_update = pls_update;
2170 
2171 		if (pls_update == B_FALSE) {
2172 			/*
2173 			 * Phys link state update is now disabled for this vsw
2174 			 * interface. If we had previously reported a link-down
2175 			 * to the stack, undo that by sending a link-up.
2176 			 */
2177 			if (vswp->phys_link_state == LINK_STATE_DOWN) {
2178 				vsw_mac_link_update(vswp, LINK_STATE_UP);
2179 			}
2180 		} else {
2181 			/*
2182 			 * Phys link state update is now enabled. Send up an
2183 			 * update based on the current phys link state.
2184 			 */
2185 			if (vswp->smode & VSW_LAYER2) {
2186 				vsw_mac_link_update(vswp,
2187 				    vswp->phys_link_state);
2188 			}
2189 		}
2190 
2191 	}
2192 
2193 	if (updated & (MD_physname | MD_smode | MD_mtu)) {
2194 
2195 		/*
2196 		 * Stop any pending thread to setup switching mode.
2197 		 */
2198 		vsw_setup_switching_stop(vswp);
2199 
2200 		/* Cleanup HybridIO */
2201 		vsw_hio_cleanup(vswp);
2202 
2203 		/*
2204 		 * Remove unicst, mcst addrs of vsw interface
2205 		 * and ports from the physdev. This also closes
2206 		 * the corresponding mac clients.
2207 		 */
2208 		vsw_unset_addrs(vswp);
2209 
2210 		/*
2211 		 * Stop, detach and close the old device..
2212 		 */
2213 		mutex_enter(&vswp->mac_lock);
2214 		vsw_mac_close(vswp);
2215 		mutex_exit(&vswp->mac_lock);
2216 
2217 		/*
2218 		 * Update phys name.
2219 		 */
2220 		if (updated & MD_physname) {
2221 			cmn_err(CE_NOTE, "!vsw%d: changing from %s to %s",
2222 			    vswp->instance, vswp->physname, physname);
2223 			(void) strncpy(vswp->physname,
2224 			    physname, strlen(physname) + 1);
2225 		}
2226 
2227 		/*
2228 		 * Update array with the new switch mode values.
2229 		 */
2230 		if (updated & MD_smode) {
2231 			vswp->smode = new_smode;
2232 		}
2233 
2234 		/* Update mtu */
2235 		if (updated & MD_mtu) {
2236 			rv = vsw_mtu_update(vswp, mtu);
2237 			if (rv != 0) {
2238 				goto fail_update;
2239 			}
2240 		}
2241 
2242 		/*
2243 		 * ..and attach, start the new device.
2244 		 */
2245 		rv = vsw_setup_switching(vswp);
2246 		if (rv == EAGAIN) {
2247 			/*
2248 			 * Unable to setup switching mode.
2249 			 * As the error is EAGAIN, schedule a thread to retry
2250 			 * and return. Programming addresses of ports and
2251 			 * vsw interface will be done by the thread when the
2252 			 * switching setup completes successfully.
2253 			 */
2254 			if (vsw_setup_switching_start(vswp) != 0) {
2255 				goto fail_update;
2256 			}
2257 			return;
2258 
2259 		} else if (rv) {
2260 			goto fail_update;
2261 		}
2262 
2263 		vsw_setup_switching_post_process(vswp);
2264 	} else if (updated & MD_macaddr) {
2265 		/*
2266 		 * We enter here if only MD_macaddr is exclusively updated.
2267 		 * If MD_physname and/or MD_smode are also updated, then
2268 		 * as part of that, we would have implicitly processed
2269 		 * MD_macaddr update (above).
2270 		 */
2271 		cmn_err(CE_NOTE, "!vsw%d: changing mac address to 0x%lx",
2272 		    vswp->instance, macaddr);
2273 
2274 		READ_ENTER(&vswp->if_lockrw);
2275 		if (vswp->if_state & VSW_IF_UP) {
2276 			/* reconfigure with new address */
2277 			vsw_if_mac_reconfig(vswp, B_FALSE, 0, NULL, 0);
2278 
2279 			/*
2280 			 * Notify the MAC layer of the changed address.
2281 			 */
2282 			mac_unicst_update(vswp->if_mh,
2283 			    (uint8_t *)&vswp->if_addr);
2284 
2285 		}
2286 		RW_EXIT(&vswp->if_lockrw);
2287 
2288 	}
2289 
2290 	if (updated & MD_vlans) {
2291 		/* Remove existing vlan ids from the hash table. */
2292 		vsw_vlan_remove_ids(vswp, VSW_LOCALDEV);
2293 
2294 		if (vswp->if_state & VSW_IF_UP) {
2295 			vsw_if_mac_reconfig(vswp, B_TRUE, pvid, vids, nvids);
2296 		} else {
2297 			if (vswp->nvids != 0) {
2298 				kmem_free(vswp->vids,
2299 				    sizeof (vsw_vlanid_t) * vswp->nvids);
2300 			}
2301 			vswp->vids = vids;
2302 			vswp->nvids = nvids;
2303 			vswp->pvid = pvid;
2304 		}
2305 
2306 		/* add these new vlan ids into hash table */
2307 		vsw_vlan_add_ids(vswp, VSW_LOCALDEV);
2308 	} else {
2309 		if (nvids != 0) {
2310 			kmem_free(vids, sizeof (vsw_vlanid_t) * nvids);
2311 		}
2312 	}
2313 
2314 	return;
2315 
2316 fail_reconf:
2317 	cmn_err(CE_WARN, "!vsw%d: configuration unchanged", vswp->instance);
2318 	return;
2319 
2320 fail_update:
2321 	cmn_err(CE_WARN, "!vsw%d: re-configuration failed",
2322 	    vswp->instance);
2323 }
2324 
2325 /*
2326  * Read the port's md properties.
2327  */
2328 static int
2329 vsw_port_read_props(vsw_port_t *portp, vsw_t *vswp,
2330 	md_t *mdp, mde_cookie_t *node)
2331 {
2332 	uint64_t		ldc_id;
2333 	uint8_t			*addrp;
2334 	int			i, addrsz;
2335 	int			num_nodes = 0, nchan = 0;
2336 	int			listsz = 0;
2337 	mde_cookie_t		*listp = NULL;
2338 	struct ether_addr	ea;
2339 	uint64_t		macaddr;
2340 	uint64_t		inst = 0;
2341 	uint64_t		val;
2342 
2343 	if (md_get_prop_val(mdp, *node, id_propname, &inst)) {
2344 		DWARN(vswp, "%s: prop(%s) not found", __func__,
2345 		    id_propname);
2346 		return (1);
2347 	}
2348 
2349 	/*
2350 	 * Find the channel endpoint node(s) (which should be under this
2351 	 * port node) which contain the channel id(s).
2352 	 */
2353 	if ((num_nodes = md_node_count(mdp)) <= 0) {
2354 		DERR(vswp, "%s: invalid number of nodes found (%d)",
2355 		    __func__, num_nodes);
2356 		return (1);
2357 	}
2358 
2359 	D2(vswp, "%s: %d nodes found", __func__, num_nodes);
2360 
2361 	/* allocate enough space for node list */
2362 	listsz = num_nodes * sizeof (mde_cookie_t);
2363 	listp = kmem_zalloc(listsz, KM_SLEEP);
2364 
2365 	nchan = md_scan_dag(mdp, *node, md_find_name(mdp, chan_propname),
2366 	    md_find_name(mdp, "fwd"), listp);
2367 
2368 	if (nchan <= 0) {
2369 		DWARN(vswp, "%s: no %s nodes found", __func__, chan_propname);
2370 		kmem_free(listp, listsz);
2371 		return (1);
2372 	}
2373 
2374 	D2(vswp, "%s: %d %s nodes found", __func__, nchan, chan_propname);
2375 
2376 	/* use property from first node found */
2377 	if (md_get_prop_val(mdp, listp[0], id_propname, &ldc_id)) {
2378 		DWARN(vswp, "%s: prop(%s) not found\n", __func__,
2379 		    id_propname);
2380 		kmem_free(listp, listsz);
2381 		return (1);
2382 	}
2383 
2384 	/* don't need list any more */
2385 	kmem_free(listp, listsz);
2386 
2387 	D2(vswp, "%s: ldc_id 0x%llx", __func__, ldc_id);
2388 
2389 	/* read mac-address property */
2390 	if (md_get_prop_data(mdp, *node, remaddr_propname,
2391 	    &addrp, &addrsz)) {
2392 		DWARN(vswp, "%s: prop(%s) not found",
2393 		    __func__, remaddr_propname);
2394 		return (1);
2395 	}
2396 
2397 	if (addrsz < ETHERADDRL) {
2398 		DWARN(vswp, "%s: invalid address size", __func__);
2399 		return (1);
2400 	}
2401 
2402 	macaddr = *((uint64_t *)addrp);
2403 	D2(vswp, "%s: remote mac address 0x%llx", __func__, macaddr);
2404 
2405 	for (i = ETHERADDRL - 1; i >= 0; i--) {
2406 		ea.ether_addr_octet[i] = macaddr & 0xFF;
2407 		macaddr >>= 8;
2408 	}
2409 
2410 	/* now update all properties into the port */
2411 	portp->p_vswp = vswp;
2412 	portp->p_instance = inst;
2413 	portp->addr_set = B_FALSE;
2414 	ether_copy(&ea, &portp->p_macaddr);
2415 	if (nchan > VSW_PORT_MAX_LDCS) {
2416 		D2(vswp, "%s: using first of %d ldc ids",
2417 		    __func__, nchan);
2418 		nchan = VSW_PORT_MAX_LDCS;
2419 	}
2420 	portp->num_ldcs = nchan;
2421 	portp->ldc_ids =
2422 	    kmem_zalloc(sizeof (uint64_t) * nchan, KM_SLEEP);
2423 	bcopy(&ldc_id, (portp->ldc_ids), sizeof (uint64_t) * nchan);
2424 
2425 	/* read vlan id properties of this port node */
2426 	vsw_vlan_read_ids(portp, VSW_VNETPORT, mdp, *node, &portp->pvid,
2427 	    &portp->vids, &portp->nvids, NULL);
2428 
2429 	/* Check if hybrid property is present */
2430 	if (md_get_prop_val(mdp, *node, hybrid_propname, &val) == 0) {
2431 		D1(vswp, "%s: prop(%s) found\n", __func__, hybrid_propname);
2432 		portp->p_hio_enabled = B_TRUE;
2433 	} else {
2434 		portp->p_hio_enabled = B_FALSE;
2435 	}
2436 	/*
2437 	 * Port hio capability determined after version
2438 	 * negotiation, i.e., when we know the peer is HybridIO capable.
2439 	 */
2440 	portp->p_hio_capable = B_FALSE;
2441 	return (0);
2442 }
2443 
2444 /*
2445  * Add a new port to the system.
2446  *
2447  * Returns 0 on success, 1 on failure.
2448  */
2449 int
2450 vsw_port_add(vsw_t *vswp, md_t *mdp, mde_cookie_t *node)
2451 {
2452 	vsw_port_t	*portp;
2453 	int		rv;
2454 
2455 	portp = kmem_zalloc(sizeof (vsw_port_t), KM_SLEEP);
2456 
2457 	rv = vsw_port_read_props(portp, vswp, mdp, node);
2458 	if (rv != 0) {
2459 		kmem_free(portp, sizeof (*portp));
2460 		return (1);
2461 	}
2462 
2463 	rv = vsw_port_attach(portp);
2464 	if (rv != 0) {
2465 		DERR(vswp, "%s: failed to attach port", __func__);
2466 		return (1);
2467 	}
2468 
2469 	return (0);
2470 }
2471 
2472 static int
2473 vsw_port_update(vsw_t *vswp, md_t *curr_mdp, mde_cookie_t curr_mdex,
2474 	md_t *prev_mdp, mde_cookie_t prev_mdex)
2475 {
2476 	uint64_t	cport_num;
2477 	uint64_t	pport_num;
2478 	vsw_port_list_t	*plistp;
2479 	vsw_port_t	*portp;
2480 	boolean_t	updated_vlans = B_FALSE;
2481 	uint16_t	pvid;
2482 	vsw_vlanid_t	*vids;
2483 	uint16_t	nvids;
2484 	uint64_t	val;
2485 	boolean_t	hio_enabled = B_FALSE;
2486 
2487 	/*
2488 	 * For now, we get port updates only if vlan ids changed.
2489 	 * We read the port num and do some sanity check.
2490 	 */
2491 	if (md_get_prop_val(curr_mdp, curr_mdex, id_propname, &cport_num)) {
2492 		return (1);
2493 	}
2494 
2495 	if (md_get_prop_val(prev_mdp, prev_mdex, id_propname, &pport_num)) {
2496 		return (1);
2497 	}
2498 	if (cport_num != pport_num)
2499 		return (1);
2500 
2501 	plistp = &(vswp->plist);
2502 
2503 	READ_ENTER(&plistp->lockrw);
2504 
2505 	portp = vsw_lookup_port(vswp, cport_num);
2506 	if (portp == NULL) {
2507 		RW_EXIT(&plistp->lockrw);
2508 		return (1);
2509 	}
2510 
2511 	/* Read the vlan ids */
2512 	vsw_vlan_read_ids(portp, VSW_VNETPORT, curr_mdp, curr_mdex, &pvid,
2513 	    &vids, &nvids, NULL);
2514 
2515 	/* Determine if there are any vlan id updates */
2516 	if ((pvid != portp->pvid) ||		/* pvid changed? */
2517 	    (nvids != portp->nvids) ||		/* # of vids changed? */
2518 	    ((nvids != 0) && (portp->nvids != 0) &&	/* vids changed? */
2519 	    !vsw_cmp_vids(vids, portp->vids, nvids))) {
2520 		updated_vlans = B_TRUE;
2521 	}
2522 
2523 	if (updated_vlans == B_TRUE) {
2524 
2525 		/* Remove existing vlan ids from the hash table. */
2526 		vsw_vlan_remove_ids(portp, VSW_VNETPORT);
2527 
2528 		/* Reconfigure vlans with network device */
2529 		vsw_mac_port_reconfig_vlans(portp, pvid, vids, nvids);
2530 
2531 		/* add these new vlan ids into hash table */
2532 		vsw_vlan_add_ids(portp, VSW_VNETPORT);
2533 
2534 		/* reset the port if it is vlan unaware (ver < 1.3) */
2535 		vsw_vlan_unaware_port_reset(portp);
2536 	}
2537 
2538 	/* Check if hybrid property is present */
2539 	if (md_get_prop_val(curr_mdp, curr_mdex, hybrid_propname, &val) == 0) {
2540 		D1(vswp, "%s: prop(%s) found\n", __func__, hybrid_propname);
2541 		hio_enabled = B_TRUE;
2542 	}
2543 
2544 	if (portp->p_hio_enabled != hio_enabled) {
2545 		vsw_hio_port_update(portp, hio_enabled);
2546 	}
2547 
2548 	RW_EXIT(&plistp->lockrw);
2549 
2550 	return (0);
2551 }
2552 
2553 /*
2554  * vsw_mac_rx -- A common function to send packets to the interface.
2555  * By default this function check if the interface is UP or not, the
2556  * rest of the behaviour depends on the flags as below:
2557  *
2558  *	VSW_MACRX_PROMISC -- Check if the promisc mode set or not.
2559  *	VSW_MACRX_COPYMSG -- Make a copy of the message(s).
2560  *	VSW_MACRX_FREEMSG -- Free if the messages cannot be sent up the stack.
2561  */
2562 void
2563 vsw_mac_rx(vsw_t *vswp, mac_resource_handle_t mrh,
2564     mblk_t *mp, vsw_macrx_flags_t flags)
2565 {
2566 	mblk_t		*mpt;
2567 
2568 	D1(vswp, "%s:enter\n", __func__);
2569 	READ_ENTER(&vswp->if_lockrw);
2570 	/* Check if the interface is up */
2571 	if (!(vswp->if_state & VSW_IF_UP)) {
2572 		RW_EXIT(&vswp->if_lockrw);
2573 		/* Free messages only if FREEMSG flag specified */
2574 		if (flags & VSW_MACRX_FREEMSG) {
2575 			freemsgchain(mp);
2576 		}
2577 		D1(vswp, "%s:exit\n", __func__);
2578 		return;
2579 	}
2580 	/*
2581 	 * If PROMISC flag is passed, then check if
2582 	 * the interface is in the PROMISC mode.
2583 	 * If not, drop the messages.
2584 	 */
2585 	if (flags & VSW_MACRX_PROMISC) {
2586 		if (!(vswp->if_state & VSW_IF_PROMISC)) {
2587 			RW_EXIT(&vswp->if_lockrw);
2588 			/* Free messages only if FREEMSG flag specified */
2589 			if (flags & VSW_MACRX_FREEMSG) {
2590 				freemsgchain(mp);
2591 			}
2592 			D1(vswp, "%s:exit\n", __func__);
2593 			return;
2594 		}
2595 	}
2596 	RW_EXIT(&vswp->if_lockrw);
2597 	/*
2598 	 * If COPYMSG flag is passed, then make a copy
2599 	 * of the message chain and send up the copy.
2600 	 */
2601 	if (flags & VSW_MACRX_COPYMSG) {
2602 		mp = copymsgchain(mp);
2603 		if (mp == NULL) {
2604 			D1(vswp, "%s:exit\n", __func__);
2605 			return;
2606 		}
2607 	}
2608 
2609 	D2(vswp, "%s: sending up stack", __func__);
2610 
2611 	mpt = NULL;
2612 	(void) vsw_vlan_frame_untag(vswp, VSW_LOCALDEV, &mp, &mpt);
2613 	if (mp != NULL) {
2614 		mac_rx(vswp->if_mh, mrh, mp);
2615 	}
2616 	D1(vswp, "%s:exit\n", __func__);
2617 }
2618 
2619 /* copy mac address of vsw into soft state structure */
2620 static void
2621 vsw_save_lmacaddr(vsw_t *vswp, uint64_t macaddr)
2622 {
2623 	int	i;
2624 
2625 	WRITE_ENTER(&vswp->if_lockrw);
2626 	for (i = ETHERADDRL - 1; i >= 0; i--) {
2627 		vswp->if_addr.ether_addr_octet[i] = macaddr & 0xFF;
2628 		macaddr >>= 8;
2629 	}
2630 	RW_EXIT(&vswp->if_lockrw);
2631 }
2632 
2633 /* Compare VLAN ids, array size expected to be same. */
2634 static boolean_t
2635 vsw_cmp_vids(vsw_vlanid_t *vids1, vsw_vlanid_t *vids2, int nvids)
2636 {
2637 	int i, j;
2638 	uint16_t vid;
2639 
2640 	for (i = 0; i < nvids; i++) {
2641 		vid = vids1[i].vl_vid;
2642 		for (j = 0; j < nvids; j++) {
2643 			if (vid == vids2[i].vl_vid)
2644 				break;
2645 		}
2646 		if (j == nvids) {
2647 			return (B_FALSE);
2648 		}
2649 	}
2650 	return (B_TRUE);
2651 }
2652