/* * CDDL HEADER START * * The contents of this file are subject to the terms of the * Common Development and Distribution License (the "License"). * You may not use this file except in compliance with the License. * * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE * or http://www.opensolaris.org/os/licensing. * See the License for the specific language governing permissions * and limitations under the License. * * When distributing Covered Code, include this CDDL HEADER in each * file and include the License file at usr/src/OPENSOLARIS.LICENSE. * If applicable, add the following below this CDDL HEADER, with the * fields enclosed by brackets "[]" replaced with your own identifying * information: Portions Copyright [yyyy] [name of copyright owner] * * CDDL HEADER END */ /* * Copyright 2007 Sun Microsystems, Inc. All rights reserved. * Use is subject to license terms. */ #pragma ident "%Z%%M% %I% %E% SMI" /* * Data-Link Driver */ #include #include #include #include #include #include #include #include #include #include /* * dld control node state, one per open control node session. */ typedef struct dld_ctl_str_s { minor_t cs_minor; queue_t *cs_wq; } dld_ctl_str_t; static void drv_init(void); static int drv_fini(void); static int drv_getinfo(dev_info_t *, ddi_info_cmd_t, void *, void **); static int drv_attach(dev_info_t *, ddi_attach_cmd_t); static int drv_detach(dev_info_t *, ddi_detach_cmd_t); /* * Secure objects declarations */ #define SECOBJ_WEP_HASHSZ 67 static krwlock_t drv_secobj_lock; static kmem_cache_t *drv_secobj_cachep; static mod_hash_t *drv_secobj_hash; static void drv_secobj_init(void); static void drv_secobj_fini(void); static void drv_ioc_secobj_set(dld_ctl_str_t *, mblk_t *); static void drv_ioc_secobj_get(dld_ctl_str_t *, mblk_t *); static void drv_ioc_secobj_unset(dld_ctl_str_t *, mblk_t *); /* * The following entry points are private to dld and are used for control * operations only. The entry points exported to mac drivers are defined * in dld_str.c. Refer to the comment on top of dld_str.c for details. */ static int drv_open(queue_t *, dev_t *, int, int, cred_t *); static int drv_close(queue_t *); static void drv_uw_put(queue_t *, mblk_t *); static void drv_uw_srv(queue_t *); dev_info_t *dld_dip; /* dev_info_t for the driver */ uint32_t dld_opt = 0; /* Global options */ static vmem_t *dld_ctl_vmem; /* for control minor numbers */ static struct module_info drv_info = { 0, /* mi_idnum */ DLD_DRIVER_NAME, /* mi_idname */ 0, /* mi_minpsz */ (64 * 1024), /* mi_maxpsz */ 1, /* mi_hiwat */ 0 /* mi_lowat */ }; static struct qinit drv_ur_init = { NULL, /* qi_putp */ NULL, /* qi_srvp */ drv_open, /* qi_qopen */ drv_close, /* qi_qclose */ NULL, /* qi_qadmin */ &drv_info, /* qi_minfo */ NULL /* qi_mstat */ }; static struct qinit drv_uw_init = { (pfi_t)drv_uw_put, /* qi_putp */ (pfi_t)drv_uw_srv, /* qi_srvp */ NULL, /* qi_qopen */ NULL, /* qi_qclose */ NULL, /* qi_qadmin */ &drv_info, /* qi_minfo */ NULL /* qi_mstat */ }; static struct streamtab drv_stream = { &drv_ur_init, /* st_rdinit */ &drv_uw_init, /* st_wrinit */ NULL, /* st_muxrinit */ NULL /* st_muxwinit */ }; DDI_DEFINE_STREAM_OPS(drv_ops, nulldev, nulldev, drv_attach, drv_detach, nodev, drv_getinfo, D_MP, &drv_stream); /* * Module linkage information for the kernel. */ extern struct mod_ops mod_driverops; static struct modldrv drv_modldrv = { &mod_driverops, DLD_INFO, &drv_ops }; static struct modlinkage drv_modlinkage = { MODREV_1, &drv_modldrv, NULL }; int _init(void) { int err; drv_init(); if ((err = mod_install(&drv_modlinkage)) != 0) return (err); return (0); } int _fini(void) { int err; if ((err = mod_remove(&drv_modlinkage)) != 0) return (err); if (drv_fini() != 0) { (void) mod_install(&drv_modlinkage); return (DDI_FAILURE); } return (err); } int _info(struct modinfo *modinfop) { return (mod_info(&drv_modlinkage, modinfop)); } /* * Initialize component modules. */ static void drv_init(void) { dld_ctl_vmem = vmem_create("dld_ctl", (void *)1, MAXMIN, 1, NULL, NULL, NULL, 1, VM_SLEEP | VMC_IDENTIFIER); drv_secobj_init(); dld_str_init(); } static int drv_fini(void) { int err; if ((err = dld_str_fini()) != 0) return (err); drv_secobj_fini(); vmem_destroy(dld_ctl_vmem); return (0); } /* * devo_getinfo: getinfo(9e) */ /*ARGSUSED*/ static int drv_getinfo(dev_info_t *dip, ddi_info_cmd_t cmd, void *arg, void **resp) { if (dld_dip == NULL) return (DDI_FAILURE); switch (cmd) { case DDI_INFO_DEVT2INSTANCE: *resp = (void *)0; break; case DDI_INFO_DEVT2DEVINFO: *resp = (void *)dld_dip; break; default: return (DDI_FAILURE); } return (DDI_SUCCESS); } /* * Check properties to set options. (See dld.h for property definitions). */ static void drv_set_opt(dev_info_t *dip) { if (ddi_prop_get_int(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS, DLD_PROP_NO_FASTPATH, 0) != 0) { dld_opt |= DLD_OPT_NO_FASTPATH; } if (ddi_prop_get_int(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS, DLD_PROP_NO_POLL, 0) != 0) { dld_opt |= DLD_OPT_NO_POLL; } if (ddi_prop_get_int(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS, DLD_PROP_NO_ZEROCOPY, 0) != 0) { dld_opt |= DLD_OPT_NO_ZEROCOPY; } if (ddi_prop_get_int(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS, DLD_PROP_NO_SOFTRING, 0) != 0) { dld_opt |= DLD_OPT_NO_SOFTRING; } } /* * devo_attach: attach(9e) */ static int drv_attach(dev_info_t *dip, ddi_attach_cmd_t cmd) { if (cmd != DDI_ATTACH) return (DDI_FAILURE); ASSERT(ddi_get_instance(dip) == 0); drv_set_opt(dip); /* * Create control node. DLPI provider nodes will be created on demand. */ if (ddi_create_minor_node(dip, DLD_CONTROL_MINOR_NAME, S_IFCHR, DLD_CONTROL_MINOR, DDI_PSEUDO, 0) != DDI_SUCCESS) return (DDI_FAILURE); dld_dip = dip; /* * Log the fact that the driver is now attached. */ ddi_report_dev(dip); return (DDI_SUCCESS); } /* * devo_detach: detach(9e) */ static int drv_detach(dev_info_t *dip, ddi_detach_cmd_t cmd) { if (cmd != DDI_DETACH) return (DDI_FAILURE); ASSERT(dld_dip == dip); /* * Remove the control node. */ ddi_remove_minor_node(dip, DLD_CONTROL_MINOR_NAME); dld_dip = NULL; return (DDI_SUCCESS); } /* * dld control node open procedure. */ /*ARGSUSED*/ static int drv_open(queue_t *rq, dev_t *devp, int flag, int sflag, cred_t *credp) { dld_ctl_str_t *ctls; minor_t minor; queue_t *oq = OTHERQ(rq); if (sflag == MODOPEN) return (ENOTSUP); /* * This is a cloning driver and therefore each queue should only * ever get opened once. */ if (rq->q_ptr != NULL) return (EBUSY); minor = (minor_t)(uintptr_t)vmem_alloc(dld_ctl_vmem, 1, VM_NOSLEEP); if (minor == 0) return (ENOMEM); ctls = kmem_zalloc(sizeof (dld_ctl_str_t), KM_NOSLEEP); if (ctls == NULL) { vmem_free(dld_ctl_vmem, (void *)(uintptr_t)minor, 1); return (ENOMEM); } ctls->cs_minor = minor; ctls->cs_wq = WR(rq); rq->q_ptr = ctls; oq->q_ptr = ctls; /* * Enable the queue srv(9e) routine. */ qprocson(rq); /* * Construct a cloned dev_t to hand back. */ *devp = makedevice(getmajor(*devp), ctls->cs_minor); return (0); } /* * dld control node close procedure. */ static int drv_close(queue_t *rq) { dld_ctl_str_t *ctls; ctls = rq->q_ptr; ASSERT(ctls != NULL); /* * Disable the queue srv(9e) routine. */ qprocsoff(rq); vmem_free(dld_ctl_vmem, (void *)(uintptr_t)ctls->cs_minor, 1); kmem_free(ctls, sizeof (dld_ctl_str_t)); return (0); } /* * DLDIOCATTR */ static void drv_ioc_attr(dld_ctl_str_t *ctls, mblk_t *mp) { dld_ioc_attr_t *diap; dls_vlan_t *dvp = NULL; dls_link_t *dlp = NULL; int err; queue_t *q = ctls->cs_wq; if ((err = miocpullup(mp, sizeof (dld_ioc_attr_t))) != 0) goto failed; diap = (dld_ioc_attr_t *)mp->b_cont->b_rptr; diap->dia_name[IFNAMSIZ - 1] = '\0'; if (dls_vlan_hold(diap->dia_name, &dvp, B_FALSE) != 0) { err = ENOENT; goto failed; } dlp = dvp->dv_dlp; (void) strlcpy(diap->dia_dev, dlp->dl_name, sizeof (diap->dia_dev)); diap->dia_vid = dvp->dv_id; diap->dia_max_sdu = dlp->dl_mip->mi_sdu_max; dls_vlan_rele(dvp); miocack(q, mp, sizeof (dld_ioc_attr_t), 0); return; failed: ASSERT(err != 0); if (err == ENOENT) { char devname[MAXNAMELEN]; uint_t instance; major_t major; /* * Try to detect if the specified device is gldv3 * and return ENODEV if it is not. */ if (ddi_parse(diap->dia_name, devname, &instance) == 0 && (major = ddi_name_to_major(devname)) != (major_t)-1 && !GLDV3_DRV(major)) err = ENODEV; } miocnak(q, mp, 0, err); } /* * DLDIOCVLAN */ typedef struct dld_ioc_vlan_state { uint_t bytes_left; dld_ioc_vlan_t *divp; dld_vlan_info_t *vlanp; } dld_ioc_vlan_state_t; static int drv_ioc_vlan_info(dls_vlan_t *dvp, void *arg) { dld_ioc_vlan_state_t *statep = arg; /* * passed buffer space is limited to 65536 bytes. So * copy only the vlans associated with the passed link. */ if (strcmp(dvp->dv_dlp->dl_name, statep->divp->div_name) == 0 && dvp->dv_id != 0) { if (statep->bytes_left < sizeof (dld_vlan_info_t)) return (ENOSPC); (void) strlcpy(statep->vlanp->dvi_name, dvp->dv_name, IFNAMSIZ); statep->divp->div_count++; statep->bytes_left -= sizeof (dld_vlan_info_t); statep->vlanp += 1; } return (0); } static void drv_ioc_vlan(dld_ctl_str_t *ctls, mblk_t *mp) { dld_ioc_vlan_t *divp; dld_ioc_vlan_state_t state; int err = EINVAL; queue_t *q = ctls->cs_wq; mblk_t *bp; if ((err = miocpullup(mp, sizeof (dld_ioc_vlan_t))) != 0) goto failed; if ((bp = msgpullup(mp->b_cont, -1)) == NULL) goto failed; freemsg(mp->b_cont); mp->b_cont = bp; divp = (dld_ioc_vlan_t *)bp->b_rptr; divp->div_count = 0; state.bytes_left = MBLKL(bp) - sizeof (dld_ioc_vlan_t); state.divp = divp; state.vlanp = (dld_vlan_info_t *)(divp + 1); err = dls_vlan_walk(drv_ioc_vlan_info, &state); if (err != 0) goto failed; miocack(q, mp, sizeof (dld_ioc_vlan_t) + state.divp->div_count * sizeof (dld_vlan_info_t), 0); return; failed: ASSERT(err != 0); miocnak(q, mp, 0, err); } /* * DLDIOCHOLDVLAN */ static void drv_hold_vlan(dld_ctl_str_t *ctls, mblk_t *mp) { queue_t *q = ctls->cs_wq; dld_hold_vlan_t *dhv; mblk_t *nmp; int err = EINVAL; dls_vlan_t *dvp; char mac[MAXNAMELEN]; dev_info_t *dip = NULL; major_t major; uint_t index; nmp = mp->b_cont; if (nmp == NULL || MBLKL(nmp) < sizeof (dld_hold_vlan_t)) goto failed; dhv = (dld_hold_vlan_t *)nmp->b_rptr; /* * When a device instance without opens is detached, its * dls_vlan_t will be destroyed. A subsequent DLDIOCHOLDVLAN * invoked on this device instance will fail because * dls_vlan_hold() does not create non-tagged vlans on demand. * To handle this problem, we must force the creation of the * dls_vlan_t (if it doesn't already exist) by calling * ddi_hold_devi_by_instance() before calling dls_vlan_hold(). */ if (ddi_parse(dhv->dhv_name, mac, &index) != DDI_SUCCESS) goto failed; if (DLS_PPA2VID(index) == VLAN_ID_NONE && strcmp(mac, "aggr") != 0) { if ((major = ddi_name_to_major(mac)) == (major_t)-1 || (dip = ddi_hold_devi_by_instance(major, DLS_PPA2INST(index), 0)) == NULL) goto failed; } err = dls_vlan_hold(dhv->dhv_name, &dvp, B_TRUE); if (dip != NULL) ddi_release_devi(dip); if (err != 0) goto failed; if ((err = dls_vlan_setzoneid(dhv->dhv_name, dhv->dhv_zid, dhv->dhv_docheck)) != 0) { dls_vlan_rele(dvp); goto failed; } else { miocack(q, mp, 0, 0); return; } failed: miocnak(q, mp, 0, err); } /* * DLDIOCRELEVLAN */ static void drv_rele_vlan(dld_ctl_str_t *ctls, mblk_t *mp) { queue_t *q = ctls->cs_wq; dld_hold_vlan_t *dhv; mblk_t *nmp; int err; nmp = mp->b_cont; if (nmp == NULL || MBLKL(nmp) < sizeof (dld_hold_vlan_t)) { err = EINVAL; miocnak(q, mp, 0, err); return; } dhv = (dld_hold_vlan_t *)nmp->b_rptr; if ((err = dls_vlan_setzoneid(dhv->dhv_name, dhv->dhv_zid, dhv->dhv_docheck)) != 0) { miocnak(q, mp, 0, err); return; } if ((err = dls_vlan_rele_by_name(dhv->dhv_name)) != 0) { miocnak(q, mp, 0, err); return; } miocack(q, mp, 0, 0); } /* * DLDIOCZIDGET */ static void drv_ioc_zid_get(dld_ctl_str_t *ctls, mblk_t *mp) { queue_t *q = ctls->cs_wq; dld_hold_vlan_t *dhv; mblk_t *nmp; int err; nmp = mp->b_cont; if (nmp == NULL || MBLKL(nmp) < sizeof (dld_hold_vlan_t)) { err = EINVAL; miocnak(q, mp, 0, err); return; } dhv = (dld_hold_vlan_t *)nmp->b_rptr; if ((err = dls_vlan_getzoneid(dhv->dhv_name, &dhv->dhv_zid)) != 0) miocnak(q, mp, 0, err); else miocack(q, mp, sizeof (dld_hold_vlan_t), 0); } /* * Process an IOCTL message received by the control node. */ static void drv_ioc(dld_ctl_str_t *ctls, mblk_t *mp) { uint_t cmd; cmd = ((struct iocblk *)mp->b_rptr)->ioc_cmd; switch (cmd) { case DLDIOCATTR: drv_ioc_attr(ctls, mp); return; case DLDIOCVLAN: drv_ioc_vlan(ctls, mp); return; case DLDIOCSECOBJSET: drv_ioc_secobj_set(ctls, mp); return; case DLDIOCSECOBJGET: drv_ioc_secobj_get(ctls, mp); return; case DLDIOCSECOBJUNSET: drv_ioc_secobj_unset(ctls, mp); return; case DLDIOCHOLDVLAN: drv_hold_vlan(ctls, mp); return; case DLDIOCRELEVLAN: drv_rele_vlan(ctls, mp); return; case DLDIOCZIDGET: drv_ioc_zid_get(ctls, mp); return; default: miocnak(ctls->cs_wq, mp, 0, ENOTSUP); return; } } /* * Write side put routine of the dld control node. */ static void drv_uw_put(queue_t *q, mblk_t *mp) { dld_ctl_str_t *ctls = q->q_ptr; switch (mp->b_datap->db_type) { case M_IOCTL: drv_ioc(ctls, mp); break; default: freemsg(mp); break; } } /* * Write-side service procedure. */ void drv_uw_srv(queue_t *q) { mblk_t *mp; while (mp = getq(q)) drv_uw_put(q, mp); } /* * Secure objects implementation */ /* ARGSUSED */ static int drv_secobj_ctor(void *buf, void *arg, int kmflag) { bzero(buf, sizeof (dld_secobj_t)); return (0); } static void drv_secobj_init(void) { rw_init(&drv_secobj_lock, NULL, RW_DEFAULT, NULL); drv_secobj_cachep = kmem_cache_create("drv_secobj_cache", sizeof (dld_secobj_t), 0, drv_secobj_ctor, NULL, NULL, NULL, NULL, 0); drv_secobj_hash = mod_hash_create_extended("drv_secobj_hash", SECOBJ_WEP_HASHSZ, mod_hash_null_keydtor, mod_hash_null_valdtor, mod_hash_bystr, NULL, mod_hash_strkey_cmp, KM_SLEEP); } static void drv_secobj_fini(void) { mod_hash_destroy_hash(drv_secobj_hash); kmem_cache_destroy(drv_secobj_cachep); rw_destroy(&drv_secobj_lock); } static void drv_ioc_secobj_set(dld_ctl_str_t *ctls, mblk_t *mp) { dld_ioc_secobj_set_t *ssp; dld_secobj_t *sobjp, *objp; int err = EINVAL; queue_t *q = ctls->cs_wq; if ((err = miocpullup(mp, sizeof (dld_ioc_secobj_set_t))) != 0) goto failed; ssp = (dld_ioc_secobj_set_t *)mp->b_cont->b_rptr; sobjp = &ssp->ss_obj; if (sobjp->so_class != DLD_SECOBJ_CLASS_WEP && sobjp->so_class != DLD_SECOBJ_CLASS_WPA) goto failed; if (sobjp->so_name[DLD_SECOBJ_NAME_MAX - 1] != '\0' || sobjp->so_len > DLD_SECOBJ_VAL_MAX) goto failed; rw_enter(&drv_secobj_lock, RW_WRITER); err = mod_hash_find(drv_secobj_hash, (mod_hash_key_t)sobjp->so_name, (mod_hash_val_t *)&objp); if (err == 0) { if ((ssp->ss_flags & DLD_SECOBJ_OPT_CREATE) != 0) { err = EEXIST; rw_exit(&drv_secobj_lock); goto failed; } } else { ASSERT(err == MH_ERR_NOTFOUND); if ((ssp->ss_flags & DLD_SECOBJ_OPT_CREATE) == 0) { err = ENOENT; rw_exit(&drv_secobj_lock); goto failed; } objp = kmem_cache_alloc(drv_secobj_cachep, KM_SLEEP); (void) strlcpy(objp->so_name, sobjp->so_name, DLD_SECOBJ_NAME_MAX); err = mod_hash_insert(drv_secobj_hash, (mod_hash_key_t)objp->so_name, (mod_hash_val_t)objp); ASSERT(err == 0); } bcopy(sobjp->so_val, objp->so_val, sobjp->so_len); objp->so_len = sobjp->so_len; objp->so_class = sobjp->so_class; rw_exit(&drv_secobj_lock); miocack(q, mp, 0, 0); return; failed: ASSERT(err != 0); miocnak(q, mp, 0, err); } typedef struct dld_secobj_state { uint_t ss_free; uint_t ss_count; int ss_rc; dld_secobj_t *ss_objp; } dld_secobj_state_t; /* ARGSUSED */ static uint_t drv_secobj_walker(mod_hash_key_t key, mod_hash_val_t *val, void *arg) { dld_secobj_state_t *statep = arg; dld_secobj_t *sobjp = (dld_secobj_t *)val; if (statep->ss_free < sizeof (dld_secobj_t)) { statep->ss_rc = ENOSPC; return (MH_WALK_TERMINATE); } bcopy(sobjp, statep->ss_objp, sizeof (dld_secobj_t)); statep->ss_objp++; statep->ss_free -= sizeof (dld_secobj_t); statep->ss_count++; return (MH_WALK_CONTINUE); } static void drv_ioc_secobj_get(dld_ctl_str_t *ctls, mblk_t *mp) { dld_ioc_secobj_get_t *sgp; dld_secobj_t *sobjp, *objp; int err = EINVAL; uint_t extra = 0; queue_t *q = ctls->cs_wq; mblk_t *bp; if ((err = miocpullup(mp, sizeof (dld_ioc_secobj_get_t))) != 0) goto failed; if ((bp = msgpullup(mp->b_cont, -1)) == NULL) goto failed; freemsg(mp->b_cont); mp->b_cont = bp; sgp = (dld_ioc_secobj_get_t *)bp->b_rptr; sobjp = &sgp->sg_obj; if (sobjp->so_name[DLD_SECOBJ_NAME_MAX - 1] != '\0') goto failed; rw_enter(&drv_secobj_lock, RW_READER); if (sobjp->so_name[0] != '\0') { err = mod_hash_find(drv_secobj_hash, (mod_hash_key_t)sobjp->so_name, (mod_hash_val_t *)&objp); if (err != 0) { ASSERT(err == MH_ERR_NOTFOUND); err = ENOENT; rw_exit(&drv_secobj_lock); goto failed; } bcopy(objp->so_val, sobjp->so_val, objp->so_len); sobjp->so_len = objp->so_len; sobjp->so_class = objp->so_class; sgp->sg_count = 1; } else { dld_secobj_state_t state; state.ss_free = MBLKL(bp) - sizeof (dld_ioc_secobj_get_t); state.ss_count = 0; state.ss_rc = 0; state.ss_objp = (dld_secobj_t *)(sgp + 1); mod_hash_walk(drv_secobj_hash, drv_secobj_walker, &state); if (state.ss_rc != 0) { err = state.ss_rc; rw_exit(&drv_secobj_lock); goto failed; } sgp->sg_count = state.ss_count; extra = state.ss_count * sizeof (dld_secobj_t); } rw_exit(&drv_secobj_lock); miocack(q, mp, sizeof (dld_ioc_secobj_get_t) + extra, 0); return; failed: ASSERT(err != 0); miocnak(q, mp, 0, err); } static void drv_ioc_secobj_unset(dld_ctl_str_t *ctls, mblk_t *mp) { dld_ioc_secobj_unset_t *sup; dld_secobj_t *objp; mod_hash_val_t val; int err = EINVAL; queue_t *q = ctls->cs_wq; if ((err = miocpullup(mp, sizeof (dld_ioc_secobj_unset_t))) != 0) goto failed; sup = (dld_ioc_secobj_unset_t *)mp->b_cont->b_rptr; if (sup->su_name[DLD_SECOBJ_NAME_MAX - 1] != '\0') goto failed; rw_enter(&drv_secobj_lock, RW_WRITER); err = mod_hash_find(drv_secobj_hash, (mod_hash_key_t)sup->su_name, (mod_hash_val_t *)&objp); if (err != 0) { ASSERT(err == MH_ERR_NOTFOUND); err = ENOENT; rw_exit(&drv_secobj_lock); goto failed; } err = mod_hash_remove(drv_secobj_hash, (mod_hash_key_t)sup->su_name, (mod_hash_val_t *)&val); ASSERT(err == 0); ASSERT(objp == (dld_secobj_t *)val); kmem_cache_free(drv_secobj_cachep, objp); rw_exit(&drv_secobj_lock); miocack(q, mp, 0, 0); return; failed: ASSERT(err != 0); miocnak(q, mp, 0, err); }