1*0Sstevel@tonic-gate /* 2*0Sstevel@tonic-gate * CDDL HEADER START 3*0Sstevel@tonic-gate * 4*0Sstevel@tonic-gate * The contents of this file are subject to the terms of the 5*0Sstevel@tonic-gate * Common Development and Distribution License, Version 1.0 only 6*0Sstevel@tonic-gate * (the "License"). You may not use this file except in compliance 7*0Sstevel@tonic-gate * with the License. 8*0Sstevel@tonic-gate * 9*0Sstevel@tonic-gate * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 10*0Sstevel@tonic-gate * or http://www.opensolaris.org/os/licensing. 11*0Sstevel@tonic-gate * See the License for the specific language governing permissions 12*0Sstevel@tonic-gate * and limitations under the License. 13*0Sstevel@tonic-gate * 14*0Sstevel@tonic-gate * When distributing Covered Code, include this CDDL HEADER in each 15*0Sstevel@tonic-gate * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 16*0Sstevel@tonic-gate * If applicable, add the following below this CDDL HEADER, with the 17*0Sstevel@tonic-gate * fields enclosed by brackets "[]" replaced with your own identifying 18*0Sstevel@tonic-gate * information: Portions Copyright [yyyy] [name of copyright owner] 19*0Sstevel@tonic-gate * 20*0Sstevel@tonic-gate * CDDL HEADER END 21*0Sstevel@tonic-gate */ 22*0Sstevel@tonic-gate /* 23*0Sstevel@tonic-gate * Copyright 2005 Sun Microsystems, Inc. All rights reserved. 24*0Sstevel@tonic-gate * Use is subject to license terms. 25*0Sstevel@tonic-gate */ 26*0Sstevel@tonic-gate 27*0Sstevel@tonic-gate #pragma ident "%Z%%M% %I% %E% SMI" 28*0Sstevel@tonic-gate 29*0Sstevel@tonic-gate /* 30*0Sstevel@tonic-gate * Common Sun DLPI routines. 31*0Sstevel@tonic-gate */ 32*0Sstevel@tonic-gate 33*0Sstevel@tonic-gate #include <sys/types.h> 34*0Sstevel@tonic-gate #include <sys/sysmacros.h> 35*0Sstevel@tonic-gate #include <sys/byteorder.h> 36*0Sstevel@tonic-gate #include <sys/systm.h> 37*0Sstevel@tonic-gate #include <sys/stream.h> 38*0Sstevel@tonic-gate #include <sys/strsun.h> 39*0Sstevel@tonic-gate #include <sys/dlpi.h> 40*0Sstevel@tonic-gate 41*0Sstevel@tonic-gate #define DLADDRL (80) 42*0Sstevel@tonic-gate 43*0Sstevel@tonic-gate void 44*0Sstevel@tonic-gate dlbindack( 45*0Sstevel@tonic-gate queue_t *wq, 46*0Sstevel@tonic-gate mblk_t *mp, 47*0Sstevel@tonic-gate t_scalar_t sap, 48*0Sstevel@tonic-gate void *addrp, 49*0Sstevel@tonic-gate t_uscalar_t addrlen, 50*0Sstevel@tonic-gate t_uscalar_t maxconind, 51*0Sstevel@tonic-gate t_uscalar_t xidtest) 52*0Sstevel@tonic-gate { 53*0Sstevel@tonic-gate union DL_primitives *dlp; 54*0Sstevel@tonic-gate size_t size; 55*0Sstevel@tonic-gate 56*0Sstevel@tonic-gate size = sizeof (dl_bind_ack_t) + addrlen; 57*0Sstevel@tonic-gate if ((mp = mexchange(wq, mp, size, M_PCPROTO, DL_BIND_ACK)) == NULL) 58*0Sstevel@tonic-gate return; 59*0Sstevel@tonic-gate 60*0Sstevel@tonic-gate dlp = (union DL_primitives *)mp->b_rptr; 61*0Sstevel@tonic-gate dlp->bind_ack.dl_sap = sap; 62*0Sstevel@tonic-gate dlp->bind_ack.dl_addr_length = addrlen; 63*0Sstevel@tonic-gate dlp->bind_ack.dl_addr_offset = sizeof (dl_bind_ack_t); 64*0Sstevel@tonic-gate dlp->bind_ack.dl_max_conind = maxconind; 65*0Sstevel@tonic-gate dlp->bind_ack.dl_xidtest_flg = xidtest; 66*0Sstevel@tonic-gate if (addrlen != 0) 67*0Sstevel@tonic-gate bcopy(addrp, mp->b_rptr + sizeof (dl_bind_ack_t), addrlen); 68*0Sstevel@tonic-gate 69*0Sstevel@tonic-gate qreply(wq, mp); 70*0Sstevel@tonic-gate } 71*0Sstevel@tonic-gate 72*0Sstevel@tonic-gate void 73*0Sstevel@tonic-gate dlokack( 74*0Sstevel@tonic-gate queue_t *wq, 75*0Sstevel@tonic-gate mblk_t *mp, 76*0Sstevel@tonic-gate t_uscalar_t correct_primitive) 77*0Sstevel@tonic-gate { 78*0Sstevel@tonic-gate union DL_primitives *dlp; 79*0Sstevel@tonic-gate 80*0Sstevel@tonic-gate if ((mp = mexchange(wq, mp, sizeof (dl_ok_ack_t), M_PCPROTO, 81*0Sstevel@tonic-gate DL_OK_ACK)) == NULL) 82*0Sstevel@tonic-gate return; 83*0Sstevel@tonic-gate dlp = (union DL_primitives *)mp->b_rptr; 84*0Sstevel@tonic-gate dlp->ok_ack.dl_correct_primitive = correct_primitive; 85*0Sstevel@tonic-gate qreply(wq, mp); 86*0Sstevel@tonic-gate } 87*0Sstevel@tonic-gate 88*0Sstevel@tonic-gate void 89*0Sstevel@tonic-gate dlerrorack( 90*0Sstevel@tonic-gate queue_t *wq, 91*0Sstevel@tonic-gate mblk_t *mp, 92*0Sstevel@tonic-gate t_uscalar_t error_primitive, 93*0Sstevel@tonic-gate t_uscalar_t error, 94*0Sstevel@tonic-gate t_uscalar_t unix_errno) 95*0Sstevel@tonic-gate { 96*0Sstevel@tonic-gate union DL_primitives *dlp; 97*0Sstevel@tonic-gate 98*0Sstevel@tonic-gate if ((mp = mexchange(wq, mp, sizeof (dl_error_ack_t), M_PCPROTO, 99*0Sstevel@tonic-gate DL_ERROR_ACK)) == NULL) 100*0Sstevel@tonic-gate return; 101*0Sstevel@tonic-gate dlp = (union DL_primitives *)mp->b_rptr; 102*0Sstevel@tonic-gate dlp->error_ack.dl_error_primitive = error_primitive; 103*0Sstevel@tonic-gate dlp->error_ack.dl_errno = error; 104*0Sstevel@tonic-gate dlp->error_ack.dl_unix_errno = unix_errno; 105*0Sstevel@tonic-gate qreply(wq, mp); 106*0Sstevel@tonic-gate } 107*0Sstevel@tonic-gate 108*0Sstevel@tonic-gate void 109*0Sstevel@tonic-gate dluderrorind( 110*0Sstevel@tonic-gate queue_t *wq, 111*0Sstevel@tonic-gate mblk_t *mp, 112*0Sstevel@tonic-gate void *addrp, 113*0Sstevel@tonic-gate t_uscalar_t addrlen, 114*0Sstevel@tonic-gate t_uscalar_t error, 115*0Sstevel@tonic-gate t_uscalar_t unix_errno) 116*0Sstevel@tonic-gate { 117*0Sstevel@tonic-gate union DL_primitives *dlp; 118*0Sstevel@tonic-gate char buf[DLADDRL]; 119*0Sstevel@tonic-gate size_t size; 120*0Sstevel@tonic-gate 121*0Sstevel@tonic-gate if (addrlen > DLADDRL) 122*0Sstevel@tonic-gate addrlen = DLADDRL; 123*0Sstevel@tonic-gate 124*0Sstevel@tonic-gate bcopy(addrp, buf, addrlen); 125*0Sstevel@tonic-gate 126*0Sstevel@tonic-gate size = sizeof (dl_uderror_ind_t) + addrlen; 127*0Sstevel@tonic-gate 128*0Sstevel@tonic-gate if ((mp = mexchange(wq, mp, size, M_PCPROTO, DL_UDERROR_IND)) == NULL) 129*0Sstevel@tonic-gate return; 130*0Sstevel@tonic-gate 131*0Sstevel@tonic-gate dlp = (union DL_primitives *)mp->b_rptr; 132*0Sstevel@tonic-gate dlp->uderror_ind.dl_dest_addr_length = addrlen; 133*0Sstevel@tonic-gate dlp->uderror_ind.dl_dest_addr_offset = sizeof (dl_uderror_ind_t); 134*0Sstevel@tonic-gate dlp->uderror_ind.dl_unix_errno = unix_errno; 135*0Sstevel@tonic-gate dlp->uderror_ind.dl_errno = error; 136*0Sstevel@tonic-gate bcopy((caddr_t)buf, 137*0Sstevel@tonic-gate (caddr_t)(mp->b_rptr + sizeof (dl_uderror_ind_t)), addrlen); 138*0Sstevel@tonic-gate qreply(wq, mp); 139*0Sstevel@tonic-gate } 140*0Sstevel@tonic-gate 141*0Sstevel@tonic-gate void 142*0Sstevel@tonic-gate dlphysaddrack( 143*0Sstevel@tonic-gate queue_t *wq, 144*0Sstevel@tonic-gate mblk_t *mp, 145*0Sstevel@tonic-gate void *addrp, 146*0Sstevel@tonic-gate t_uscalar_t len) 147*0Sstevel@tonic-gate { 148*0Sstevel@tonic-gate union DL_primitives *dlp; 149*0Sstevel@tonic-gate size_t size; 150*0Sstevel@tonic-gate 151*0Sstevel@tonic-gate size = sizeof (dl_phys_addr_ack_t) + len; 152*0Sstevel@tonic-gate if ((mp = mexchange(wq, mp, size, M_PCPROTO, DL_PHYS_ADDR_ACK)) == NULL) 153*0Sstevel@tonic-gate return; 154*0Sstevel@tonic-gate dlp = (union DL_primitives *)mp->b_rptr; 155*0Sstevel@tonic-gate dlp->physaddr_ack.dl_addr_length = len; 156*0Sstevel@tonic-gate dlp->physaddr_ack.dl_addr_offset = sizeof (dl_phys_addr_ack_t); 157*0Sstevel@tonic-gate if (len != 0) 158*0Sstevel@tonic-gate bcopy(addrp, mp->b_rptr + sizeof (dl_phys_addr_ack_t), len); 159*0Sstevel@tonic-gate qreply(wq, mp); 160*0Sstevel@tonic-gate } 161*0Sstevel@tonic-gate 162*0Sstevel@tonic-gate void 163*0Sstevel@tonic-gate dlcapabsetqid(dl_mid_t *idp, const queue_t *q) 164*0Sstevel@tonic-gate { 165*0Sstevel@tonic-gate #ifndef _LP64 166*0Sstevel@tonic-gate idp->mid[0] = (t_uscalar_t)q; 167*0Sstevel@tonic-gate #else 168*0Sstevel@tonic-gate idp->mid[0] = (t_uscalar_t)BMASK_32((uint64_t)q); 169*0Sstevel@tonic-gate idp->mid[1] = (t_uscalar_t)BMASK_32(((uint64_t)q) >> 32); 170*0Sstevel@tonic-gate #endif 171*0Sstevel@tonic-gate } 172*0Sstevel@tonic-gate 173*0Sstevel@tonic-gate boolean_t 174*0Sstevel@tonic-gate dlcapabcheckqid(const dl_mid_t *idp, const queue_t *q) 175*0Sstevel@tonic-gate { 176*0Sstevel@tonic-gate #ifndef _LP64 177*0Sstevel@tonic-gate return ((queue_t *)(idp->mid[0]) == q); 178*0Sstevel@tonic-gate #else 179*0Sstevel@tonic-gate return ((queue_t *) 180*0Sstevel@tonic-gate ((uint64_t)idp->mid[0] | ((uint64_t)idp->mid[1] << 32)) == q); 181*0Sstevel@tonic-gate #endif 182*0Sstevel@tonic-gate } 183*0Sstevel@tonic-gate 184*0Sstevel@tonic-gate void 185*0Sstevel@tonic-gate dlnotifyack( 186*0Sstevel@tonic-gate queue_t *wq, 187*0Sstevel@tonic-gate mblk_t *mp, 188*0Sstevel@tonic-gate uint32_t notifications) 189*0Sstevel@tonic-gate { 190*0Sstevel@tonic-gate union DL_primitives *dlp; 191*0Sstevel@tonic-gate 192*0Sstevel@tonic-gate if ((mp = mexchange(wq, mp, sizeof (dl_ok_ack_t), M_PROTO, 193*0Sstevel@tonic-gate DL_NOTIFY_ACK)) == NULL) 194*0Sstevel@tonic-gate return; 195*0Sstevel@tonic-gate dlp = (union DL_primitives *)mp->b_rptr; 196*0Sstevel@tonic-gate dlp->notify_ack.dl_notifications = notifications; 197*0Sstevel@tonic-gate qreply(wq, mp); 198*0Sstevel@tonic-gate } 199