11ae08745Sheppo /* 21ae08745Sheppo * CDDL HEADER START 31ae08745Sheppo * 41ae08745Sheppo * The contents of this file are subject to the terms of the 51ae08745Sheppo * Common Development and Distribution License (the "License"). 61ae08745Sheppo * You may not use this file except in compliance with the License. 71ae08745Sheppo * 81ae08745Sheppo * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 91ae08745Sheppo * or http://www.opensolaris.org/os/licensing. 101ae08745Sheppo * See the License for the specific language governing permissions 111ae08745Sheppo * and limitations under the License. 121ae08745Sheppo * 131ae08745Sheppo * When distributing Covered Code, include this CDDL HEADER in each 141ae08745Sheppo * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 151ae08745Sheppo * If applicable, add the following below this CDDL HEADER, with the 161ae08745Sheppo * fields enclosed by brackets "[]" replaced with your own identifying 171ae08745Sheppo * information: Portions Copyright [yyyy] [name of copyright owner] 181ae08745Sheppo * 191ae08745Sheppo * CDDL HEADER END 201ae08745Sheppo */ 211ae08745Sheppo 221ae08745Sheppo /* 231ae08745Sheppo * Copyright 2006 Sun Microsystems, Inc. All rights reserved. 241ae08745Sheppo * Use is subject to license terms. 251ae08745Sheppo */ 261ae08745Sheppo 271ae08745Sheppo #pragma ident "%Z%%M% %I% %E% SMI" 281ae08745Sheppo 291ae08745Sheppo #include <sys/types.h> 301ae08745Sheppo #include <sys/file.h> 311ae08745Sheppo #include <sys/errno.h> 321ae08745Sheppo #include <sys/uio.h> 331ae08745Sheppo #include <sys/open.h> 341ae08745Sheppo #include <sys/cred.h> 351ae08745Sheppo #include <sys/kmem.h> 361ae08745Sheppo #include <sys/conf.h> 371ae08745Sheppo #include <sys/cmn_err.h> 381ae08745Sheppo #include <sys/ksynch.h> 391ae08745Sheppo #include <sys/modctl.h> 401ae08745Sheppo #include <sys/stat.h> /* needed for S_IFBLK and S_IFCHR */ 411ae08745Sheppo #include <sys/debug.h> 421ae08745Sheppo #include <sys/sysmacros.h> 431ae08745Sheppo #include <sys/types.h> 441ae08745Sheppo #include <sys/cred.h> 451ae08745Sheppo #include <sys/promif.h> 461ae08745Sheppo #include <sys/ddi.h> 471ae08745Sheppo #include <sys/sunddi.h> 481ae08745Sheppo #include <sys/cyclic.h> 491ae08745Sheppo #include <sys/note.h> 501ae08745Sheppo #include <sys/mach_descrip.h> 511ae08745Sheppo #include <sys/mdeg.h> 521ae08745Sheppo #include <sys/ldc.h> 531ae08745Sheppo #include <sys/vldc_impl.h> 541ae08745Sheppo 551ae08745Sheppo /* 561ae08745Sheppo * Function prototypes. 571ae08745Sheppo */ 581ae08745Sheppo 591ae08745Sheppo /* DDI entrypoints */ 601ae08745Sheppo static int vldc_attach(dev_info_t *dip, ddi_attach_cmd_t cmd); 611ae08745Sheppo static int vldc_detach(dev_info_t *dip, ddi_detach_cmd_t cmd); 621ae08745Sheppo static int vldc_open(dev_t *devp, int flag, int otyp, cred_t *cred); 631ae08745Sheppo static int vldc_close(dev_t dev, int flag, int otyp, cred_t *cred); 641ae08745Sheppo static int vldc_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, 651ae08745Sheppo cred_t *credp, int *rvalp); 661ae08745Sheppo static int vldc_read(dev_t dev, struct uio *uiop, cred_t *credp); 671ae08745Sheppo static int vldc_write(dev_t dev, struct uio *uiop, cred_t *credp); 681ae08745Sheppo static int vldc_chpoll(dev_t dev, short events, int anyyet, 691ae08745Sheppo short *reventsp, struct pollhead **phpp); 701ae08745Sheppo 711ae08745Sheppo /* Internal functions */ 721ae08745Sheppo static uint_t i_vldc_cb(uint64_t event, caddr_t arg); 731ae08745Sheppo static int i_vldc_mdeg_cb(void *cb_argp, mdeg_result_t *resp); 741ae08745Sheppo static int i_vldc_mdeg_register(vldc_t *vldcp); 751ae08745Sheppo static int i_vldc_mdeg_unregister(vldc_t *vldcp); 761ae08745Sheppo static int i_vldc_add_port(vldc_t *vldcp, md_t *mdp, mde_cookie_t node); 771ae08745Sheppo static int i_vldc_remove_port(vldc_t *vldcp, uint_t portno); 781ae08745Sheppo static int i_vldc_close_port(vldc_t *vldcp, uint_t portno); 791ae08745Sheppo 801ae08745Sheppo /* soft state structure */ 811ae08745Sheppo static void *vldc_ssp; 821ae08745Sheppo 831ae08745Sheppo /* 841ae08745Sheppo * Matching criteria passed to the MDEG to register interest 851ae08745Sheppo * in changes to 'virtual-device-port' nodes identified by their 861ae08745Sheppo * 'id' property. 871ae08745Sheppo */ 881ae08745Sheppo static md_prop_match_t vport_prop_match[] = { 891ae08745Sheppo { MDET_PROP_VAL, "id" }, 901ae08745Sheppo { MDET_LIST_END, NULL } 911ae08745Sheppo }; 921ae08745Sheppo 931ae08745Sheppo static mdeg_node_match_t vport_match = { "virtual-device-port", 941ae08745Sheppo vport_prop_match }; 951ae08745Sheppo 961ae08745Sheppo /* 971ae08745Sheppo * Specification of an MD node passed to the MDEG to filter any 981ae08745Sheppo * 'virtual-device-port' nodes that do not belong to the specified 991ae08745Sheppo * node. This template is copied for each vldc instance and filled 1001ae08745Sheppo * in with the appropriate 'name' and 'cfg-handle' values before 1011ae08745Sheppo * being passed to the MDEG. 1021ae08745Sheppo */ 1031ae08745Sheppo static mdeg_prop_spec_t vldc_prop_template[] = { 1041ae08745Sheppo { MDET_PROP_STR, "name", NULL }, 1051ae08745Sheppo { MDET_PROP_VAL, "cfg-handle", NULL }, 1061ae08745Sheppo { MDET_LIST_END, NULL, NULL } 1071ae08745Sheppo }; 1081ae08745Sheppo 1091ae08745Sheppo #define VLDC_MDEG_PROP_NAME(specp) ((specp)[0].ps_str) 1101ae08745Sheppo #define VLDC_SET_MDEG_PROP_NAME(specp, name) ((specp)[0].ps_str = (name)) 1111ae08745Sheppo #define VLDC_SET_MDEG_PROP_INST(specp, inst) ((specp)[1].ps_val = (inst)) 1121ae08745Sheppo 1131ae08745Sheppo 1141ae08745Sheppo static struct cb_ops vldc_cb_ops = { 1151ae08745Sheppo vldc_open, /* open */ 1161ae08745Sheppo vldc_close, /* close */ 1171ae08745Sheppo nodev, /* strategy */ 1181ae08745Sheppo nodev, /* print */ 1191ae08745Sheppo nodev, /* dump */ 1201ae08745Sheppo vldc_read, /* read */ 1211ae08745Sheppo vldc_write, /* write */ 1221ae08745Sheppo vldc_ioctl, /* ioctl */ 1231ae08745Sheppo nodev, /* devmap */ 1241ae08745Sheppo nodev, /* mmap */ 1251ae08745Sheppo ddi_segmap, /* segmap */ 1261ae08745Sheppo vldc_chpoll, /* chpoll */ 1271ae08745Sheppo ddi_prop_op, /* prop_op */ 1281ae08745Sheppo NULL, /* stream */ 1291ae08745Sheppo D_NEW | D_MP /* flag */ 1301ae08745Sheppo }; 1311ae08745Sheppo 1321ae08745Sheppo static struct dev_ops vldc_ops = { 1331ae08745Sheppo DEVO_REV, /* rev */ 1341ae08745Sheppo 0, /* ref count */ 1351ae08745Sheppo ddi_getinfo_1to1, /* getinfo */ 1361ae08745Sheppo nulldev, /* identify */ 1371ae08745Sheppo nulldev, /* probe */ 1381ae08745Sheppo vldc_attach, /* attach */ 1391ae08745Sheppo vldc_detach, /* detach */ 1401ae08745Sheppo nodev, /* reset */ 1411ae08745Sheppo &vldc_cb_ops, /* cb_ops */ 1421ae08745Sheppo (struct bus_ops *)NULL /* bus_ops */ 1431ae08745Sheppo }; 1441ae08745Sheppo 1451ae08745Sheppo extern struct mod_ops mod_driverops; 1461ae08745Sheppo 1471ae08745Sheppo static struct modldrv md = { 1481ae08745Sheppo &mod_driverops, /* Type - it is a driver */ 1491ae08745Sheppo "sun4v Virtual LDC Driver %I%", /* Name of the module */ 1501ae08745Sheppo &vldc_ops, /* driver specific ops */ 1511ae08745Sheppo }; 1521ae08745Sheppo 1531ae08745Sheppo static struct modlinkage ml = { 1541ae08745Sheppo MODREV_1, 1551ae08745Sheppo &md, 1561ae08745Sheppo NULL 1571ae08745Sheppo }; 1581ae08745Sheppo 1591ae08745Sheppo /* maximum MTU and cookie size tunables */ 1601ae08745Sheppo uint32_t vldc_max_mtu = VLDC_MAX_MTU; 1611ae08745Sheppo uint64_t vldc_max_cookie = VLDC_MAX_COOKIE; 1621ae08745Sheppo 1631ae08745Sheppo 1641ae08745Sheppo #ifdef DEBUG 1651ae08745Sheppo 1661ae08745Sheppo /* 1671ae08745Sheppo * Print debug messages 1681ae08745Sheppo * 1691ae08745Sheppo * set vldcdbg to 0x7 to enable all messages 1701ae08745Sheppo * 1711ae08745Sheppo * 0x4 - Warnings 1721ae08745Sheppo * 0x2 - All debug messages (most verbose) 1731ae08745Sheppo * 0x1 - Minimal debug messages 1741ae08745Sheppo */ 1751ae08745Sheppo 1761ae08745Sheppo int vldcdbg = 0x0; 1771ae08745Sheppo 1781ae08745Sheppo static void 1791ae08745Sheppo vldcdebug(const char *fmt, ...) 1801ae08745Sheppo { 1811ae08745Sheppo char buf[512]; 1821ae08745Sheppo va_list ap; 1831ae08745Sheppo 1841ae08745Sheppo va_start(ap, fmt); 1851ae08745Sheppo (void) vsnprintf(buf, sizeof (buf), fmt, ap); 1861ae08745Sheppo va_end(ap); 1871ae08745Sheppo 1881ae08745Sheppo cmn_err(CE_CONT, "?%s", buf); 1891ae08745Sheppo } 1901ae08745Sheppo 1911ae08745Sheppo #define D1 if (vldcdbg & 0x01) vldcdebug 1921ae08745Sheppo #define D2 if (vldcdbg & 0x02) vldcdebug 1931ae08745Sheppo #define DWARN if (vldcdbg & 0x04) vldcdebug 1941ae08745Sheppo 1951ae08745Sheppo #else /* not DEBUG */ 1961ae08745Sheppo 1971ae08745Sheppo #define D1 if (0) printf 1981ae08745Sheppo #define D2 if (0) printf 1991ae08745Sheppo #define DWARN if (0) printf 2001ae08745Sheppo 2011ae08745Sheppo #endif /* not DEBUG */ 2021ae08745Sheppo 2031ae08745Sheppo 2041ae08745Sheppo /* _init(9E): initialize the loadable module */ 2051ae08745Sheppo int 2061ae08745Sheppo _init(void) 2071ae08745Sheppo { 2081ae08745Sheppo int error; 2091ae08745Sheppo 2101ae08745Sheppo /* init the soft state structure */ 2111ae08745Sheppo error = ddi_soft_state_init(&vldc_ssp, sizeof (vldc_t), 1); 2121ae08745Sheppo if (error != 0) { 2131ae08745Sheppo return (error); 2141ae08745Sheppo } 2151ae08745Sheppo 2161ae08745Sheppo /* Link the driver into the system */ 2171ae08745Sheppo error = mod_install(&ml); 2181ae08745Sheppo 2191ae08745Sheppo return (error); 2201ae08745Sheppo } 2211ae08745Sheppo 2221ae08745Sheppo /* _info(9E): return information about the loadable module */ 2231ae08745Sheppo int 2241ae08745Sheppo _info(struct modinfo *modinfop) 2251ae08745Sheppo { 2261ae08745Sheppo /* Report status of the dynamically loadable driver module */ 2271ae08745Sheppo return (mod_info(&ml, modinfop)); 2281ae08745Sheppo } 2291ae08745Sheppo 2301ae08745Sheppo /* _fini(9E): prepare the module for unloading. */ 2311ae08745Sheppo int 2321ae08745Sheppo _fini(void) 2331ae08745Sheppo { 2341ae08745Sheppo int error; 2351ae08745Sheppo 2361ae08745Sheppo /* Unlink the driver module from the system */ 2371ae08745Sheppo if ((error = mod_remove(&ml)) == 0) { 2381ae08745Sheppo /* 2391ae08745Sheppo * We have successfully "removed" the driver. 2401ae08745Sheppo * destroy soft state 2411ae08745Sheppo */ 2421ae08745Sheppo ddi_soft_state_fini(&vldc_ssp); 2431ae08745Sheppo } 2441ae08745Sheppo 2451ae08745Sheppo return (error); 2461ae08745Sheppo } 2471ae08745Sheppo 2481ae08745Sheppo /* ldc callback */ 2491ae08745Sheppo static uint_t 2501ae08745Sheppo i_vldc_cb(uint64_t event, caddr_t arg) 2511ae08745Sheppo { 2521ae08745Sheppo vldc_port_t *vport = (vldc_port_t *)arg; 2531ae08745Sheppo short pollevents = 0; 2541ae08745Sheppo int rv; 2551ae08745Sheppo 2561ae08745Sheppo D1("i_vldc_cb: callback invoked port=%d, event=0x%lx\n", 2571ae08745Sheppo vport->number, event); 2581ae08745Sheppo 2591ae08745Sheppo if (event & LDC_EVT_UP) { 2601ae08745Sheppo pollevents |= POLLOUT; 2611ae08745Sheppo vport->hanged_up = B_FALSE; 2621ae08745Sheppo 2631ae08745Sheppo } else if (event & LDC_EVT_DOWN) { 2641ae08745Sheppo pollevents |= POLLHUP; 2651ae08745Sheppo vport->hanged_up = B_TRUE; 2661ae08745Sheppo 2671ae08745Sheppo } else if (event & LDC_EVT_RESET) { 2681ae08745Sheppo /* do an ldc_up because we can't be sure the other side will */ 2691ae08745Sheppo if ((rv = ldc_up(vport->ldc_handle)) != 0) 2701ae08745Sheppo if (rv != ECONNREFUSED) 2711ae08745Sheppo DWARN("i_vldc_cb: port@%d failed to" 2721ae08745Sheppo " bring up LDC channel=%ld, err=%d\n", 2731ae08745Sheppo vport->number, vport->ldc_id, rv); 2741ae08745Sheppo } 2751ae08745Sheppo 2761ae08745Sheppo if (event & LDC_EVT_READ) 2771ae08745Sheppo pollevents |= POLLIN; 2781ae08745Sheppo 2791ae08745Sheppo if (pollevents != 0) { 2801ae08745Sheppo D1("i_vldc_cb: port@%d pollwakeup=0x%x\n", 2811ae08745Sheppo vport->number, pollevents); 2821ae08745Sheppo pollwakeup(&vport->poll, pollevents); 2831ae08745Sheppo } 2841ae08745Sheppo 2851ae08745Sheppo return (LDC_SUCCESS); 2861ae08745Sheppo } 2871ae08745Sheppo 2881ae08745Sheppo /* mdeg callback */ 2891ae08745Sheppo static int 2901ae08745Sheppo i_vldc_mdeg_cb(void *cb_argp, mdeg_result_t *resp) 2911ae08745Sheppo { 2921ae08745Sheppo vldc_t *vldcp; 2931ae08745Sheppo int idx; 2941ae08745Sheppo uint64_t portno; 2951ae08745Sheppo int rv; 2961ae08745Sheppo md_t *mdp; 2971ae08745Sheppo mde_cookie_t node; 2981ae08745Sheppo 2991ae08745Sheppo if (resp == NULL) { 3001ae08745Sheppo D1("i_vldc_mdeg_cb: no result returned\n"); 3011ae08745Sheppo return (MDEG_FAILURE); 3021ae08745Sheppo } 3031ae08745Sheppo 3041ae08745Sheppo vldcp = (vldc_t *)cb_argp; 3051ae08745Sheppo 3061ae08745Sheppo mutex_enter(&vldcp->lock); 3071ae08745Sheppo if (vldcp->detaching == B_TRUE) { 3081ae08745Sheppo D1("i_vldc_mdeg_cb: detach in progress\n"); 3091ae08745Sheppo mutex_exit(&vldcp->lock); 3101ae08745Sheppo return (MDEG_FAILURE); 3111ae08745Sheppo } 3121ae08745Sheppo 3131ae08745Sheppo D1("i_vldc_mdeg_cb: added=%d, removed=%d, matched=%d\n", 3141ae08745Sheppo resp->added.nelem, resp->removed.nelem, resp->match_prev.nelem); 3151ae08745Sheppo 3161ae08745Sheppo /* process added ports */ 3171ae08745Sheppo for (idx = 0; idx < resp->added.nelem; idx++) { 3181ae08745Sheppo mdp = resp->added.mdp; 3191ae08745Sheppo node = resp->added.mdep[idx]; 3201ae08745Sheppo 3211ae08745Sheppo D1("i_vldc_mdeg_cb: processing added node 0x%lx\n", node); 3221ae08745Sheppo 3231ae08745Sheppo /* attempt to add a port */ 3241ae08745Sheppo if ((rv = i_vldc_add_port(vldcp, mdp, node)) != MDEG_SUCCESS) { 3251ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_mdeg_cb: unable to add port, " 3261ae08745Sheppo "err = %d", rv); 3271ae08745Sheppo } 3281ae08745Sheppo } 3291ae08745Sheppo 3301ae08745Sheppo /* process removed ports */ 3311ae08745Sheppo for (idx = 0; idx < resp->removed.nelem; idx++) { 3321ae08745Sheppo mdp = resp->removed.mdp; 3331ae08745Sheppo node = resp->removed.mdep[idx]; 3341ae08745Sheppo 3351ae08745Sheppo D1("i_vldc_mdeg_cb: processing removed node 0x%lx\n", node); 3361ae08745Sheppo 3371ae08745Sheppo /* read in the port's id property */ 3381ae08745Sheppo if (md_get_prop_val(mdp, node, "id", &portno)) { 3391ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_mdeg_cb: node 0x%lx of " 3401ae08745Sheppo "removed list has no 'id' property", node); 3411ae08745Sheppo continue; 3421ae08745Sheppo } 3431ae08745Sheppo 3441ae08745Sheppo /* attempt to remove a port */ 3451ae08745Sheppo if ((rv = i_vldc_remove_port(vldcp, portno)) != 0) { 3461ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_mdeg_cb: unable to remove " 3471ae08745Sheppo "port %lu, err %d", portno, rv); 3481ae08745Sheppo } 3491ae08745Sheppo } 3501ae08745Sheppo 3511ae08745Sheppo /* 3521ae08745Sheppo * Currently no support for updating already active ports. So, ignore 3531ae08745Sheppo * the match_curr and match_prev arrays for now. 3541ae08745Sheppo */ 3551ae08745Sheppo 3561ae08745Sheppo mutex_exit(&vldcp->lock); 3571ae08745Sheppo 3581ae08745Sheppo return (MDEG_SUCCESS); 3591ae08745Sheppo } 3601ae08745Sheppo 3611ae08745Sheppo /* register callback to mdeg */ 3621ae08745Sheppo static int 3631ae08745Sheppo i_vldc_mdeg_register(vldc_t *vldcp) 3641ae08745Sheppo { 3651ae08745Sheppo mdeg_prop_spec_t *pspecp; 3661ae08745Sheppo mdeg_node_spec_t *inst_specp; 3671ae08745Sheppo mdeg_handle_t mdeg_hdl; 3681ae08745Sheppo size_t templatesz; 3691ae08745Sheppo int inst; 3701ae08745Sheppo char *name; 3711ae08745Sheppo size_t namesz; 3721ae08745Sheppo char *nameprop; 3731ae08745Sheppo int rv; 3741ae08745Sheppo 3751ae08745Sheppo /* get the unique vldc instance assigned by the LDom manager */ 3761ae08745Sheppo inst = ddi_prop_get_int(DDI_DEV_T_ANY, vldcp->dip, 3771ae08745Sheppo DDI_PROP_DONTPASS, "reg", -1); 3781ae08745Sheppo if (inst == -1) { 3791ae08745Sheppo cmn_err(CE_NOTE, "?vldc%d has no 'reg' property", 3801ae08745Sheppo ddi_get_instance(vldcp->dip)); 3811ae08745Sheppo return (DDI_FAILURE); 3821ae08745Sheppo } 3831ae08745Sheppo 3841ae08745Sheppo /* get the name of the vldc instance */ 3851ae08745Sheppo rv = ddi_prop_lookup_string(DDI_DEV_T_ANY, vldcp->dip, 3861ae08745Sheppo DDI_PROP_DONTPASS, "name", &nameprop); 3871ae08745Sheppo if (rv != DDI_PROP_SUCCESS) { 3881ae08745Sheppo cmn_err(CE_NOTE, "?vldc%d has no 'name' property", 3891ae08745Sheppo ddi_get_instance(vldcp->dip)); 3901ae08745Sheppo return (DDI_FAILURE); 3911ae08745Sheppo } 3921ae08745Sheppo 3931ae08745Sheppo D1("i_vldc_mdeg_register: name=%s, instance=%d\n", nameprop, inst); 3941ae08745Sheppo 3951ae08745Sheppo /* 3961ae08745Sheppo * Allocate and initialize a per-instance copy 3971ae08745Sheppo * of the global property spec array that will 3981ae08745Sheppo * uniquely identify this vldc instance. 3991ae08745Sheppo */ 4001ae08745Sheppo templatesz = sizeof (vldc_prop_template); 4011ae08745Sheppo pspecp = kmem_alloc(templatesz, KM_SLEEP); 4021ae08745Sheppo 4031ae08745Sheppo bcopy(vldc_prop_template, pspecp, templatesz); 4041ae08745Sheppo 4051ae08745Sheppo /* copy in the name property */ 4061ae08745Sheppo namesz = strlen(nameprop) + 1; 4071ae08745Sheppo name = kmem_alloc(namesz, KM_SLEEP); 4081ae08745Sheppo 4091ae08745Sheppo bcopy(nameprop, name, namesz); 4101ae08745Sheppo VLDC_SET_MDEG_PROP_NAME(pspecp, name); 411*d10e4ef2Snarayan ddi_prop_free(nameprop); 4121ae08745Sheppo 4131ae08745Sheppo /* copy in the instance property */ 4141ae08745Sheppo VLDC_SET_MDEG_PROP_INST(pspecp, inst); 4151ae08745Sheppo 4161ae08745Sheppo /* initialize the complete prop spec structure */ 4171ae08745Sheppo inst_specp = kmem_alloc(sizeof (mdeg_node_spec_t), KM_SLEEP); 4181ae08745Sheppo inst_specp->namep = "virtual-device"; 4191ae08745Sheppo inst_specp->specp = pspecp; 4201ae08745Sheppo 4211ae08745Sheppo /* perform the registration */ 4221ae08745Sheppo rv = mdeg_register(inst_specp, &vport_match, i_vldc_mdeg_cb, 4231ae08745Sheppo vldcp, &mdeg_hdl); 4241ae08745Sheppo 4251ae08745Sheppo if (rv != MDEG_SUCCESS) { 4261ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_mdeg_register: mdeg_register " 4271ae08745Sheppo "failed, err = %d", rv); 4281ae08745Sheppo kmem_free(name, namesz); 4291ae08745Sheppo kmem_free(pspecp, templatesz); 4301ae08745Sheppo kmem_free(inst_specp, sizeof (mdeg_node_spec_t)); 4311ae08745Sheppo return (DDI_FAILURE); 4321ae08745Sheppo } 4331ae08745Sheppo 4341ae08745Sheppo /* save off data that will be needed later */ 4351ae08745Sheppo vldcp->inst_spec = inst_specp; 4361ae08745Sheppo vldcp->mdeg_hdl = mdeg_hdl; 4371ae08745Sheppo 4381ae08745Sheppo return (DDI_SUCCESS); 4391ae08745Sheppo } 4401ae08745Sheppo 4411ae08745Sheppo /* unregister callback from mdeg */ 4421ae08745Sheppo static int 4431ae08745Sheppo i_vldc_mdeg_unregister(vldc_t *vldcp) 4441ae08745Sheppo { 4451ae08745Sheppo char *name; 4461ae08745Sheppo int rv; 4471ae08745Sheppo 4481ae08745Sheppo D1("i_vldc_mdeg_unregister: hdl=0x%lx\n", vldcp->mdeg_hdl); 4491ae08745Sheppo 4501ae08745Sheppo rv = mdeg_unregister(vldcp->mdeg_hdl); 4511ae08745Sheppo if (rv != MDEG_SUCCESS) { 4521ae08745Sheppo return (rv); 4531ae08745Sheppo } 4541ae08745Sheppo 4551ae08745Sheppo /* 4561ae08745Sheppo * Clean up cached MDEG data 4571ae08745Sheppo */ 4581ae08745Sheppo name = VLDC_MDEG_PROP_NAME(vldcp->inst_spec->specp); 4591ae08745Sheppo if (name != NULL) { 4601ae08745Sheppo kmem_free(name, strlen(name) + 1); 4611ae08745Sheppo } 4621ae08745Sheppo kmem_free(vldcp->inst_spec->specp, sizeof (vldc_prop_template)); 4631ae08745Sheppo vldcp->inst_spec->specp = NULL; 4641ae08745Sheppo 4651ae08745Sheppo kmem_free(vldcp->inst_spec, sizeof (mdeg_node_spec_t)); 4661ae08745Sheppo vldcp->inst_spec = NULL; 4671ae08745Sheppo 4681ae08745Sheppo return (MDEG_SUCCESS); 4691ae08745Sheppo } 4701ae08745Sheppo 4711ae08745Sheppo static int 4721ae08745Sheppo i_vldc_get_port_channel(md_t *mdp, mde_cookie_t node, uint64_t *ldc_id) 4731ae08745Sheppo { 4741ae08745Sheppo int num_nodes, nchan; 4751ae08745Sheppo size_t listsz; 4761ae08745Sheppo mde_cookie_t *listp; 4771ae08745Sheppo 4781ae08745Sheppo /* 4791ae08745Sheppo * Find the channel-endpoint node(s) (which should be under this 4801ae08745Sheppo * port node) which contain the channel id(s). 4811ae08745Sheppo */ 4821ae08745Sheppo if ((num_nodes = md_node_count(mdp)) <= 0) { 4831ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_get_port_channel: invalid number of " 4841ae08745Sheppo "channel-endpoint nodes found (%d)", num_nodes); 4851ae08745Sheppo return (-1); 4861ae08745Sheppo } 4871ae08745Sheppo 4881ae08745Sheppo /* allocate space for node list */ 4891ae08745Sheppo listsz = num_nodes * sizeof (mde_cookie_t); 4901ae08745Sheppo listp = kmem_alloc(listsz, KM_SLEEP); 4911ae08745Sheppo 4921ae08745Sheppo nchan = md_scan_dag(mdp, node, md_find_name(mdp, "channel-endpoint"), 4931ae08745Sheppo md_find_name(mdp, "fwd"), listp); 4941ae08745Sheppo 4951ae08745Sheppo if (nchan <= 0) { 4961ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_get_port_channel: no channel-endpoint" 4971ae08745Sheppo " nodes found"); 4981ae08745Sheppo kmem_free(listp, listsz); 4991ae08745Sheppo return (-1); 5001ae08745Sheppo } 5011ae08745Sheppo 5021ae08745Sheppo D2("i_vldc_get_port_channel: %d channel-endpoint nodes found", nchan); 5031ae08745Sheppo 5041ae08745Sheppo /* use property from first node found */ 5051ae08745Sheppo if (md_get_prop_val(mdp, listp[0], "id", ldc_id)) { 5061ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_get_port_channel: channel-endpoint " 5071ae08745Sheppo "has no 'id' property"); 5081ae08745Sheppo kmem_free(listp, listsz); 5091ae08745Sheppo return (-1); 5101ae08745Sheppo } 5111ae08745Sheppo 5121ae08745Sheppo kmem_free(listp, listsz); 5131ae08745Sheppo 5141ae08745Sheppo return (0); 5151ae08745Sheppo } 5161ae08745Sheppo 5171ae08745Sheppo /* add a vldc port */ 5181ae08745Sheppo static int 5191ae08745Sheppo i_vldc_add_port(vldc_t *vldcp, md_t *mdp, mde_cookie_t node) 5201ae08745Sheppo { 5211ae08745Sheppo vldc_port_t *vport; 5221ae08745Sheppo char *sname; 5231ae08745Sheppo uint64_t portno; 5241ae08745Sheppo int vldc_inst; 5251ae08745Sheppo minor_t minor; 5261ae08745Sheppo int minor_idx; 5271ae08745Sheppo boolean_t new_minor; 5281ae08745Sheppo int rv; 5291ae08745Sheppo 5301ae08745Sheppo /* read in the port's id property */ 5311ae08745Sheppo if (md_get_prop_val(mdp, node, "id", &portno)) { 5321ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_add_port: node 0x%lx of added " 5331ae08745Sheppo "list has no 'id' property", node); 5341ae08745Sheppo return (MDEG_FAILURE); 5351ae08745Sheppo } 5361ae08745Sheppo 5371ae08745Sheppo if (portno >= VLDC_MAX_PORTS) { 5381ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_add_port: found port number (%lu) " 5391ae08745Sheppo "larger than maximum supported number of ports", portno); 5401ae08745Sheppo return (MDEG_FAILURE); 5411ae08745Sheppo } 5421ae08745Sheppo 5431ae08745Sheppo vport = &(vldcp->port[portno]); 5441ae08745Sheppo 5451ae08745Sheppo if (vport->minorp != NULL) { 5461ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_add_port: trying to add a port (%lu)" 5471ae08745Sheppo " which is already bound", portno); 5481ae08745Sheppo return (MDEG_FAILURE); 5491ae08745Sheppo } 5501ae08745Sheppo 5511ae08745Sheppo vport->number = portno; 5521ae08745Sheppo 5531ae08745Sheppo /* get all channels for this device (currently only one) */ 5541ae08745Sheppo if (i_vldc_get_port_channel(mdp, node, &vport->ldc_id) == -1) { 5551ae08745Sheppo return (MDEG_FAILURE); 5561ae08745Sheppo } 5571ae08745Sheppo 5581ae08745Sheppo /* set the default MTU */ 5591ae08745Sheppo vport->mtu = VLDC_DEFAULT_MTU; 5601ae08745Sheppo 5611ae08745Sheppo /* get the service being exported by this port */ 5621ae08745Sheppo if (md_get_prop_str(mdp, node, "vldc-svc-name", &sname)) { 5631ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_add_port: vdevice has no " 5641ae08745Sheppo "'vldc-svc-name' property"); 5651ae08745Sheppo return (MDEG_FAILURE); 5661ae08745Sheppo } 5671ae08745Sheppo 5681ae08745Sheppo /* minor number look up */ 5691ae08745Sheppo for (minor_idx = 0; minor_idx < vldcp->minors_assigned; 5701ae08745Sheppo minor_idx++) { 5711ae08745Sheppo if (strcmp(vldcp->minor_tbl[minor_idx].sname, sname) == 0) { 5721ae08745Sheppo /* found previously assigned minor number */ 5731ae08745Sheppo break; 5741ae08745Sheppo } 5751ae08745Sheppo } 5761ae08745Sheppo 5771ae08745Sheppo new_minor = B_FALSE; 5781ae08745Sheppo if (minor_idx == vldcp->minors_assigned) { 5791ae08745Sheppo /* end of lookup - assign new minor number */ 5801ae08745Sheppo if (vldcp->minors_assigned == VLDC_MAX_MINORS) { 5811ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_add_port: too many minor " 5821ae08745Sheppo "nodes (%d)", minor_idx); 5831ae08745Sheppo return (MDEG_FAILURE); 5841ae08745Sheppo } 5851ae08745Sheppo 5861ae08745Sheppo (void) strlcpy(vldcp->minor_tbl[minor_idx].sname, 5871ae08745Sheppo sname, MAXPATHLEN); 5881ae08745Sheppo 5891ae08745Sheppo vldcp->minors_assigned++; 5901ae08745Sheppo new_minor = B_TRUE; 5911ae08745Sheppo } 5921ae08745Sheppo 5931ae08745Sheppo ASSERT(vldcp->minor_tbl[minor_idx].portno == VLDC_INVALID_PORTNO); 5941ae08745Sheppo 5951ae08745Sheppo vport->minorp = &vldcp->minor_tbl[minor_idx]; 5961ae08745Sheppo vldcp->minor_tbl[minor_idx].portno = portno; 5971ae08745Sheppo vldcp->minor_tbl[minor_idx].in_use = 0; 5981ae08745Sheppo 5991ae08745Sheppo D1("i_vldc_add_port: port@%d mtu=%d, ldc=%ld, service=%s\n", 6001ae08745Sheppo vport->number, vport->mtu, vport->ldc_id, sname); 6011ae08745Sheppo 6021ae08745Sheppo /* 6031ae08745Sheppo * Create a minor node. The minor number is 6041ae08745Sheppo * (vldc_inst << VLDC_INST_SHIFT) | minor_idx 6051ae08745Sheppo */ 6061ae08745Sheppo vldc_inst = ddi_get_instance(vldcp->dip); 6071ae08745Sheppo 6081ae08745Sheppo minor = (vldc_inst << VLDC_INST_SHIFT) | (minor_idx); 6091ae08745Sheppo 6101ae08745Sheppo rv = ddi_create_minor_node(vldcp->dip, sname, S_IFCHR, 6111ae08745Sheppo minor, DDI_NT_SERIAL, 0); 6121ae08745Sheppo 6131ae08745Sheppo if (rv != DDI_SUCCESS) { 6141ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_add_port: failed to create minor" 6151ae08745Sheppo "node (%u), err = %d", minor, rv); 6161ae08745Sheppo vldcp->minor_tbl[minor_idx].portno = VLDC_INVALID_PORTNO; 6171ae08745Sheppo if (new_minor) { 6181ae08745Sheppo vldcp->minors_assigned--; 6191ae08745Sheppo } 6201ae08745Sheppo return (MDEG_FAILURE); 6211ae08745Sheppo } 6221ae08745Sheppo 6231ae08745Sheppo /* 6241ae08745Sheppo * The port is now bound to a minor node and is initially in the 6251ae08745Sheppo * closed state. 6261ae08745Sheppo */ 6271ae08745Sheppo vport->status = VLDC_PORT_CLOSED; 6281ae08745Sheppo 6291ae08745Sheppo D1("i_vldc_add_port: port %lu initialized\n", portno); 6301ae08745Sheppo 6311ae08745Sheppo return (MDEG_SUCCESS); 6321ae08745Sheppo } 6331ae08745Sheppo 6341ae08745Sheppo /* remove a vldc port */ 6351ae08745Sheppo static int 6361ae08745Sheppo i_vldc_remove_port(vldc_t *vldcp, uint_t portno) 6371ae08745Sheppo { 6381ae08745Sheppo vldc_port_t *vport; 6391ae08745Sheppo vldc_minor_t *vminor; 6401ae08745Sheppo 6411ae08745Sheppo vport = &(vldcp->port[portno]); 6421ae08745Sheppo vminor = vport->minorp; 6431ae08745Sheppo if (vminor == NULL) { 6441ae08745Sheppo cmn_err(CE_NOTE, "?i_vldc_remove_port: trying to remove a " 6451ae08745Sheppo "port (%u) which is not bound", portno); 6461ae08745Sheppo return (MDEG_FAILURE); 6471ae08745Sheppo } 6481ae08745Sheppo 6491ae08745Sheppo /* 6501ae08745Sheppo * Make sure that all new attempts to open or use the minor node 6511ae08745Sheppo * associated with the port will fail. 6521ae08745Sheppo */ 6531ae08745Sheppo mutex_enter(&vminor->lock); 6541ae08745Sheppo vminor->portno = VLDC_INVALID_PORTNO; 6551ae08745Sheppo mutex_exit(&vminor->lock); 6561ae08745Sheppo 6571ae08745Sheppo /* send hangup to anyone polling */ 6581ae08745Sheppo pollwakeup(&vport->poll, POLLHUP); 6591ae08745Sheppo 6601ae08745Sheppo /* Now wait for all current users of the minor node to finish. */ 6611ae08745Sheppo mutex_enter(&vminor->lock); 6621ae08745Sheppo while (vminor->in_use > 0) { 6631ae08745Sheppo cv_wait(&vminor->cv, &vminor->lock); 6641ae08745Sheppo } 6651ae08745Sheppo 6661ae08745Sheppo if ((vport->status == VLDC_PORT_READY) || 6671ae08745Sheppo (vport->status == VLDC_PORT_OPEN)) { 6681ae08745Sheppo /* close the port before it is torn down */ 6691ae08745Sheppo (void) i_vldc_close_port(vldcp, portno); 6701ae08745Sheppo } 6711ae08745Sheppo 6721ae08745Sheppo /* remove minor node */ 6731ae08745Sheppo ddi_remove_minor_node(vldcp->dip, vport->minorp->sname); 6741ae08745Sheppo vport->minorp = NULL; 6751ae08745Sheppo 6761ae08745Sheppo mutex_exit(&vminor->lock); 6771ae08745Sheppo 6781ae08745Sheppo D1("i_vldc_remove_port: removed vldc port %u\n", portno); 6791ae08745Sheppo 6801ae08745Sheppo return (MDEG_SUCCESS); 6811ae08745Sheppo } 6821ae08745Sheppo 6831ae08745Sheppo /* close a ldc channel */ 6841ae08745Sheppo static int 6851ae08745Sheppo i_vldc_ldc_close(vldc_port_t *vport) 6861ae08745Sheppo { 6871ae08745Sheppo int rv = 0; 6881ae08745Sheppo int err; 6891ae08745Sheppo 6901ae08745Sheppo err = ldc_close(vport->ldc_handle); 6911ae08745Sheppo if (err != 0) 6921ae08745Sheppo rv = err; 6931ae08745Sheppo err = ldc_unreg_callback(vport->ldc_handle); 6941ae08745Sheppo if ((err != 0) && (rv != 0)) 6951ae08745Sheppo rv = err; 6961ae08745Sheppo err = ldc_fini(vport->ldc_handle); 6971ae08745Sheppo if ((err != 0) && (rv != 0)) 6981ae08745Sheppo rv = err; 6991ae08745Sheppo 7001ae08745Sheppo return (rv); 7011ae08745Sheppo } 7021ae08745Sheppo 7031ae08745Sheppo /* close a vldc port */ 7041ae08745Sheppo static int 7051ae08745Sheppo i_vldc_close_port(vldc_t *vldcp, uint_t portno) 7061ae08745Sheppo { 7071ae08745Sheppo vldc_port_t *vport; 7081ae08745Sheppo int rv; 7091ae08745Sheppo 7101ae08745Sheppo vport = &(vldcp->port[portno]); 7111ae08745Sheppo 7121ae08745Sheppo ASSERT(MUTEX_HELD(&vport->minorp->lock)); 7131ae08745Sheppo 7141ae08745Sheppo if (vport->status == VLDC_PORT_CLOSED) { 7151ae08745Sheppo /* nothing to do */ 7161ae08745Sheppo DWARN("i_vldc_close_port: port %d in an unexpected " 7171ae08745Sheppo "state (%d)\n", portno, vport->status); 7181ae08745Sheppo return (DDI_SUCCESS); 7191ae08745Sheppo } 7201ae08745Sheppo 7211ae08745Sheppo rv = DDI_SUCCESS; 7221ae08745Sheppo if (vport->status == VLDC_PORT_READY) { 7231ae08745Sheppo rv = i_vldc_ldc_close(vport); 7241ae08745Sheppo } else { 7251ae08745Sheppo ASSERT(vport->status == VLDC_PORT_OPEN); 7261ae08745Sheppo } 7271ae08745Sheppo 7281ae08745Sheppo /* free memory */ 7291ae08745Sheppo kmem_free(vport->send_buf, vport->mtu); 7301ae08745Sheppo kmem_free(vport->recv_buf, vport->mtu); 7311ae08745Sheppo 732*d10e4ef2Snarayan if (strcmp(vport->minorp->sname, VLDC_HVCTL_SVCNAME) == 0) 733*d10e4ef2Snarayan kmem_free(vport->cookie_buf, vldc_max_cookie); 734*d10e4ef2Snarayan 7351ae08745Sheppo vport->status = VLDC_PORT_CLOSED; 7361ae08745Sheppo 7371ae08745Sheppo return (rv); 7381ae08745Sheppo } 7391ae08745Sheppo 7401ae08745Sheppo /* 7411ae08745Sheppo * attach(9E): attach a device to the system. 7421ae08745Sheppo * called once for each instance of the device on the system. 7431ae08745Sheppo */ 7441ae08745Sheppo static int 7451ae08745Sheppo vldc_attach(dev_info_t *dip, ddi_attach_cmd_t cmd) 7461ae08745Sheppo { 7471ae08745Sheppo int i, instance; 7481ae08745Sheppo vldc_t *vldcp; 7491ae08745Sheppo 7501ae08745Sheppo switch (cmd) { 7511ae08745Sheppo 7521ae08745Sheppo case DDI_ATTACH: 7531ae08745Sheppo 7541ae08745Sheppo instance = ddi_get_instance(dip); 7551ae08745Sheppo 7561ae08745Sheppo if (ddi_soft_state_zalloc(vldc_ssp, instance) != DDI_SUCCESS) { 7571ae08745Sheppo return (DDI_FAILURE); 7581ae08745Sheppo } 7591ae08745Sheppo 7601ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 7611ae08745Sheppo if (vldcp == NULL) { 7621ae08745Sheppo ddi_soft_state_free(vldc_ssp, instance); 7631ae08745Sheppo return (ENXIO); 7641ae08745Sheppo } 7651ae08745Sheppo 7661ae08745Sheppo D1("vldc_attach: DDI_ATTACH instance=%d\n", instance); 7671ae08745Sheppo 7681ae08745Sheppo mutex_init(&vldcp->lock, NULL, MUTEX_DRIVER, NULL); 7691ae08745Sheppo vldcp->dip = dip; 7701ae08745Sheppo vldcp->detaching = B_FALSE; 7711ae08745Sheppo 7721ae08745Sheppo for (i = 0; i < VLDC_MAX_PORTS; i++) { 7731ae08745Sheppo /* No minor node association to start with */ 7741ae08745Sheppo vldcp->port[i].minorp = NULL; 7751ae08745Sheppo } 7761ae08745Sheppo 7771ae08745Sheppo for (i = 0; i < VLDC_MAX_MINORS; i++) { 7781ae08745Sheppo mutex_init(&(vldcp->minor_tbl[i].lock), NULL, 7791ae08745Sheppo MUTEX_DRIVER, NULL); 7801ae08745Sheppo cv_init(&(vldcp->minor_tbl[i].cv), NULL, 7811ae08745Sheppo CV_DRIVER, NULL); 7821ae08745Sheppo /* No port association to start with */ 7831ae08745Sheppo vldcp->minor_tbl[i].portno = VLDC_INVALID_PORTNO; 7841ae08745Sheppo } 7851ae08745Sheppo 7861ae08745Sheppo /* Register for MD update notification */ 7871ae08745Sheppo if (i_vldc_mdeg_register(vldcp) != DDI_SUCCESS) { 7881ae08745Sheppo ddi_soft_state_free(vldc_ssp, instance); 7891ae08745Sheppo return (DDI_FAILURE); 7901ae08745Sheppo } 7911ae08745Sheppo 7921ae08745Sheppo return (DDI_SUCCESS); 7931ae08745Sheppo 7941ae08745Sheppo case DDI_RESUME: 7951ae08745Sheppo 7961ae08745Sheppo return (DDI_SUCCESS); 7971ae08745Sheppo 7981ae08745Sheppo default: 7991ae08745Sheppo 8001ae08745Sheppo return (DDI_FAILURE); 8011ae08745Sheppo } 8021ae08745Sheppo } 8031ae08745Sheppo 8041ae08745Sheppo /* 8051ae08745Sheppo * detach(9E): detach a device from the system. 8061ae08745Sheppo */ 8071ae08745Sheppo static int 8081ae08745Sheppo vldc_detach(dev_info_t *dip, ddi_detach_cmd_t cmd) 8091ae08745Sheppo { 8101ae08745Sheppo int i, instance; 8111ae08745Sheppo vldc_t *vldcp; 8121ae08745Sheppo 8131ae08745Sheppo switch (cmd) { 8141ae08745Sheppo 8151ae08745Sheppo case DDI_DETACH: 8161ae08745Sheppo 8171ae08745Sheppo instance = ddi_get_instance(dip); 8181ae08745Sheppo 8191ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 8201ae08745Sheppo if (vldcp == NULL) { 8211ae08745Sheppo return (DDI_FAILURE); 8221ae08745Sheppo } 8231ae08745Sheppo 8241ae08745Sheppo D1("vldc_detach: DDI_DETACH instance=%d\n", instance); 8251ae08745Sheppo 8261ae08745Sheppo mutex_enter(&vldcp->lock); 8271ae08745Sheppo 8281ae08745Sheppo /* Fail the detach if all ports have not been removed. */ 8291ae08745Sheppo for (i = 0; i < VLDC_MAX_MINORS; i++) { 8301ae08745Sheppo if (vldcp->minor_tbl[i].portno != VLDC_INVALID_PORTNO) { 8311ae08745Sheppo D1("vldc_detach: vldc@%d:%d is bound, " 8321ae08745Sheppo "detach failed\n", 8331ae08745Sheppo instance, vldcp->minor_tbl[i].portno); 8341ae08745Sheppo mutex_exit(&vldcp->lock); 8351ae08745Sheppo return (DDI_FAILURE); 8361ae08745Sheppo } 8371ae08745Sheppo } 8381ae08745Sheppo 8391ae08745Sheppo /* 8401ae08745Sheppo * Prevent MDEG from adding new ports before the callback can 8411ae08745Sheppo * be unregistered. The lock can't be held accross the 8421ae08745Sheppo * unregistration call because a callback may be in progress 8431ae08745Sheppo * and blocked on the lock. 8441ae08745Sheppo */ 8451ae08745Sheppo vldcp->detaching = B_TRUE; 8461ae08745Sheppo 8471ae08745Sheppo mutex_exit(&vldcp->lock); 8481ae08745Sheppo 8491ae08745Sheppo if (i_vldc_mdeg_unregister(vldcp) != MDEG_SUCCESS) { 8501ae08745Sheppo vldcp->detaching = B_FALSE; 8511ae08745Sheppo return (DDI_FAILURE); 8521ae08745Sheppo } 8531ae08745Sheppo 8541ae08745Sheppo /* Tear down all bound ports and free resources. */ 8551ae08745Sheppo for (i = 0; i < VLDC_MAX_MINORS; i++) { 8561ae08745Sheppo if (vldcp->minor_tbl[i].portno != VLDC_INVALID_PORTNO) { 8571ae08745Sheppo (void) i_vldc_remove_port(vldcp, i); 8581ae08745Sheppo } 8591ae08745Sheppo mutex_destroy(&(vldcp->minor_tbl[i].lock)); 8601ae08745Sheppo cv_destroy(&(vldcp->minor_tbl[i].cv)); 8611ae08745Sheppo } 8621ae08745Sheppo 8631ae08745Sheppo mutex_destroy(&vldcp->lock); 8641ae08745Sheppo ddi_soft_state_free(vldc_ssp, instance); 8651ae08745Sheppo 8661ae08745Sheppo return (DDI_SUCCESS); 8671ae08745Sheppo 8681ae08745Sheppo case DDI_SUSPEND: 8691ae08745Sheppo 8701ae08745Sheppo return (DDI_SUCCESS); 8711ae08745Sheppo 8721ae08745Sheppo default: 8731ae08745Sheppo 8741ae08745Sheppo return (DDI_FAILURE); 8751ae08745Sheppo } 8761ae08745Sheppo } 8771ae08745Sheppo 8781ae08745Sheppo /* cb_open */ 8791ae08745Sheppo static int 8801ae08745Sheppo vldc_open(dev_t *devp, int flag, int otyp, cred_t *cred) 8811ae08745Sheppo { 8821ae08745Sheppo _NOTE(ARGUNUSED(flag, otyp, cred)) 8831ae08745Sheppo 8841ae08745Sheppo int instance; 8851ae08745Sheppo minor_t minor; 8861ae08745Sheppo uint64_t portno; 8871ae08745Sheppo vldc_t *vldcp; 8881ae08745Sheppo vldc_port_t *vport; 8891ae08745Sheppo vldc_minor_t *vminor; 8901ae08745Sheppo 8911ae08745Sheppo minor = getminor(*devp); 8921ae08745Sheppo instance = VLDCINST(minor); 8931ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 8941ae08745Sheppo if (vldcp == NULL) 8951ae08745Sheppo return (ENXIO); 8961ae08745Sheppo 8971ae08745Sheppo vminor = VLDCMINOR(vldcp, minor); 8981ae08745Sheppo mutex_enter(&vminor->lock); 8991ae08745Sheppo portno = vminor->portno; 9001ae08745Sheppo if (portno == VLDC_INVALID_PORTNO) { 9011ae08745Sheppo mutex_exit(&vminor->lock); 9021ae08745Sheppo return (ENXIO); 9031ae08745Sheppo } 9041ae08745Sheppo 9051ae08745Sheppo vport = &(vldcp->port[portno]); 9061ae08745Sheppo 9071ae08745Sheppo D1("vldc_open: opening vldc@%d:%lu\n", instance, portno); 9081ae08745Sheppo 9091ae08745Sheppo if (vport->status != VLDC_PORT_CLOSED) { 9101ae08745Sheppo mutex_exit(&vminor->lock); 9111ae08745Sheppo return (EBUSY); 9121ae08745Sheppo } 9131ae08745Sheppo 9141ae08745Sheppo vport->recv_buf = kmem_alloc(vport->mtu, KM_SLEEP); 9151ae08745Sheppo vport->send_buf = kmem_alloc(vport->mtu, KM_SLEEP); 9161ae08745Sheppo 917*d10e4ef2Snarayan if (strcmp(vport->minorp->sname, VLDC_HVCTL_SVCNAME) == 0) 918*d10e4ef2Snarayan vport->cookie_buf = kmem_alloc(vldc_max_cookie, KM_SLEEP); 919*d10e4ef2Snarayan 9201ae08745Sheppo vport->is_stream = B_FALSE; /* assume not a stream */ 9211ae08745Sheppo vport->hanged_up = B_FALSE; 9221ae08745Sheppo 9231ae08745Sheppo vport->status = VLDC_PORT_OPEN; 9241ae08745Sheppo 9251ae08745Sheppo mutex_exit(&vminor->lock); 9261ae08745Sheppo 9271ae08745Sheppo return (DDI_SUCCESS); 9281ae08745Sheppo } 9291ae08745Sheppo 9301ae08745Sheppo /* cb_close */ 9311ae08745Sheppo static int 9321ae08745Sheppo vldc_close(dev_t dev, int flag, int otyp, cred_t *cred) 9331ae08745Sheppo { 9341ae08745Sheppo _NOTE(ARGUNUSED(flag, otyp, cred)) 9351ae08745Sheppo 9361ae08745Sheppo int instance; 9371ae08745Sheppo minor_t minor; 9381ae08745Sheppo uint64_t portno; 9391ae08745Sheppo vldc_t *vldcp; 9401ae08745Sheppo vldc_minor_t *vminor; 9411ae08745Sheppo int rv; 9421ae08745Sheppo 9431ae08745Sheppo minor = getminor(dev); 9441ae08745Sheppo instance = VLDCINST(minor); 9451ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 9461ae08745Sheppo if (vldcp == NULL) { 9471ae08745Sheppo return (ENXIO); 9481ae08745Sheppo } 9491ae08745Sheppo 9501ae08745Sheppo vminor = VLDCMINOR(vldcp, minor); 9511ae08745Sheppo mutex_enter(&vminor->lock); 9521ae08745Sheppo portno = vminor->portno; 9531ae08745Sheppo if (portno == VLDC_INVALID_PORTNO) { 9541ae08745Sheppo mutex_exit(&vminor->lock); 9551ae08745Sheppo return (ENOLINK); 9561ae08745Sheppo } 9571ae08745Sheppo 9581ae08745Sheppo D1("vldc_close: closing vldc@%d:%lu\n", instance, portno); 9591ae08745Sheppo 9601ae08745Sheppo rv = i_vldc_close_port(vldcp, portno); 9611ae08745Sheppo 9621ae08745Sheppo mutex_exit(&vminor->lock); 9631ae08745Sheppo 9641ae08745Sheppo return (rv); 9651ae08745Sheppo } 9661ae08745Sheppo 9671ae08745Sheppo static int 9681ae08745Sheppo vldc_set_ldc_mode(vldc_port_t *vport, vldc_t *vldcp, int channel_mode) 9691ae08745Sheppo { 9701ae08745Sheppo ldc_attr_t attr; 9711ae08745Sheppo int rv; 9721ae08745Sheppo 9731ae08745Sheppo ASSERT(MUTEX_HELD(&vport->minorp->lock)); 9741ae08745Sheppo 9751ae08745Sheppo /* validate mode */ 9761ae08745Sheppo switch (channel_mode) { 9771ae08745Sheppo case LDC_MODE_STREAM: 9781ae08745Sheppo vport->is_stream = B_TRUE; 9791ae08745Sheppo break; 9801ae08745Sheppo case LDC_MODE_RAW: 9811ae08745Sheppo case LDC_MODE_UNRELIABLE: 9821ae08745Sheppo case LDC_MODE_RELIABLE: 9831ae08745Sheppo vport->is_stream = B_FALSE; 9841ae08745Sheppo break; 9851ae08745Sheppo default: 9861ae08745Sheppo return (EINVAL); 9871ae08745Sheppo } 9881ae08745Sheppo 9891ae08745Sheppo if (vport->status == VLDC_PORT_READY) { 9901ae08745Sheppo rv = i_vldc_ldc_close(vport); 9911ae08745Sheppo vport->status = VLDC_PORT_OPEN; 9921ae08745Sheppo if (rv != 0) { 9931ae08745Sheppo DWARN("vldc_set_ldc_mode: i_vldc_ldc_close " 9941ae08745Sheppo "failed, rv=%d\n", rv); 9951ae08745Sheppo return (rv); 9961ae08745Sheppo } 9971ae08745Sheppo } 9981ae08745Sheppo 9991ae08745Sheppo D1("vldc_set_ldc_mode: vport status %d, mode %d\n", 10001ae08745Sheppo vport->status, channel_mode); 10011ae08745Sheppo 10021ae08745Sheppo vport->ldc_mode = channel_mode; 10031ae08745Sheppo 10041ae08745Sheppo /* initialize the channel */ 10051ae08745Sheppo attr.devclass = LDC_DEV_SERIAL; 10061ae08745Sheppo attr.instance = ddi_get_instance(vldcp->dip); 10071ae08745Sheppo attr.qlen = VLDC_QUEUE_LEN; 10081ae08745Sheppo attr.mode = vport->ldc_mode; 10091ae08745Sheppo 10101ae08745Sheppo if ((rv = ldc_init(vport->ldc_id, &attr, 10111ae08745Sheppo &vport->ldc_handle)) != 0) { 10121ae08745Sheppo DWARN("vldc_ioctl_opt_op: ldc_init failed, rv=%d\n", rv); 10131ae08745Sheppo goto error_init; 10141ae08745Sheppo } 10151ae08745Sheppo 10161ae08745Sheppo /* register it */ 10171ae08745Sheppo if ((rv = ldc_reg_callback(vport->ldc_handle, 10181ae08745Sheppo i_vldc_cb, (caddr_t)vport)) != 0) { 10191ae08745Sheppo DWARN("vldc_ioctl_opt_op: ldc_reg_callback failed, rv=%d\n", 10201ae08745Sheppo rv); 10211ae08745Sheppo goto error_reg; 10221ae08745Sheppo } 10231ae08745Sheppo 10241ae08745Sheppo /* open the channel */ 10251ae08745Sheppo if ((rv = ldc_open(vport->ldc_handle)) != 0) { 10261ae08745Sheppo DWARN("vldc_ioctl_opt_op: ldc_open failed, rv=%d\n", rv); 10271ae08745Sheppo goto error_open; 10281ae08745Sheppo } 10291ae08745Sheppo 10301ae08745Sheppo vport->status = VLDC_PORT_READY; 10311ae08745Sheppo 10321ae08745Sheppo /* 10331ae08745Sheppo * Attempt to bring the channel up, but do not 10341ae08745Sheppo * fail if the other end is not up yet. 10351ae08745Sheppo */ 10361ae08745Sheppo rv = ldc_up(vport->ldc_handle); 10371ae08745Sheppo 10381ae08745Sheppo if (rv == ECONNREFUSED) { 10391ae08745Sheppo D1("vldc_ioctl_opt_op: remote endpoint not up yet\n"); 10401ae08745Sheppo } else if (rv != 0) { 10411ae08745Sheppo DWARN("vldc_ioctl_opt_op: ldc_up failed, rv=%d\n", rv); 10421ae08745Sheppo goto error_up; 10431ae08745Sheppo } 10441ae08745Sheppo 10451ae08745Sheppo D1("vldc_ioctl_opt_op: ldc %ld initialized successfully\n", 10461ae08745Sheppo vport->ldc_id); 10471ae08745Sheppo 10481ae08745Sheppo return (0); 10491ae08745Sheppo 10501ae08745Sheppo error_up: 10511ae08745Sheppo vport->status = VLDC_PORT_OPEN; 10521ae08745Sheppo (void) ldc_close(vport->ldc_handle); 10531ae08745Sheppo error_open: 10541ae08745Sheppo (void) ldc_unreg_callback(vport->ldc_handle); 10551ae08745Sheppo error_reg: 10561ae08745Sheppo (void) ldc_fini(vport->ldc_handle); 10571ae08745Sheppo error_init: 10581ae08745Sheppo return (rv); 10591ae08745Sheppo } 10601ae08745Sheppo 10611ae08745Sheppo /* ioctl to read cookie */ 10621ae08745Sheppo static int 10631ae08745Sheppo i_vldc_ioctl_read_cookie(vldc_port_t *vport, int vldc_instance, void *arg, 10641ae08745Sheppo int mode) 10651ae08745Sheppo { 10661ae08745Sheppo vldc_data_t copy_info; 1067*d10e4ef2Snarayan uint64_t len, balance, copy_size; 1068*d10e4ef2Snarayan caddr_t src_addr, dst_addr; 10691ae08745Sheppo int rv; 10701ae08745Sheppo 10711ae08745Sheppo if (ddi_copyin(arg, ©_info, sizeof (copy_info), mode) == -1) { 10721ae08745Sheppo return (EFAULT); 10731ae08745Sheppo } 10741ae08745Sheppo 1075*d10e4ef2Snarayan len = balance = copy_info.length; 1076*d10e4ef2Snarayan src_addr = (caddr_t)copy_info.src_addr; 1077*d10e4ef2Snarayan dst_addr = (caddr_t)copy_info.dst_addr; 1078*d10e4ef2Snarayan while (balance > 0) { 10791ae08745Sheppo 1080*d10e4ef2Snarayan /* get the max amount to the copied */ 1081*d10e4ef2Snarayan copy_size = MIN(balance, vldc_max_cookie); 10821ae08745Sheppo 10831ae08745Sheppo mutex_enter(&vport->minorp->lock); 10841ae08745Sheppo 1085*d10e4ef2Snarayan D2("i_vldc_ioctl_read_cookie: vldc@%d:%d reading from 0x%p " 1086*d10e4ef2Snarayan "size 0x%lx to 0x%p\n", vldc_instance, vport->number, 1087*d10e4ef2Snarayan dst_addr, copy_size, src_addr); 10881ae08745Sheppo 10891ae08745Sheppo /* read from the HV into the temporary buffer */ 1090*d10e4ef2Snarayan rv = ldc_mem_rdwr_pa(vport->ldc_handle, vport->cookie_buf, 1091*d10e4ef2Snarayan ©_size, dst_addr, LDC_COPY_IN); 10921ae08745Sheppo if (rv != 0) { 1093*d10e4ef2Snarayan DWARN("i_vldc_ioctl_read_cookie: vldc@%d:%d cannot " 1094*d10e4ef2Snarayan "read address 0x%p, rv=%d\n", 1095*d10e4ef2Snarayan vldc_instance, vport->number, dst_addr, rv); 10961ae08745Sheppo mutex_exit(&vport->minorp->lock); 10971ae08745Sheppo return (EFAULT); 10981ae08745Sheppo } 10991ae08745Sheppo 11001ae08745Sheppo D2("i_vldc_ioctl_read_cookie: vldc@%d:%d read succeeded\n", 11011ae08745Sheppo vldc_instance, vport->number); 11021ae08745Sheppo 11031ae08745Sheppo mutex_exit(&vport->minorp->lock); 11041ae08745Sheppo 1105*d10e4ef2Snarayan /* 1106*d10e4ef2Snarayan * copy data from temporary buffer out to the 1107*d10e4ef2Snarayan * caller and free buffer 1108*d10e4ef2Snarayan */ 1109*d10e4ef2Snarayan rv = ddi_copyout(vport->cookie_buf, src_addr, copy_size, mode); 11101ae08745Sheppo if (rv != 0) { 11111ae08745Sheppo return (EFAULT); 11121ae08745Sheppo } 11131ae08745Sheppo 1114*d10e4ef2Snarayan /* adjust len, source and dest */ 1115*d10e4ef2Snarayan balance -= copy_size; 1116*d10e4ef2Snarayan src_addr += copy_size; 1117*d10e4ef2Snarayan dst_addr += copy_size; 1118*d10e4ef2Snarayan } 1119*d10e4ef2Snarayan 11201ae08745Sheppo /* set the structure to reflect outcome */ 11211ae08745Sheppo copy_info.length = len; 11221ae08745Sheppo if (ddi_copyout(©_info, arg, sizeof (copy_info), mode) != 0) { 11231ae08745Sheppo return (EFAULT); 11241ae08745Sheppo } 11251ae08745Sheppo 11261ae08745Sheppo return (0); 11271ae08745Sheppo } 11281ae08745Sheppo 11291ae08745Sheppo /* ioctl to write cookie */ 11301ae08745Sheppo static int 11311ae08745Sheppo i_vldc_ioctl_write_cookie(vldc_port_t *vport, int vldc_instance, void *arg, 11321ae08745Sheppo int mode) 11331ae08745Sheppo { 11341ae08745Sheppo vldc_data_t copy_info; 1135*d10e4ef2Snarayan uint64_t len, balance, copy_size; 1136*d10e4ef2Snarayan caddr_t src_addr, dst_addr; 11371ae08745Sheppo int rv; 11381ae08745Sheppo 1139*d10e4ef2Snarayan if (ddi_copyin(arg, ©_info, sizeof (copy_info), mode) != 0) { 11401ae08745Sheppo return (EFAULT); 11411ae08745Sheppo } 11421ae08745Sheppo 11431ae08745Sheppo D2("i_vldc_ioctl_write_cookie: vldc@%d:%d writing 0x%lx size 0x%lx " 11441ae08745Sheppo "to 0x%lx\n", vldc_instance, vport->number, copy_info.src_addr, 11451ae08745Sheppo copy_info.length, copy_info.dst_addr); 11461ae08745Sheppo 1147*d10e4ef2Snarayan len = balance = copy_info.length; 1148*d10e4ef2Snarayan src_addr = (caddr_t)copy_info.src_addr; 1149*d10e4ef2Snarayan dst_addr = (caddr_t)copy_info.dst_addr; 1150*d10e4ef2Snarayan while (balance > 0) { 11511ae08745Sheppo 1152*d10e4ef2Snarayan /* get the max amount to the copied */ 1153*d10e4ef2Snarayan copy_size = MIN(balance, vldc_max_cookie); 1154*d10e4ef2Snarayan 1155*d10e4ef2Snarayan /* 1156*d10e4ef2Snarayan * copy into the temporary buffer the data 1157*d10e4ef2Snarayan * to be written to the HV 1158*d10e4ef2Snarayan */ 1159*d10e4ef2Snarayan if (ddi_copyin((caddr_t)src_addr, vport->cookie_buf, 1160*d10e4ef2Snarayan copy_size, mode) != 0) { 11611ae08745Sheppo return (EFAULT); 11621ae08745Sheppo } 11631ae08745Sheppo 11641ae08745Sheppo mutex_enter(&vport->minorp->lock); 11651ae08745Sheppo 11661ae08745Sheppo /* write the data from the temporary buffer to the HV */ 1167*d10e4ef2Snarayan rv = ldc_mem_rdwr_pa(vport->ldc_handle, vport->cookie_buf, 1168*d10e4ef2Snarayan ©_size, dst_addr, LDC_COPY_OUT); 11691ae08745Sheppo if (rv != 0) { 1170*d10e4ef2Snarayan DWARN("i_vldc_ioctl_write_cookie: vldc@%d:%d " 1171*d10e4ef2Snarayan "failed to write at address 0x%p\n, rv=%d", 1172*d10e4ef2Snarayan vldc_instance, vport->number, dst_addr, rv); 11731ae08745Sheppo mutex_exit(&vport->minorp->lock); 11741ae08745Sheppo return (EFAULT); 11751ae08745Sheppo } 11761ae08745Sheppo 11771ae08745Sheppo D2("i_vldc_ioctl_write_cookie: vldc@%d:%d write succeeded\n", 11781ae08745Sheppo vldc_instance, vport->number); 11791ae08745Sheppo 11801ae08745Sheppo mutex_exit(&vport->minorp->lock); 11811ae08745Sheppo 1182*d10e4ef2Snarayan /* adjust len, source and dest */ 1183*d10e4ef2Snarayan balance -= copy_size; 1184*d10e4ef2Snarayan src_addr += copy_size; 1185*d10e4ef2Snarayan dst_addr += copy_size; 1186*d10e4ef2Snarayan } 11871ae08745Sheppo 11881ae08745Sheppo /* set the structure to reflect outcome */ 11891ae08745Sheppo copy_info.length = len; 11901ae08745Sheppo if (ddi_copyout(©_info, (caddr_t)arg, 11911ae08745Sheppo sizeof (copy_info), mode) != 0) { 11921ae08745Sheppo return (EFAULT); 11931ae08745Sheppo } 11941ae08745Sheppo 11951ae08745Sheppo return (0); 11961ae08745Sheppo } 11971ae08745Sheppo 11981ae08745Sheppo /* vldc specific ioctl option commands */ 11991ae08745Sheppo static int 12001ae08745Sheppo i_vldc_ioctl_opt_op(vldc_port_t *vport, vldc_t *vldcp, void *arg, int mode) 12011ae08745Sheppo { 12021ae08745Sheppo vldc_opt_op_t vldc_cmd; 12031ae08745Sheppo uint32_t new_mtu; 12041ae08745Sheppo int rv = 0; 12051ae08745Sheppo 12061ae08745Sheppo if (ddi_copyin(arg, &vldc_cmd, sizeof (vldc_cmd), mode) != 0) { 12071ae08745Sheppo return (EFAULT); 12081ae08745Sheppo } 12091ae08745Sheppo 12101ae08745Sheppo D1("vldc_ioctl_opt_op: op %d\n", vldc_cmd.opt_sel); 12111ae08745Sheppo 12121ae08745Sheppo switch (vldc_cmd.opt_sel) { 12131ae08745Sheppo 12141ae08745Sheppo case VLDC_OPT_MTU_SZ: 12151ae08745Sheppo 12161ae08745Sheppo if (vldc_cmd.op_sel == VLDC_OP_GET) { 12171ae08745Sheppo vldc_cmd.opt_val = vport->mtu; 12181ae08745Sheppo if (ddi_copyout(&vldc_cmd, arg, 12191ae08745Sheppo sizeof (vldc_cmd), mode) == -1) { 12201ae08745Sheppo return (EFAULT); 12211ae08745Sheppo } 12221ae08745Sheppo } else { 12231ae08745Sheppo new_mtu = vldc_cmd.opt_val; 12241ae08745Sheppo 12251ae08745Sheppo if ((new_mtu < LDC_PACKET_SIZE) || 12261ae08745Sheppo (new_mtu > vldc_max_mtu)) { 12271ae08745Sheppo return (EINVAL); 12281ae08745Sheppo } 12291ae08745Sheppo 12301ae08745Sheppo mutex_enter(&vport->minorp->lock); 12311ae08745Sheppo 12321ae08745Sheppo if ((vport->status != VLDC_PORT_CLOSED) && 12331ae08745Sheppo (new_mtu != vport->mtu)) { 12341ae08745Sheppo /* 12351ae08745Sheppo * The port has buffers allocated since it is 12361ae08745Sheppo * not closed plus the MTU size has changed. 12371ae08745Sheppo * Reallocate the buffers to the new MTU size. 12381ae08745Sheppo */ 12391ae08745Sheppo kmem_free(vport->recv_buf, vport->mtu); 12401ae08745Sheppo vport->recv_buf = kmem_alloc(new_mtu, KM_SLEEP); 12411ae08745Sheppo 12421ae08745Sheppo kmem_free(vport->send_buf, vport->mtu); 12431ae08745Sheppo vport->send_buf = kmem_alloc(new_mtu, KM_SLEEP); 12441ae08745Sheppo 12451ae08745Sheppo vport->mtu = new_mtu; 12461ae08745Sheppo } 12471ae08745Sheppo 12481ae08745Sheppo mutex_exit(&vport->minorp->lock); 12491ae08745Sheppo } 12501ae08745Sheppo 12511ae08745Sheppo break; 12521ae08745Sheppo 12531ae08745Sheppo case VLDC_OPT_STATUS: 12541ae08745Sheppo 12551ae08745Sheppo if (vldc_cmd.op_sel == VLDC_OP_GET) { 12561ae08745Sheppo vldc_cmd.opt_val = vport->status; 12571ae08745Sheppo if (ddi_copyout(&vldc_cmd, arg, 12581ae08745Sheppo sizeof (vldc_cmd), mode) == -1) { 12591ae08745Sheppo return (EFAULT); 12601ae08745Sheppo } 12611ae08745Sheppo } else { 12621ae08745Sheppo return (ENOTSUP); 12631ae08745Sheppo } 12641ae08745Sheppo 12651ae08745Sheppo break; 12661ae08745Sheppo 12671ae08745Sheppo case VLDC_OPT_MODE: 12681ae08745Sheppo 12691ae08745Sheppo if (vldc_cmd.op_sel == VLDC_OP_GET) { 12701ae08745Sheppo vldc_cmd.opt_val = vport->ldc_mode; 12711ae08745Sheppo if (ddi_copyout(&vldc_cmd, arg, 12721ae08745Sheppo sizeof (vldc_cmd), mode) == -1) { 12731ae08745Sheppo return (EFAULT); 12741ae08745Sheppo } 12751ae08745Sheppo } else { 12761ae08745Sheppo mutex_enter(&vport->minorp->lock); 12771ae08745Sheppo rv = vldc_set_ldc_mode(vport, vldcp, vldc_cmd.opt_val); 12781ae08745Sheppo mutex_exit(&vport->minorp->lock); 12791ae08745Sheppo } 12801ae08745Sheppo 12811ae08745Sheppo break; 12821ae08745Sheppo 12831ae08745Sheppo default: 12841ae08745Sheppo 12851ae08745Sheppo D1("vldc_ioctl_opt_op: unsupported op %d\n", vldc_cmd.opt_sel); 12861ae08745Sheppo return (ENOTSUP); 12871ae08745Sheppo } 12881ae08745Sheppo 12891ae08745Sheppo return (rv); 12901ae08745Sheppo } 12911ae08745Sheppo 12921ae08745Sheppo /* cb_ioctl */ 12931ae08745Sheppo static int 12941ae08745Sheppo vldc_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *credp, 12951ae08745Sheppo int *rvalp) 12961ae08745Sheppo { 12971ae08745Sheppo _NOTE(ARGUNUSED(credp, rvalp)) 12981ae08745Sheppo 12991ae08745Sheppo int rv = EINVAL; 13001ae08745Sheppo int instance; 13011ae08745Sheppo minor_t minor; 13021ae08745Sheppo uint64_t portno; 13031ae08745Sheppo vldc_t *vldcp; 13041ae08745Sheppo vldc_port_t *vport; 13051ae08745Sheppo vldc_minor_t *vminor; 13061ae08745Sheppo 13071ae08745Sheppo minor = getminor(dev); 13081ae08745Sheppo instance = VLDCINST(minor); 13091ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 13101ae08745Sheppo if (vldcp == NULL) { 13111ae08745Sheppo return (ENXIO); 13121ae08745Sheppo } 13131ae08745Sheppo 13141ae08745Sheppo vminor = VLDCMINOR(vldcp, minor); 13151ae08745Sheppo mutex_enter(&vminor->lock); 13161ae08745Sheppo portno = vminor->portno; 13171ae08745Sheppo if (portno == VLDC_INVALID_PORTNO) { 13181ae08745Sheppo mutex_exit(&vminor->lock); 13191ae08745Sheppo return (ENOLINK); 13201ae08745Sheppo } 13211ae08745Sheppo vminor->in_use += 1; 13221ae08745Sheppo mutex_exit(&vminor->lock); 13231ae08745Sheppo 13241ae08745Sheppo vport = &(vldcp->port[portno]); 13251ae08745Sheppo 13261ae08745Sheppo D1("vldc_ioctl: vldc@%d:%lu cmd=0x%x\n", instance, portno, cmd); 13271ae08745Sheppo 13281ae08745Sheppo switch (cmd) { 13291ae08745Sheppo 13301ae08745Sheppo case VLDC_IOCTL_OPT_OP: 13311ae08745Sheppo 13321ae08745Sheppo rv = i_vldc_ioctl_opt_op(vport, vldcp, (void *)arg, mode); 13331ae08745Sheppo break; 13341ae08745Sheppo 13351ae08745Sheppo case VLDC_IOCTL_READ_COOKIE: 1336*d10e4ef2Snarayan if (strcmp(vport->minorp->sname, VLDC_HVCTL_SVCNAME)) { 1337*d10e4ef2Snarayan rv = EINVAL; 1338*d10e4ef2Snarayan break; 1339*d10e4ef2Snarayan } 13401ae08745Sheppo rv = i_vldc_ioctl_read_cookie(vport, instance, 13411ae08745Sheppo (void *)arg, mode); 13421ae08745Sheppo break; 13431ae08745Sheppo 13441ae08745Sheppo case VLDC_IOCTL_WRITE_COOKIE: 1345*d10e4ef2Snarayan if (strcmp(vport->minorp->sname, VLDC_HVCTL_SVCNAME)) { 1346*d10e4ef2Snarayan rv = EINVAL; 1347*d10e4ef2Snarayan break; 1348*d10e4ef2Snarayan } 13491ae08745Sheppo rv = i_vldc_ioctl_write_cookie(vport, instance, 13501ae08745Sheppo (void *)arg, mode); 13511ae08745Sheppo break; 13521ae08745Sheppo 13531ae08745Sheppo default: 13541ae08745Sheppo 13551ae08745Sheppo DWARN("vldc_ioctl: vldc@%d:%lu unknown cmd=0x%x\n", 13561ae08745Sheppo instance, portno, cmd); 13571ae08745Sheppo rv = EINVAL; 13581ae08745Sheppo break; 13591ae08745Sheppo } 13601ae08745Sheppo 13611ae08745Sheppo mutex_enter(&vminor->lock); 13621ae08745Sheppo vminor->in_use -= 1; 13631ae08745Sheppo if (vminor->in_use == 0) { 13641ae08745Sheppo cv_signal(&vminor->cv); 13651ae08745Sheppo } 13661ae08745Sheppo mutex_exit(&vminor->lock); 13671ae08745Sheppo 13681ae08745Sheppo D1("vldc_ioctl: rv=%d\n", rv); 13691ae08745Sheppo 13701ae08745Sheppo return (rv); 13711ae08745Sheppo } 13721ae08745Sheppo 13731ae08745Sheppo /* cb_read */ 13741ae08745Sheppo static int 13751ae08745Sheppo vldc_read(dev_t dev, struct uio *uiop, cred_t *credp) 13761ae08745Sheppo { 13771ae08745Sheppo _NOTE(ARGUNUSED(credp)) 13781ae08745Sheppo 13791ae08745Sheppo int instance; 13801ae08745Sheppo minor_t minor; 13811ae08745Sheppo size_t size = 0; 13821ae08745Sheppo uint64_t portno; 13831ae08745Sheppo vldc_t *vldcp; 13841ae08745Sheppo vldc_port_t *vport; 13851ae08745Sheppo vldc_minor_t *vminor; 13861ae08745Sheppo int rv = 0; 13871ae08745Sheppo 13881ae08745Sheppo minor = getminor(dev); 13891ae08745Sheppo instance = VLDCINST(minor); 13901ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 13911ae08745Sheppo if (vldcp == NULL) { 13921ae08745Sheppo return (ENXIO); 13931ae08745Sheppo } 13941ae08745Sheppo 13951ae08745Sheppo vminor = VLDCMINOR(vldcp, minor); 13961ae08745Sheppo mutex_enter(&vminor->lock); 13971ae08745Sheppo portno = vminor->portno; 13981ae08745Sheppo if (portno == VLDC_INVALID_PORTNO) { 13991ae08745Sheppo mutex_exit(&vminor->lock); 14001ae08745Sheppo return (ENOLINK); 14011ae08745Sheppo } 14021ae08745Sheppo 14031ae08745Sheppo D2("vldc_read: vldc@%d:%lu reading data\n", instance, portno); 14041ae08745Sheppo 14051ae08745Sheppo vport = &(vldcp->port[portno]); 14061ae08745Sheppo 14071ae08745Sheppo /* check the port status */ 14081ae08745Sheppo if (vport->status != VLDC_PORT_READY) { 14091ae08745Sheppo DWARN("vldc_read: vldc@%d:%lu not in the ready state\n", 14101ae08745Sheppo instance, portno); 14111ae08745Sheppo mutex_exit(&vminor->lock); 14121ae08745Sheppo return (ENOTACTIVE); 14131ae08745Sheppo } 14141ae08745Sheppo 14151ae08745Sheppo /* read data */ 14161ae08745Sheppo size = MIN(vport->mtu, uiop->uio_resid); 14171ae08745Sheppo rv = ldc_read(vport->ldc_handle, vport->recv_buf, &size); 14181ae08745Sheppo 14191ae08745Sheppo D2("vldc_read: vldc@%d:%lu ldc_read size=%ld, rv=%d\n", 14201ae08745Sheppo instance, portno, size, rv); 14211ae08745Sheppo 14221ae08745Sheppo if (rv == 0) { 14231ae08745Sheppo if (size != 0) { 14241ae08745Sheppo rv = uiomove(vport->recv_buf, size, UIO_READ, uiop); 14251ae08745Sheppo } else { 14261ae08745Sheppo rv = EWOULDBLOCK; 14271ae08745Sheppo } 14281ae08745Sheppo } else { 14291ae08745Sheppo switch (rv) { 14301ae08745Sheppo case ENOBUFS: 14311ae08745Sheppo break; 14321ae08745Sheppo case ETIMEDOUT: 14331ae08745Sheppo case EWOULDBLOCK: 14341ae08745Sheppo rv = EWOULDBLOCK; 14351ae08745Sheppo break; 14361ae08745Sheppo default: 14371ae08745Sheppo rv = ECONNRESET; 14381ae08745Sheppo break; 14391ae08745Sheppo } 14401ae08745Sheppo } 14411ae08745Sheppo 14421ae08745Sheppo mutex_exit(&vminor->lock); 14431ae08745Sheppo 14441ae08745Sheppo return (rv); 14451ae08745Sheppo } 14461ae08745Sheppo 14471ae08745Sheppo /* cb_write */ 14481ae08745Sheppo static int 14491ae08745Sheppo vldc_write(dev_t dev, struct uio *uiop, cred_t *credp) 14501ae08745Sheppo { 14511ae08745Sheppo _NOTE(ARGUNUSED(credp)) 14521ae08745Sheppo 14531ae08745Sheppo int instance; 14541ae08745Sheppo minor_t minor; 14551ae08745Sheppo size_t size; 14561ae08745Sheppo size_t orig_size; 14571ae08745Sheppo uint64_t portno; 14581ae08745Sheppo vldc_t *vldcp; 14591ae08745Sheppo vldc_port_t *vport; 14601ae08745Sheppo vldc_minor_t *vminor; 14611ae08745Sheppo int rv = EINVAL; 14621ae08745Sheppo 14631ae08745Sheppo minor = getminor(dev); 14641ae08745Sheppo instance = VLDCINST(minor); 14651ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 14661ae08745Sheppo if (vldcp == NULL) { 14671ae08745Sheppo return (ENXIO); 14681ae08745Sheppo } 14691ae08745Sheppo 14701ae08745Sheppo vminor = VLDCMINOR(vldcp, minor); 14711ae08745Sheppo mutex_enter(&vminor->lock); 14721ae08745Sheppo portno = vminor->portno; 14731ae08745Sheppo if (portno == VLDC_INVALID_PORTNO) { 14741ae08745Sheppo mutex_exit(&vminor->lock); 14751ae08745Sheppo return (ENOLINK); 14761ae08745Sheppo } 14771ae08745Sheppo 14781ae08745Sheppo vport = &(vldcp->port[portno]); 14791ae08745Sheppo 14801ae08745Sheppo /* check the port status */ 14811ae08745Sheppo if (vport->status != VLDC_PORT_READY) { 14821ae08745Sheppo DWARN("vldc_write: vldc@%d:%lu not in the ready state\n", 14831ae08745Sheppo instance, portno); 14841ae08745Sheppo mutex_exit(&vminor->lock); 14851ae08745Sheppo return (ENOTACTIVE); 14861ae08745Sheppo } 14871ae08745Sheppo 14881ae08745Sheppo orig_size = uiop->uio_resid; 14891ae08745Sheppo size = orig_size; 14901ae08745Sheppo 14911ae08745Sheppo if (size > vport->mtu) { 14921ae08745Sheppo if (vport->is_stream) { 14931ae08745Sheppo /* can only send MTU size at a time */ 14941ae08745Sheppo size = vport->mtu; 14951ae08745Sheppo } else { 14961ae08745Sheppo mutex_exit(&vminor->lock); 14971ae08745Sheppo return (EMSGSIZE); 14981ae08745Sheppo } 14991ae08745Sheppo } 15001ae08745Sheppo 15011ae08745Sheppo D2("vldc_write: vldc@%d:%lu writing %lu bytes\n", instance, portno, 15021ae08745Sheppo size); 15031ae08745Sheppo 15041ae08745Sheppo rv = uiomove(vport->send_buf, size, UIO_WRITE, uiop); 15051ae08745Sheppo if (rv == 0) { 15061ae08745Sheppo rv = ldc_write(vport->ldc_handle, (caddr_t)vport->send_buf, 15071ae08745Sheppo &size); 15081ae08745Sheppo if (rv != 0) { 15091ae08745Sheppo DWARN("vldc_write: vldc@%d:%lu failed writing %lu " 15101ae08745Sheppo "bytes rv=%d\n", instance, portno, size, rv); 15111ae08745Sheppo } 15121ae08745Sheppo } else { 15131ae08745Sheppo size = 0; 15141ae08745Sheppo } 15151ae08745Sheppo 15161ae08745Sheppo mutex_exit(&vminor->lock); 15171ae08745Sheppo 15181ae08745Sheppo /* resid is total number of bytes *not* sent */ 15191ae08745Sheppo uiop->uio_resid = orig_size - size; 15201ae08745Sheppo 15211ae08745Sheppo return (rv); 15221ae08745Sheppo } 15231ae08745Sheppo 15241ae08745Sheppo /* cb_chpoll */ 15251ae08745Sheppo static int 15261ae08745Sheppo vldc_chpoll(dev_t dev, short events, int anyyet, short *reventsp, 15271ae08745Sheppo struct pollhead **phpp) 15281ae08745Sheppo { 15291ae08745Sheppo int instance; 15301ae08745Sheppo minor_t minor; 15311ae08745Sheppo uint64_t portno; 15321ae08745Sheppo vldc_t *vldcp; 15331ae08745Sheppo vldc_port_t *vport; 15341ae08745Sheppo vldc_minor_t *vminor; 15351ae08745Sheppo ldc_status_t ldc_state; 15361ae08745Sheppo boolean_t isempty; 15371ae08745Sheppo int rv; 15381ae08745Sheppo 15391ae08745Sheppo minor = getminor(dev); 15401ae08745Sheppo instance = VLDCINST(minor); 15411ae08745Sheppo vldcp = ddi_get_soft_state(vldc_ssp, instance); 15421ae08745Sheppo if (vldcp == NULL) { 15431ae08745Sheppo return (ENXIO); 15441ae08745Sheppo } 15451ae08745Sheppo 15461ae08745Sheppo vminor = VLDCMINOR(vldcp, minor); 15471ae08745Sheppo mutex_enter(&vminor->lock); 15481ae08745Sheppo portno = vminor->portno; 15491ae08745Sheppo if (portno == VLDC_INVALID_PORTNO) { 15501ae08745Sheppo mutex_exit(&vminor->lock); 15511ae08745Sheppo return (ENOLINK); 15521ae08745Sheppo } 15531ae08745Sheppo 15541ae08745Sheppo vport = &(vldcp->port[portno]); 15551ae08745Sheppo 15561ae08745Sheppo /* check the port status */ 15571ae08745Sheppo if (vport->status != VLDC_PORT_READY) { 15581ae08745Sheppo mutex_exit(&vminor->lock); 15591ae08745Sheppo return (ENOTACTIVE); 15601ae08745Sheppo } 15611ae08745Sheppo 15621ae08745Sheppo D2("vldc_chpoll: vldc@%d:%lu polling events 0x%x\n", 15631ae08745Sheppo instance, portno, events); 15641ae08745Sheppo 15651ae08745Sheppo rv = ldc_status(vport->ldc_handle, &ldc_state); 15661ae08745Sheppo if (rv != 0) { 15671ae08745Sheppo DWARN("vldc_chpoll: vldc@%d:%lu could not get ldc status, " 15681ae08745Sheppo "rv=%d\n", instance, portno, rv); 15691ae08745Sheppo mutex_exit(&vminor->lock); 15701ae08745Sheppo return (EBADFD); 15711ae08745Sheppo } 15721ae08745Sheppo 15731ae08745Sheppo *reventsp = 0; 15741ae08745Sheppo 15751ae08745Sheppo if (ldc_state == LDC_UP) { 15761ae08745Sheppo /* 15771ae08745Sheppo * Check if the receive queue is empty and if not, signal that 15781ae08745Sheppo * there is data ready to read. 15791ae08745Sheppo */ 15801ae08745Sheppo if (events & POLLIN) { 15811ae08745Sheppo if ((ldc_chkq(vport->ldc_handle, &isempty) == 0) && 15821ae08745Sheppo (isempty == B_FALSE)) { 15831ae08745Sheppo *reventsp |= POLLIN; 15841ae08745Sheppo } 15851ae08745Sheppo } 15861ae08745Sheppo 15871ae08745Sheppo if (events & POLLOUT) 15881ae08745Sheppo *reventsp |= POLLOUT; 15891ae08745Sheppo 15901ae08745Sheppo } else if (vport->hanged_up) { 15911ae08745Sheppo *reventsp |= POLLHUP; 15921ae08745Sheppo vport->hanged_up = B_FALSE; 15931ae08745Sheppo } 15941ae08745Sheppo 15951ae08745Sheppo mutex_exit(&vminor->lock); 15961ae08745Sheppo 15971ae08745Sheppo if (((*reventsp) == 0) && (!anyyet)) { 15981ae08745Sheppo *phpp = &vport->poll; 15991ae08745Sheppo } 16001ae08745Sheppo 16011ae08745Sheppo D2("vldc_chpoll: vldc@%d:%lu ev=0x%x, rev=0x%x\n", 16021ae08745Sheppo instance, portno, events, *reventsp); 16031ae08745Sheppo 16041ae08745Sheppo return (0); 16051ae08745Sheppo } 1606