xref: /titanic_52/usr/src/uts/common/io/vnic/vnic_ctl.c (revision 5eb92cf2b27ec0d138dc9e8eedd5b6ecf4cfec0c)
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  * Copyright 2007 Sun Microsystems, Inc.  All rights reserved.
23  * Use is subject to license terms.
24  */
25 
26 #pragma ident	"%Z%%M%	%I%	%E% SMI"
27 
28 /*
29  * Virtual Network Interface Card (VNIC)
30  */
31 
32 #include <sys/ddi.h>
33 #include <sys/strsun.h>
34 #include <sys/dld.h>
35 #include <sys/dld_impl.h>
36 #include <sys/conf.h>
37 #include <sys/modctl.h>
38 #include <sys/stat.h>
39 #include <sys/vnic.h>
40 #include <sys/vnic_impl.h>
41 #include <inet/common.h>
42 
43 /* module description */
44 #define	VNIC_LINKINFO		"VNIC MAC"
45 #define	VNIC_DRIVER_NAME	"vnic"
46 
47 /* device info ptr, only one for instance 0 */
48 static dev_info_t *vnic_dip = NULL;
49 
50 /* for control interface */
51 static int vnic_getinfo(dev_info_t *, ddi_info_cmd_t, void *, void **);
52 static int vnic_attach(dev_info_t *, ddi_attach_cmd_t);
53 static int vnic_detach(dev_info_t *, ddi_detach_cmd_t);
54 static int vnic_open(queue_t *, dev_t *, int, int, cred_t *);
55 static int vnic_close(queue_t *);
56 static void vnic_wput(queue_t *, mblk_t *);
57 
58 typedef struct vnic_taskq_args_s {
59 	queue_t	*tq_vnic_q;
60 	mblk_t	*tq_vnic_mp;
61 	int	tq_vnic_flag;
62 } vnic_taskq_args_t;
63 
64 static void vnic_ioc_create(vnic_taskq_args_t *);
65 static void vnic_ioc_modify(vnic_taskq_args_t *);
66 static void vnic_ioc_delete(vnic_taskq_args_t *);
67 static void vnic_ioc_info(vnic_taskq_args_t *);
68 
69 typedef struct ioc_cmd_s {
70 	int ic_cmd;
71 	void (*ic_func)(vnic_taskq_args_t *);
72 } ioc_cmd_t;
73 
74 static ioc_cmd_t ioc_cmd[] = {
75 	{VNIC_IOC_CREATE, vnic_ioc_create},
76 	{VNIC_IOC_DELETE, vnic_ioc_delete},
77 	{VNIC_IOC_INFO, vnic_ioc_info},
78 	{VNIC_IOC_MODIFY, vnic_ioc_modify}
79 };
80 
81 #define	IOC_CMD_SZ (sizeof (ioc_cmd) / sizeof (ioc_cmd_t))
82 
83 /*
84  * mi_hiwat is set to 1 because of the flow control mechanism implemented
85  * in dld. refer to the comments in dld_str.c for details.
86  */
87 static struct module_info vnic_module_info = {
88 	0,
89 	VNIC_DRIVER_NAME,
90 	0,
91 	INFPSZ,
92 	1,
93 	0
94 };
95 
96 static struct qinit vnic_r_qinit = {	/* read queues */
97 	NULL,
98 	NULL,
99 	vnic_open,
100 	vnic_close,
101 	NULL,
102 	&vnic_module_info
103 };
104 
105 static struct qinit vnic_w_qinit = {	/* write queues */
106 	(pfi_t)dld_wput,
107 	(pfi_t)dld_wsrv,
108 	NULL,
109 	NULL,
110 	NULL,
111 	&vnic_module_info
112 };
113 
114 /*
115  * Entry points for vnic control node
116  */
117 static struct qinit vnic_w_ctl_qinit = {
118 	(pfi_t)vnic_wput,
119 	NULL,
120 	NULL,
121 	NULL,
122 	NULL,
123 	&vnic_module_info
124 };
125 
126 static struct streamtab vnic_streamtab = {
127 	&vnic_r_qinit,
128 	&vnic_w_qinit
129 };
130 
131 DDI_DEFINE_STREAM_OPS(vnic_dev_ops, nulldev, nulldev, vnic_attach, vnic_detach,
132     nodev, vnic_getinfo, D_MP, &vnic_streamtab);
133 
134 static struct modldrv vnic_modldrv = {
135 	&mod_driverops,		/* Type of module.  This one is a driver */
136 	VNIC_LINKINFO,		/* short description */
137 	&vnic_dev_ops		/* driver specific ops */
138 };
139 
140 static struct modlinkage modlinkage = {
141 	MODREV_1,
142 	&vnic_modldrv,
143 	NULL
144 };
145 
146 int
147 _init(void)
148 {
149 	return (mod_install(&modlinkage));
150 }
151 
152 int
153 _fini(void)
154 {
155 	return (mod_remove(&modlinkage));
156 }
157 
158 int
159 _info(struct modinfo *modinfop)
160 {
161 	return (mod_info(&modlinkage, modinfop));
162 }
163 
164 static int
165 vnic_open(queue_t *q, dev_t *devp, int flag, int sflag, cred_t *credp)
166 {
167 	if (q->q_ptr != NULL)
168 		return (EBUSY);
169 
170 	if (getminor(*devp) == VNIC_CTL_NODE_MINOR) {
171 		dld_str_t	*dsp;
172 
173 		dsp = dld_str_create(q, DLD_CONTROL, getmajor(*devp),
174 		    DL_STYLE1);
175 		if (dsp == NULL)
176 			return (ENOSR);
177 
178 		/*
179 		 * The VNIC control node uses its own set of entry points.
180 		 */
181 		WR(q)->q_qinfo = &vnic_w_ctl_qinit;
182 		*devp = makedevice(getmajor(*devp), dsp->ds_minor);
183 		qprocson(q);
184 		return (0);
185 	}
186 	return (dld_open(q, devp, flag, sflag, credp));
187 }
188 
189 static int
190 vnic_close(queue_t *q)
191 {
192 	dld_str_t	*dsp = q->q_ptr;
193 
194 	if (dsp->ds_type == DLD_CONTROL) {
195 		qprocsoff(q);
196 		dld_str_destroy(dsp);
197 		return (0);
198 	}
199 	return (dld_close(q));
200 }
201 
202 void
203 vnic_ioctl(queue_t *wq, mblk_t *mp)
204 {
205 	/* LINTED alignment */
206 	struct iocblk *iocp = (struct iocblk *)mp->b_rptr;
207 	int i, err = 0;
208 	mblk_t *nmp;
209 	void (*func)();
210 	vnic_taskq_args_t *taskq_args;
211 
212 	if (mp->b_cont == NULL) {
213 		err = EINVAL;
214 		goto done;
215 	}
216 
217 	/*
218 	 * Construct contiguous message
219 	 */
220 	if ((nmp = msgpullup(mp->b_cont, -1)) == NULL) {
221 		freemsg(mp->b_cont);
222 		err = ENOMEM;
223 		goto done;
224 	}
225 
226 	freemsg(mp->b_cont);
227 	mp->b_cont = nmp;
228 
229 	for (i = 0; i < IOC_CMD_SZ; i++) {
230 		if (iocp->ioc_cmd == ioc_cmd[i].ic_cmd) {
231 			func = ioc_cmd[i].ic_func;
232 			break;
233 		}
234 	}
235 
236 	if (i == IOC_CMD_SZ) {
237 		freemsg(mp->b_cont);
238 		err = EINVAL;
239 		goto done;
240 	}
241 
242 	taskq_args = kmem_zalloc(sizeof (vnic_taskq_args_t), KM_NOSLEEP);
243 	if (taskq_args == NULL) {
244 		freemsg(mp->b_cont);
245 		err = ENOMEM;
246 		goto done;
247 	}
248 
249 	taskq_args->tq_vnic_q = wq;
250 	taskq_args->tq_vnic_mp = mp;
251 	taskq_args->tq_vnic_flag = (int)iocp->ioc_flag;
252 	if (taskq_dispatch(system_taskq,
253 	    func, taskq_args, TQ_NOSLEEP) == NULL) {
254 		kmem_free(taskq_args, sizeof (vnic_taskq_args_t));
255 		freemsg(mp->b_cont);
256 		err = ENOMEM;
257 		goto done;
258 	}
259 
260 done:
261 	if (err != 0)
262 		miocnak(wq, mp, 0, err);
263 }
264 
265 static void
266 vnic_wput(queue_t *q, mblk_t *mp)
267 {
268 	if (DB_TYPE(mp) == M_IOCTL)
269 		vnic_ioctl(q, mp);
270 	else
271 		freemsg(mp);
272 }
273 
274 static void
275 vnic_init(void)
276 {
277 	vnic_dev_init();
278 	vnic_bcast_init();
279 	vnic_classifier_init();
280 }
281 
282 static void
283 vnic_fini(void)
284 {
285 	vnic_dev_fini();
286 	vnic_bcast_fini();
287 	vnic_classifier_fini();
288 }
289 
290 dev_info_t *
291 vnic_get_dip(void)
292 {
293 	return (vnic_dip);
294 }
295 
296 /*ARGSUSED*/
297 static int
298 vnic_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
299     void **result)
300 {
301 	switch (infocmd) {
302 	case DDI_INFO_DEVT2DEVINFO:
303 		*result = vnic_dip;
304 		return (DDI_SUCCESS);
305 	case DDI_INFO_DEVT2INSTANCE:
306 		*result = NULL;
307 		return (DDI_SUCCESS);
308 	}
309 	return (DDI_FAILURE);
310 }
311 
312 static int
313 vnic_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
314 {
315 	switch (cmd) {
316 	case DDI_ATTACH:
317 		if (ddi_get_instance(dip) != 0) {
318 			/* we only allow instance 0 to attach */
319 			return (DDI_FAILURE);
320 		}
321 
322 		/* create minor node for control interface */
323 		if (ddi_create_minor_node(dip, VNIC_CTL_NODE_NAME, S_IFCHR,
324 		    VNIC_CTL_NODE_MINOR, DDI_PSEUDO, 0) != DDI_SUCCESS) {
325 			return (DDI_FAILURE);
326 		}
327 
328 		vnic_dip = dip;
329 		vnic_init();
330 
331 		return (DDI_SUCCESS);
332 
333 	case DDI_RESUME:
334 		return (DDI_SUCCESS);
335 
336 	default:
337 		return (DDI_FAILURE);
338 	}
339 }
340 
341 /*ARGSUSED*/
342 static int
343 vnic_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
344 {
345 	switch (cmd) {
346 	case DDI_DETACH:
347 		/*
348 		 * Allow the VNIC instance to be detached only if there
349 		 * are not VNICs configured.
350 		 */
351 		if (vnic_dev_count() > 0)
352 			return (DDI_FAILURE);
353 
354 		vnic_dip = NULL;
355 		vnic_fini();
356 		ddi_remove_minor_node(dip, VNIC_CTL_NODE_NAME);
357 
358 		return (DDI_SUCCESS);
359 
360 	case DDI_SUSPEND:
361 		return (DDI_SUCCESS);
362 
363 	default:
364 		return (DDI_FAILURE);
365 	}
366 }
367 
368 /*
369  * Process a VNICIOC_CREATE request.
370  */
371 static void
372 vnic_ioc_create(vnic_taskq_args_t *taskq_args)
373 {
374 	STRUCT_HANDLE(vnic_ioc_create, create_arg);
375 	queue_t *wq = taskq_args->tq_vnic_q;
376 	mblk_t *mp = taskq_args->tq_vnic_mp;
377 	int mode = taskq_args->tq_vnic_flag;
378 	int rc = 0;
379 	int mac_len;
380 	uchar_t mac_addr[MAXMACADDRLEN];
381 	uint_t vnic_id;
382 	char dev_name[MAXNAMELEN + 1];
383 	vnic_mac_addr_type_t mac_addr_type;
384 
385 	kmem_free(taskq_args, sizeof (vnic_taskq_args_t));
386 	STRUCT_SET_HANDLE(create_arg, mode, (void *)mp->b_cont->b_rptr);
387 	if (MBLKL(mp->b_cont) < STRUCT_SIZE(create_arg)) {
388 		rc = EINVAL;
389 		goto bail;
390 	}
391 
392 	/*
393 	 * VNIC id. For now it is specified by the user. Once we have
394 	 * vanity naming, we can pick a value for the user, and let
395 	 * the user assign a generic name to the VNIC (XXXND)
396 	 */
397 	vnic_id = STRUCT_FGET(create_arg, vc_vnic_id);
398 
399 	/*
400 	 * Device name and number of the MAC port the VNIC is defined
401 	 * on top of.
402 	 */
403 	bcopy(STRUCT_FGET(create_arg, vc_dev_name), dev_name, MAXNAMELEN);
404 
405 	/* MAC address */
406 	mac_addr_type = STRUCT_FGET(create_arg, vc_mac_addr_type);
407 	mac_len = STRUCT_FGET(create_arg, vc_mac_len);
408 
409 	switch (mac_addr_type) {
410 	case VNIC_MAC_ADDR_TYPE_FIXED:
411 		bcopy(STRUCT_FGET(create_arg, vc_mac_addr), mac_addr,
412 		    MAXMACADDRLEN);
413 		break;
414 	default:
415 		rc = ENOTSUP;
416 		goto bail;
417 	}
418 
419 	rc = vnic_dev_create(vnic_id, dev_name, mac_len, mac_addr);
420 	if (rc != 0) {
421 		cmn_err(CE_WARN, "vnic_dev_create failed with %d", rc);
422 		goto bail;
423 	}
424 
425 bail:
426 	freemsg(mp->b_cont);
427 	mp->b_cont = NULL;
428 	if (rc != 0)
429 		miocnak(wq, mp, 0, rc);
430 	else
431 		miocack(wq, mp, 0, 0);
432 }
433 
434 static void
435 vnic_ioc_modify(vnic_taskq_args_t *taskq_args)
436 {
437 	STRUCT_HANDLE(vnic_ioc_modify, modify_arg);
438 	queue_t *wq = taskq_args->tq_vnic_q;
439 	mblk_t *mp = taskq_args->tq_vnic_mp;
440 	int mode = taskq_args->tq_vnic_flag;
441 	int err = 0;
442 	uint_t vnic_id;
443 	uint_t modify_mask;
444 	vnic_mac_addr_type_t mac_addr_type;
445 	uint_t mac_len;
446 	uchar_t mac_addr[MAXMACADDRLEN];
447 
448 	kmem_free(taskq_args, sizeof (vnic_taskq_args_t));
449 	STRUCT_SET_HANDLE(modify_arg, mode, (void *)mp->b_cont->b_rptr);
450 	if (MBLKL(mp->b_cont) < STRUCT_SIZE(modify_arg)) {
451 		err = EINVAL;
452 		goto done;
453 	}
454 
455 	vnic_id = STRUCT_FGET(modify_arg, vm_vnic_id);
456 	modify_mask = STRUCT_FGET(modify_arg, vm_modify_mask);
457 
458 	if (modify_mask & VNIC_IOC_MODIFY_ADDR) {
459 		mac_addr_type = STRUCT_FGET(modify_arg, vm_mac_addr_type);
460 		mac_len = STRUCT_FGET(modify_arg, vm_mac_len);
461 		bcopy(STRUCT_FGET(modify_arg, vm_mac_addr), mac_addr,
462 		    MAXMACADDRLEN);
463 	}
464 
465 	err = vnic_dev_modify(vnic_id, modify_mask, mac_addr_type,
466 	    mac_len, mac_addr);
467 done:
468 	freemsg(mp->b_cont);
469 	mp->b_cont = NULL;
470 	if (err != 0)
471 		miocnak(wq, mp, 0, err);
472 	else
473 		miocack(wq, mp, 0, 0);
474 }
475 
476 static void
477 vnic_ioc_delete(vnic_taskq_args_t *taskq_args)
478 {
479 	STRUCT_HANDLE(vnic_ioc_delete, delete_arg);
480 	queue_t *wq = taskq_args->tq_vnic_q;
481 	mblk_t *mp = taskq_args->tq_vnic_mp;
482 	int mode = taskq_args->tq_vnic_flag;
483 	uint_t vnic_id;
484 	int err = 0;
485 
486 	kmem_free(taskq_args, sizeof (vnic_taskq_args_t));
487 	STRUCT_SET_HANDLE(delete_arg, mode, (void *)mp->b_cont->b_rptr);
488 	if (STRUCT_SIZE(delete_arg) > MBLKL(mp)) {
489 		err = EINVAL;
490 		goto fail;
491 	}
492 
493 	vnic_id = STRUCT_FGET(delete_arg, vd_vnic_id);
494 	err = vnic_dev_delete(vnic_id);
495 
496 fail:
497 	freemsg(mp->b_cont);
498 	mp->b_cont = NULL;
499 	if (err != 0)
500 		miocnak(wq, mp, 0, err);
501 	else
502 		miocack(wq, mp, 0, err);
503 }
504 
505 typedef struct vnic_ioc_info_state {
506 	uint32_t bytes_left;
507 	uchar_t *where;
508 } vnic_ioc_info_state_t;
509 
510 static int
511 vnic_ioc_info_new_vnic(void *arg, uint32_t id, vnic_mac_addr_type_t addr_type,
512     uint_t mac_len, uint8_t *mac_addr, char *dev_name)
513 {
514 	vnic_ioc_info_state_t *state = arg;
515 	/*LINTED*/
516 	vnic_ioc_info_vnic_t *vn = (vnic_ioc_info_vnic_t *)state->where;
517 
518 	if (state->bytes_left < sizeof (*vn))
519 		return (ENOSPC);
520 
521 	vn->vn_vnic_id = id;
522 	vn->vn_mac_addr_type = addr_type;
523 	vn->vn_mac_len = mac_len;
524 	bcopy(mac_addr, &(vn->vn_mac_addr), mac_len);
525 	bcopy(dev_name, &(vn->vn_dev_name), MAXNAMELEN);
526 
527 	state->where += sizeof (*vn);
528 	state->bytes_left -= sizeof (*vn);
529 
530 	return (0);
531 }
532 
533 static void
534 vnic_ioc_info(vnic_taskq_args_t *taskq_args)
535 {
536 	queue_t *wq = taskq_args->tq_vnic_q;
537 	mblk_t *mp = taskq_args->tq_vnic_mp;
538 	vnic_ioc_info_t *info_argp;
539 	int rc, len;
540 	uint32_t nvnics, vnic_id;
541 	char dev_name[MAXNAMELEN];
542 	vnic_ioc_info_state_t state;
543 
544 	kmem_free(taskq_args, sizeof (vnic_taskq_args_t));
545 	if ((len = MBLKL(mp->b_cont)) < sizeof (*info_argp)) {
546 		rc = EINVAL;
547 		goto bail;
548 	}
549 
550 	/* LINTED alignment */
551 	info_argp = (vnic_ioc_info_t *)mp->b_cont->b_rptr;
552 
553 	/*
554 	 * ID of the vnic to return or vnic device.
555 	 * If zero, the call returns information
556 	 * regarding all vnics currently defined.
557 	 */
558 	vnic_id = info_argp->vi_vnic_id;
559 	if (info_argp->vi_dev_name)
560 		bcopy(info_argp->vi_dev_name, dev_name, MAXNAMELEN);
561 
562 	state.bytes_left = len - sizeof (vnic_ioc_info_t);
563 	state.where = (uchar_t *)(info_argp +1);
564 
565 	rc = vnic_info(&nvnics, vnic_id, dev_name, &state,
566 	    vnic_ioc_info_new_vnic);
567 
568 bail:
569 	if (rc == 0) {
570 		info_argp->vi_nvnics = nvnics;
571 		miocack(wq, mp, len, 0);
572 	} else {
573 		freemsg(mp->b_cont);
574 		mp->b_cont = NULL;
575 		miocnak(wq, mp, 0, rc);
576 	}
577 }
578