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 2004 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 /* Copyright (c) 1984, 1986, 1987, 1988, 1989 AT&T */ 28*0Sstevel@tonic-gate /* All Rights Reserved */ 29*0Sstevel@tonic-gate 30*0Sstevel@tonic-gate 31*0Sstevel@tonic-gate #pragma ident "%Z%%M% %I% %E% SMI" /* from S5R4 1.10 */ 32*0Sstevel@tonic-gate 33*0Sstevel@tonic-gate /* 34*0Sstevel@tonic-gate * Description: The pckt module packetizes messages on 35*0Sstevel@tonic-gate * its read queue by pre-fixing an M_PROTO 36*0Sstevel@tonic-gate * message type to certain incoming messages. 37*0Sstevel@tonic-gate */ 38*0Sstevel@tonic-gate 39*0Sstevel@tonic-gate #include <sys/types.h> 40*0Sstevel@tonic-gate #include <sys/param.h> 41*0Sstevel@tonic-gate #include <sys/stream.h> 42*0Sstevel@tonic-gate #include <sys/stropts.h> 43*0Sstevel@tonic-gate #include <sys/kmem.h> 44*0Sstevel@tonic-gate #include <sys/errno.h> 45*0Sstevel@tonic-gate #include <sys/ddi.h> 46*0Sstevel@tonic-gate #include <sys/sunddi.h> 47*0Sstevel@tonic-gate #include <sys/debug.h> 48*0Sstevel@tonic-gate 49*0Sstevel@tonic-gate /* 50*0Sstevel@tonic-gate * This is the loadable module wrapper. 51*0Sstevel@tonic-gate */ 52*0Sstevel@tonic-gate #include <sys/conf.h> 53*0Sstevel@tonic-gate #include <sys/modctl.h> 54*0Sstevel@tonic-gate 55*0Sstevel@tonic-gate static struct streamtab pcktinfo; 56*0Sstevel@tonic-gate 57*0Sstevel@tonic-gate /* 58*0Sstevel@tonic-gate * Per queue instances are single-threaded since the q_ptr 59*0Sstevel@tonic-gate * field of queues need to be shared among threads. 60*0Sstevel@tonic-gate */ 61*0Sstevel@tonic-gate static struct fmodsw fsw = { 62*0Sstevel@tonic-gate "pckt", 63*0Sstevel@tonic-gate &pcktinfo, 64*0Sstevel@tonic-gate D_NEW | D_MTPERQ | D_MP 65*0Sstevel@tonic-gate }; 66*0Sstevel@tonic-gate 67*0Sstevel@tonic-gate /* 68*0Sstevel@tonic-gate * Module linkage information for the kernel. 69*0Sstevel@tonic-gate */ 70*0Sstevel@tonic-gate 71*0Sstevel@tonic-gate static struct modlstrmod modlstrmod = { 72*0Sstevel@tonic-gate &mod_strmodops, 73*0Sstevel@tonic-gate "pckt module", 74*0Sstevel@tonic-gate &fsw 75*0Sstevel@tonic-gate }; 76*0Sstevel@tonic-gate 77*0Sstevel@tonic-gate static struct modlinkage modlinkage = { 78*0Sstevel@tonic-gate MODREV_1, &modlstrmod, NULL 79*0Sstevel@tonic-gate }; 80*0Sstevel@tonic-gate 81*0Sstevel@tonic-gate 82*0Sstevel@tonic-gate int 83*0Sstevel@tonic-gate _init(void) 84*0Sstevel@tonic-gate { 85*0Sstevel@tonic-gate return (mod_install(&modlinkage)); 86*0Sstevel@tonic-gate } 87*0Sstevel@tonic-gate 88*0Sstevel@tonic-gate int 89*0Sstevel@tonic-gate _fini(void) 90*0Sstevel@tonic-gate { 91*0Sstevel@tonic-gate return (mod_remove(&modlinkage)); 92*0Sstevel@tonic-gate } 93*0Sstevel@tonic-gate 94*0Sstevel@tonic-gate int 95*0Sstevel@tonic-gate _info(struct modinfo *modinfop) 96*0Sstevel@tonic-gate { 97*0Sstevel@tonic-gate return (mod_info(&modlinkage, modinfop)); 98*0Sstevel@tonic-gate } 99*0Sstevel@tonic-gate 100*0Sstevel@tonic-gate static int pcktopen(queue_t *, dev_t *, int, int, cred_t *); 101*0Sstevel@tonic-gate static int pcktclose(queue_t *, int, cred_t *); 102*0Sstevel@tonic-gate static void pcktrput(queue_t *, mblk_t *); 103*0Sstevel@tonic-gate static void pcktrsrv(queue_t *); 104*0Sstevel@tonic-gate static void pcktwput(queue_t *, mblk_t *); 105*0Sstevel@tonic-gate static mblk_t *add_ctl_info(queue_t *, mblk_t *); 106*0Sstevel@tonic-gate static void add_ctl_wkup(void *); 107*0Sstevel@tonic-gate 108*0Sstevel@tonic-gate 109*0Sstevel@tonic-gate /* 110*0Sstevel@tonic-gate * Stream module data structure definitions. 111*0Sstevel@tonic-gate * Sits over the ptm module generally. 112*0Sstevel@tonic-gate * 113*0Sstevel@tonic-gate * Read side flow control strategy: Since we may be putting messages on 114*0Sstevel@tonic-gate * the read q due to allocb failures, these failures must get 115*0Sstevel@tonic-gate * reflected fairly quickly to the module below us. 116*0Sstevel@tonic-gate * No sense in piling on messages in times of memory shortage. 117*0Sstevel@tonic-gate * Further, for the case of upper level flow control, there is no 118*0Sstevel@tonic-gate * compelling reason to have more buffering in this module. 119*0Sstevel@tonic-gate * Thus use a hi-water mark of one. 120*0Sstevel@tonic-gate * This module imposes no max packet size, there is no inherent reason 121*0Sstevel@tonic-gate * in the code to do so. 122*0Sstevel@tonic-gate */ 123*0Sstevel@tonic-gate static struct module_info pcktiinfo = { 124*0Sstevel@tonic-gate 0x9898, /* module id number */ 125*0Sstevel@tonic-gate "pckt", /* module name */ 126*0Sstevel@tonic-gate 0, /* minimum packet size */ 127*0Sstevel@tonic-gate INFPSZ, /* maximum packet size */ 128*0Sstevel@tonic-gate 1, /* hi-water mark */ 129*0Sstevel@tonic-gate 0 /* lo-water mark */ 130*0Sstevel@tonic-gate }; 131*0Sstevel@tonic-gate 132*0Sstevel@tonic-gate /* 133*0Sstevel@tonic-gate * Write side flow control strategy: There is no write service procedure. 134*0Sstevel@tonic-gate * The write put function is pass thru, thus there is no reason to have any 135*0Sstevel@tonic-gate * limits on the maximum packet size. 136*0Sstevel@tonic-gate */ 137*0Sstevel@tonic-gate static struct module_info pcktoinfo = { 138*0Sstevel@tonic-gate 0x9898, /* module id number */ 139*0Sstevel@tonic-gate "pckt", /* module name */ 140*0Sstevel@tonic-gate 0, /* minimum packet size */ 141*0Sstevel@tonic-gate INFPSZ, /* maximum packet size */ 142*0Sstevel@tonic-gate 0, /* hi-water mark */ 143*0Sstevel@tonic-gate 0 /* lo-water mark */ 144*0Sstevel@tonic-gate }; 145*0Sstevel@tonic-gate 146*0Sstevel@tonic-gate static struct qinit pcktrinit = { 147*0Sstevel@tonic-gate (int (*)())pcktrput, 148*0Sstevel@tonic-gate (int (*)())pcktrsrv, 149*0Sstevel@tonic-gate pcktopen, 150*0Sstevel@tonic-gate pcktclose, 151*0Sstevel@tonic-gate NULL, 152*0Sstevel@tonic-gate &pcktiinfo, 153*0Sstevel@tonic-gate NULL 154*0Sstevel@tonic-gate }; 155*0Sstevel@tonic-gate 156*0Sstevel@tonic-gate static struct qinit pcktwinit = { 157*0Sstevel@tonic-gate (int (*)())pcktwput, 158*0Sstevel@tonic-gate NULL, 159*0Sstevel@tonic-gate NULL, 160*0Sstevel@tonic-gate NULL, 161*0Sstevel@tonic-gate NULL, 162*0Sstevel@tonic-gate &pcktoinfo, 163*0Sstevel@tonic-gate NULL 164*0Sstevel@tonic-gate }; 165*0Sstevel@tonic-gate 166*0Sstevel@tonic-gate static struct streamtab pcktinfo = { 167*0Sstevel@tonic-gate &pcktrinit, 168*0Sstevel@tonic-gate &pcktwinit, 169*0Sstevel@tonic-gate NULL, 170*0Sstevel@tonic-gate NULL 171*0Sstevel@tonic-gate }; 172*0Sstevel@tonic-gate 173*0Sstevel@tonic-gate 174*0Sstevel@tonic-gate /* 175*0Sstevel@tonic-gate * Per-instance state struct for the pckt module. 176*0Sstevel@tonic-gate */ 177*0Sstevel@tonic-gate struct pckt_info { 178*0Sstevel@tonic-gate queue_t *pi_qptr; /* back pointer to q */ 179*0Sstevel@tonic-gate bufcall_id_t pi_bufcall_id; 180*0Sstevel@tonic-gate #ifdef _MULTI_DATAMODEL 181*0Sstevel@tonic-gate model_t model; 182*0Sstevel@tonic-gate #endif /* _MULTI_DATAMODEL */ 183*0Sstevel@tonic-gate }; 184*0Sstevel@tonic-gate 185*0Sstevel@tonic-gate /* 186*0Sstevel@tonic-gate * Dummy qbufcall callback routine used by open and close. 187*0Sstevel@tonic-gate * The framework will wake up qwait_sig when we return from 188*0Sstevel@tonic-gate * this routine (as part of leaving the perimeters.) 189*0Sstevel@tonic-gate * (The framework enters the perimeters before calling the qbufcall() callback 190*0Sstevel@tonic-gate * and leaves the perimeters after the callback routine has executed. The 191*0Sstevel@tonic-gate * framework performs an implicit wakeup of any thread in qwait/qwait_sig 192*0Sstevel@tonic-gate * when it leaves the perimeter. See qwait(9E).) 193*0Sstevel@tonic-gate */ 194*0Sstevel@tonic-gate /* ARGSUSED */ 195*0Sstevel@tonic-gate static void 196*0Sstevel@tonic-gate dummy_callback(void *arg) 197*0Sstevel@tonic-gate {} 198*0Sstevel@tonic-gate 199*0Sstevel@tonic-gate /* 200*0Sstevel@tonic-gate * pcktopen - open routine gets called when the 201*0Sstevel@tonic-gate * module gets pushed onto the stream. 202*0Sstevel@tonic-gate */ 203*0Sstevel@tonic-gate /*ARGSUSED*/ 204*0Sstevel@tonic-gate static int 205*0Sstevel@tonic-gate pcktopen( 206*0Sstevel@tonic-gate queue_t *q, /* pointer to the read side queue */ 207*0Sstevel@tonic-gate dev_t *devp, /* pointer to stream tail's dev */ 208*0Sstevel@tonic-gate int oflag, /* the user open(2) supplied flags */ 209*0Sstevel@tonic-gate int sflag, /* open state flag */ 210*0Sstevel@tonic-gate cred_t *credp) /* credentials */ 211*0Sstevel@tonic-gate { 212*0Sstevel@tonic-gate struct pckt_info *pip; 213*0Sstevel@tonic-gate mblk_t *mop; /* ptr to a setopts msg block */ 214*0Sstevel@tonic-gate struct stroptions *sop; 215*0Sstevel@tonic-gate 216*0Sstevel@tonic-gate if (sflag != MODOPEN) 217*0Sstevel@tonic-gate return (EINVAL); 218*0Sstevel@tonic-gate 219*0Sstevel@tonic-gate if (q->q_ptr != NULL) { 220*0Sstevel@tonic-gate /* It's already attached. */ 221*0Sstevel@tonic-gate return (0); 222*0Sstevel@tonic-gate } 223*0Sstevel@tonic-gate 224*0Sstevel@tonic-gate /* 225*0Sstevel@tonic-gate * Allocate state structure. 226*0Sstevel@tonic-gate */ 227*0Sstevel@tonic-gate pip = kmem_alloc(sizeof (*pip), KM_SLEEP); 228*0Sstevel@tonic-gate bzero(pip, sizeof (*pip)); 229*0Sstevel@tonic-gate 230*0Sstevel@tonic-gate #ifdef _MULTI_DATAMODEL 231*0Sstevel@tonic-gate pip->model = ddi_model_convert_from(get_udatamodel()); 232*0Sstevel@tonic-gate #endif /* _MULTI_DATAMODEL */ 233*0Sstevel@tonic-gate 234*0Sstevel@tonic-gate /* 235*0Sstevel@tonic-gate * Cross-link. 236*0Sstevel@tonic-gate */ 237*0Sstevel@tonic-gate pip->pi_qptr = q; 238*0Sstevel@tonic-gate q->q_ptr = pip; 239*0Sstevel@tonic-gate WR(q)->q_ptr = pip; 240*0Sstevel@tonic-gate 241*0Sstevel@tonic-gate qprocson(q); 242*0Sstevel@tonic-gate 243*0Sstevel@tonic-gate /* 244*0Sstevel@tonic-gate * Initialize an M_SETOPTS message to set up hi/lo water marks on 245*0Sstevel@tonic-gate * stream head read queue. 246*0Sstevel@tonic-gate */ 247*0Sstevel@tonic-gate 248*0Sstevel@tonic-gate while ((mop = allocb(sizeof (struct stroptions), BPRI_MED)) == NULL) { 249*0Sstevel@tonic-gate bufcall_id_t id = qbufcall(q, sizeof (struct stroptions), 250*0Sstevel@tonic-gate BPRI_MED, dummy_callback, NULL); 251*0Sstevel@tonic-gate if (!qwait_sig(q)) { 252*0Sstevel@tonic-gate qunbufcall(q, id); 253*0Sstevel@tonic-gate kmem_free(pip, sizeof (*pip)); 254*0Sstevel@tonic-gate qprocsoff(q); 255*0Sstevel@tonic-gate return (EINTR); 256*0Sstevel@tonic-gate } 257*0Sstevel@tonic-gate qunbufcall(q, id); 258*0Sstevel@tonic-gate } 259*0Sstevel@tonic-gate 260*0Sstevel@tonic-gate 261*0Sstevel@tonic-gate /* 262*0Sstevel@tonic-gate * XXX: Should this module really control the hi/low water marks? 263*0Sstevel@tonic-gate * Is there any reason in this code to do so? 264*0Sstevel@tonic-gate */ 265*0Sstevel@tonic-gate mop->b_datap->db_type = M_SETOPTS; 266*0Sstevel@tonic-gate mop->b_wptr += sizeof (struct stroptions); 267*0Sstevel@tonic-gate sop = (struct stroptions *)mop->b_rptr; 268*0Sstevel@tonic-gate sop->so_flags = SO_HIWAT | SO_LOWAT; 269*0Sstevel@tonic-gate sop->so_hiwat = 512; 270*0Sstevel@tonic-gate sop->so_lowat = 256; 271*0Sstevel@tonic-gate 272*0Sstevel@tonic-gate /* 273*0Sstevel@tonic-gate * Commit to the open and send the M_SETOPTS off to the stream head. 274*0Sstevel@tonic-gate */ 275*0Sstevel@tonic-gate putnext(q, mop); 276*0Sstevel@tonic-gate 277*0Sstevel@tonic-gate return (0); 278*0Sstevel@tonic-gate } 279*0Sstevel@tonic-gate 280*0Sstevel@tonic-gate 281*0Sstevel@tonic-gate /* 282*0Sstevel@tonic-gate * pcktclose - This routine gets called when the module 283*0Sstevel@tonic-gate * gets popped off of the stream. 284*0Sstevel@tonic-gate */ 285*0Sstevel@tonic-gate 286*0Sstevel@tonic-gate /*ARGSUSED*/ 287*0Sstevel@tonic-gate static int 288*0Sstevel@tonic-gate pcktclose( 289*0Sstevel@tonic-gate queue_t *q, /* Pointer to the read queue */ 290*0Sstevel@tonic-gate int flag, 291*0Sstevel@tonic-gate cred_t *credp) 292*0Sstevel@tonic-gate { 293*0Sstevel@tonic-gate struct pckt_info *pip = (struct pckt_info *)q->q_ptr; 294*0Sstevel@tonic-gate 295*0Sstevel@tonic-gate qprocsoff(q); 296*0Sstevel@tonic-gate /* 297*0Sstevel@tonic-gate * Cancel outstanding qbufcall 298*0Sstevel@tonic-gate */ 299*0Sstevel@tonic-gate if (pip->pi_bufcall_id) { 300*0Sstevel@tonic-gate qunbufcall(q, pip->pi_bufcall_id); 301*0Sstevel@tonic-gate pip->pi_bufcall_id = 0; 302*0Sstevel@tonic-gate } 303*0Sstevel@tonic-gate /* 304*0Sstevel@tonic-gate * Do not worry about msgs queued on the q, the framework 305*0Sstevel@tonic-gate * will free them up. 306*0Sstevel@tonic-gate */ 307*0Sstevel@tonic-gate kmem_free(q->q_ptr, sizeof (struct pckt_info)); 308*0Sstevel@tonic-gate q->q_ptr = WR(q)->q_ptr = NULL; 309*0Sstevel@tonic-gate return (0); 310*0Sstevel@tonic-gate } 311*0Sstevel@tonic-gate 312*0Sstevel@tonic-gate /* 313*0Sstevel@tonic-gate * pcktrput - Module read queue put procedure. 314*0Sstevel@tonic-gate * This is called from the module or 315*0Sstevel@tonic-gate * driver downstream. 316*0Sstevel@tonic-gate */ 317*0Sstevel@tonic-gate static void 318*0Sstevel@tonic-gate pcktrput( 319*0Sstevel@tonic-gate queue_t *q, /* Pointer to the read queue */ 320*0Sstevel@tonic-gate mblk_t *mp) /* Pointer to the current message block */ 321*0Sstevel@tonic-gate { 322*0Sstevel@tonic-gate mblk_t *pckt_msgp; 323*0Sstevel@tonic-gate 324*0Sstevel@tonic-gate 325*0Sstevel@tonic-gate switch (mp->b_datap->db_type) { 326*0Sstevel@tonic-gate case M_FLUSH: 327*0Sstevel@tonic-gate /* 328*0Sstevel@tonic-gate * The PTS driver swaps the FLUSHR and FLUSHW flags 329*0Sstevel@tonic-gate * we need to swap them back to reflect the actual 330*0Sstevel@tonic-gate * slave side FLUSH mode. 331*0Sstevel@tonic-gate */ 332*0Sstevel@tonic-gate if ((*mp->b_rptr & FLUSHRW) != FLUSHRW) 333*0Sstevel@tonic-gate if ((*mp->b_rptr & FLUSHRW) == FLUSHR) 334*0Sstevel@tonic-gate *mp->b_rptr = FLUSHW; 335*0Sstevel@tonic-gate else if ((*mp->b_rptr & FLUSHRW) == FLUSHW) 336*0Sstevel@tonic-gate *mp->b_rptr = FLUSHR; 337*0Sstevel@tonic-gate 338*0Sstevel@tonic-gate pckt_msgp = copymsg(mp); 339*0Sstevel@tonic-gate if (*mp->b_rptr & FLUSHW) { 340*0Sstevel@tonic-gate /* 341*0Sstevel@tonic-gate * In the packet model we are not allowing 342*0Sstevel@tonic-gate * flushes of the master's stream head read 343*0Sstevel@tonic-gate * side queue. This is because all packet 344*0Sstevel@tonic-gate * state information is stored there and 345*0Sstevel@tonic-gate * a flush could destroy this data before 346*0Sstevel@tonic-gate * it is read. 347*0Sstevel@tonic-gate */ 348*0Sstevel@tonic-gate *mp->b_rptr = FLUSHW; 349*0Sstevel@tonic-gate putnext(q, mp); 350*0Sstevel@tonic-gate } else { 351*0Sstevel@tonic-gate /* 352*0Sstevel@tonic-gate * Free messages that only flush the 353*0Sstevel@tonic-gate * master's read queue. 354*0Sstevel@tonic-gate */ 355*0Sstevel@tonic-gate freemsg(mp); 356*0Sstevel@tonic-gate } 357*0Sstevel@tonic-gate 358*0Sstevel@tonic-gate if (pckt_msgp == NULL) 359*0Sstevel@tonic-gate break; 360*0Sstevel@tonic-gate 361*0Sstevel@tonic-gate mp = pckt_msgp; 362*0Sstevel@tonic-gate /* 363*0Sstevel@tonic-gate * Prefix M_PROTO and putnext. 364*0Sstevel@tonic-gate */ 365*0Sstevel@tonic-gate goto prefix_head; 366*0Sstevel@tonic-gate 367*0Sstevel@tonic-gate case M_DATA: 368*0Sstevel@tonic-gate case M_IOCTL: 369*0Sstevel@tonic-gate case M_PROTO: 370*0Sstevel@tonic-gate /* 371*0Sstevel@tonic-gate * For non-priority messages, follow flow-control rules. 372*0Sstevel@tonic-gate * Also, if there are messages on the q already, keep 373*0Sstevel@tonic-gate * queueing them since they need to be processed in order. 374*0Sstevel@tonic-gate */ 375*0Sstevel@tonic-gate if (!canputnext(q) || (qsize(q) > 0)) { 376*0Sstevel@tonic-gate (void) putq(q, mp); 377*0Sstevel@tonic-gate break; 378*0Sstevel@tonic-gate } 379*0Sstevel@tonic-gate /* FALLTHROUGH */ 380*0Sstevel@tonic-gate 381*0Sstevel@tonic-gate /* 382*0Sstevel@tonic-gate * For high priority messages, skip flow control checks. 383*0Sstevel@tonic-gate */ 384*0Sstevel@tonic-gate case M_PCPROTO: 385*0Sstevel@tonic-gate case M_READ: 386*0Sstevel@tonic-gate case M_STOP: 387*0Sstevel@tonic-gate case M_START: 388*0Sstevel@tonic-gate case M_STARTI: 389*0Sstevel@tonic-gate case M_STOPI: 390*0Sstevel@tonic-gate prefix_head: 391*0Sstevel@tonic-gate /* 392*0Sstevel@tonic-gate * Prefix an M_PROTO header to message and pass upstream. 393*0Sstevel@tonic-gate */ 394*0Sstevel@tonic-gate if ((mp = add_ctl_info(q, mp)) != NULL) 395*0Sstevel@tonic-gate putnext(q, mp); 396*0Sstevel@tonic-gate break; 397*0Sstevel@tonic-gate 398*0Sstevel@tonic-gate default: 399*0Sstevel@tonic-gate /* 400*0Sstevel@tonic-gate * For data messages, queue them back on the queue if 401*0Sstevel@tonic-gate * there are messages on the queue already. This is 402*0Sstevel@tonic-gate * done to preserve the order of messages. 403*0Sstevel@tonic-gate * For high priority messages or for no messages on the 404*0Sstevel@tonic-gate * q, simply putnext() and pass it on. 405*0Sstevel@tonic-gate */ 406*0Sstevel@tonic-gate if ((datamsg(mp->b_datap->db_type)) && (qsize(q) > 0)) 407*0Sstevel@tonic-gate (void) putq(q, mp); 408*0Sstevel@tonic-gate else 409*0Sstevel@tonic-gate putnext(q, mp); 410*0Sstevel@tonic-gate break; 411*0Sstevel@tonic-gate } 412*0Sstevel@tonic-gate } 413*0Sstevel@tonic-gate 414*0Sstevel@tonic-gate /* 415*0Sstevel@tonic-gate * pcktrsrv - module read service procedure 416*0Sstevel@tonic-gate * This function deals with messages left in the queue due to 417*0Sstevel@tonic-gate * (a) not enough memory to allocate the header M_PROTO message 418*0Sstevel@tonic-gate * (b) flow control reasons 419*0Sstevel@tonic-gate * The function will attempt to get the messages off the queue and 420*0Sstevel@tonic-gate * process them. 421*0Sstevel@tonic-gate */ 422*0Sstevel@tonic-gate static void 423*0Sstevel@tonic-gate pcktrsrv(queue_t *q) 424*0Sstevel@tonic-gate { 425*0Sstevel@tonic-gate mblk_t *mp; 426*0Sstevel@tonic-gate 427*0Sstevel@tonic-gate while ((mp = getq(q)) != NULL) { 428*0Sstevel@tonic-gate if (!canputnext(q)) { 429*0Sstevel@tonic-gate /* 430*0Sstevel@tonic-gate * For high priority messages, make sure there is no 431*0Sstevel@tonic-gate * infinite loop. Disable the queue for this case. 432*0Sstevel@tonic-gate * High priority messages get here only for buffer 433*0Sstevel@tonic-gate * allocation failures. Thus the bufcall callout 434*0Sstevel@tonic-gate * will reenable the q. 435*0Sstevel@tonic-gate * XXX bug alert - nooenable will *not* prevent 436*0Sstevel@tonic-gate * putbq of a hipri messages frm enabling the queue. 437*0Sstevel@tonic-gate */ 438*0Sstevel@tonic-gate if (!datamsg(mp->b_datap->db_type)) 439*0Sstevel@tonic-gate noenable(q); 440*0Sstevel@tonic-gate (void) putbq(q, mp); 441*0Sstevel@tonic-gate return; 442*0Sstevel@tonic-gate } 443*0Sstevel@tonic-gate 444*0Sstevel@tonic-gate /* 445*0Sstevel@tonic-gate * M_FLUSH msgs may also be here if there was a memory 446*0Sstevel@tonic-gate * failure. 447*0Sstevel@tonic-gate */ 448*0Sstevel@tonic-gate switch (mp->b_datap->db_type) { 449*0Sstevel@tonic-gate case M_FLUSH: 450*0Sstevel@tonic-gate case M_PROTO: 451*0Sstevel@tonic-gate case M_PCPROTO: 452*0Sstevel@tonic-gate case M_STOP: 453*0Sstevel@tonic-gate case M_START: 454*0Sstevel@tonic-gate case M_IOCTL: 455*0Sstevel@tonic-gate case M_DATA: 456*0Sstevel@tonic-gate case M_READ: 457*0Sstevel@tonic-gate case M_STARTI: 458*0Sstevel@tonic-gate case M_STOPI: 459*0Sstevel@tonic-gate /* 460*0Sstevel@tonic-gate * Prefix an M_PROTO header to msg and pass upstream. 461*0Sstevel@tonic-gate */ 462*0Sstevel@tonic-gate if ((mp = add_ctl_info(q, mp)) == NULL) { 463*0Sstevel@tonic-gate /* 464*0Sstevel@tonic-gate * Running into memory or flow ctl problems. 465*0Sstevel@tonic-gate */ 466*0Sstevel@tonic-gate return; 467*0Sstevel@tonic-gate } 468*0Sstevel@tonic-gate /* FALL THROUGH */ 469*0Sstevel@tonic-gate 470*0Sstevel@tonic-gate default: 471*0Sstevel@tonic-gate putnext(q, mp); 472*0Sstevel@tonic-gate break; 473*0Sstevel@tonic-gate } 474*0Sstevel@tonic-gate } 475*0Sstevel@tonic-gate } 476*0Sstevel@tonic-gate 477*0Sstevel@tonic-gate /* 478*0Sstevel@tonic-gate * pcktwput - Module write queue put procedure. 479*0Sstevel@tonic-gate * All messages are send downstream unchanged 480*0Sstevel@tonic-gate */ 481*0Sstevel@tonic-gate 482*0Sstevel@tonic-gate static void 483*0Sstevel@tonic-gate pcktwput( 484*0Sstevel@tonic-gate queue_t *q, /* Pointer to the read queue */ 485*0Sstevel@tonic-gate mblk_t *mp) /* Pointer to current message block */ 486*0Sstevel@tonic-gate { 487*0Sstevel@tonic-gate putnext(q, mp); 488*0Sstevel@tonic-gate } 489*0Sstevel@tonic-gate 490*0Sstevel@tonic-gate #ifdef _MULTI_DATAMODEL 491*0Sstevel@tonic-gate /* 492*0Sstevel@tonic-gate * reallocb - copy the data block from the given message block into a new block. 493*0Sstevel@tonic-gate * This function is used in case data block had another message block 494*0Sstevel@tonic-gate * pointing to it (and hence we just copy this one data block). 495*0Sstevel@tonic-gate * 496*0Sstevel@tonic-gate * Returns new message block if successful. On failure it returns NULL. 497*0Sstevel@tonic-gate * It also tries to do a qbufcall and if that also fails, 498*0Sstevel@tonic-gate * it frees the message block. 499*0Sstevel@tonic-gate */ 500*0Sstevel@tonic-gate static mblk_t * 501*0Sstevel@tonic-gate pckt_reallocb( 502*0Sstevel@tonic-gate queue_t *q, /* Pointer to the read queue */ 503*0Sstevel@tonic-gate mblk_t *mp /* Pointer to the message block to be changed */ 504*0Sstevel@tonic-gate ) 505*0Sstevel@tonic-gate { 506*0Sstevel@tonic-gate mblk_t *nmp; 507*0Sstevel@tonic-gate 508*0Sstevel@tonic-gate ASSERT(mp->b_datap->db_ref >= 1); 509*0Sstevel@tonic-gate 510*0Sstevel@tonic-gate /* 511*0Sstevel@tonic-gate * No reallocation is needed if there is only one reference 512*0Sstevel@tonic-gate * to this data block. 513*0Sstevel@tonic-gate */ 514*0Sstevel@tonic-gate if (mp->b_datap->db_ref == 1) 515*0Sstevel@tonic-gate return (mp); 516*0Sstevel@tonic-gate 517*0Sstevel@tonic-gate if ((nmp = copyb(mp)) == NULL) { 518*0Sstevel@tonic-gate struct pckt_info *pip = (struct pckt_info *)q->q_ptr; 519*0Sstevel@tonic-gate 520*0Sstevel@tonic-gate noenable(q); 521*0Sstevel@tonic-gate if (pip->pi_bufcall_id = qbufcall(q, mp->b_wptr - mp->b_rptr, 522*0Sstevel@tonic-gate BPRI_MED, add_ctl_wkup, q)) { 523*0Sstevel@tonic-gate /* 524*0Sstevel@tonic-gate * Put the message back onto the q. 525*0Sstevel@tonic-gate */ 526*0Sstevel@tonic-gate (void) putq(q, mp); 527*0Sstevel@tonic-gate } else { 528*0Sstevel@tonic-gate /* 529*0Sstevel@tonic-gate * Things are pretty bad and serious if bufcall fails! 530*0Sstevel@tonic-gate * Drop the message in this case. 531*0Sstevel@tonic-gate */ 532*0Sstevel@tonic-gate freemsg(mp); 533*0Sstevel@tonic-gate } 534*0Sstevel@tonic-gate return ((mblk_t *)0); 535*0Sstevel@tonic-gate } 536*0Sstevel@tonic-gate 537*0Sstevel@tonic-gate nmp->b_cont = mp->b_cont; 538*0Sstevel@tonic-gate freeb(mp); 539*0Sstevel@tonic-gate return (nmp); 540*0Sstevel@tonic-gate } 541*0Sstevel@tonic-gate #endif /* _MULTI_DATAMODEL */ 542*0Sstevel@tonic-gate 543*0Sstevel@tonic-gate /* 544*0Sstevel@tonic-gate * add_ctl_info: add message control information to in coming 545*0Sstevel@tonic-gate * message. 546*0Sstevel@tonic-gate */ 547*0Sstevel@tonic-gate static mblk_t * 548*0Sstevel@tonic-gate add_ctl_info( 549*0Sstevel@tonic-gate queue_t *q, /* pointer to the read queue */ 550*0Sstevel@tonic-gate mblk_t *mp) /* pointer to the raw data input message */ 551*0Sstevel@tonic-gate { 552*0Sstevel@tonic-gate struct pckt_info *pip = (struct pckt_info *)q->q_ptr; 553*0Sstevel@tonic-gate mblk_t *bp; /* pointer to the unmodified message block */ 554*0Sstevel@tonic-gate 555*0Sstevel@tonic-gate /* 556*0Sstevel@tonic-gate * Waiting on space for previous message? 557*0Sstevel@tonic-gate */ 558*0Sstevel@tonic-gate if (pip->pi_bufcall_id) { 559*0Sstevel@tonic-gate /* 560*0Sstevel@tonic-gate * Chain this message on to q for later processing. 561*0Sstevel@tonic-gate */ 562*0Sstevel@tonic-gate (void) putq(q, mp); 563*0Sstevel@tonic-gate return (NULL); 564*0Sstevel@tonic-gate } 565*0Sstevel@tonic-gate 566*0Sstevel@tonic-gate /* 567*0Sstevel@tonic-gate * Need to add the message block header as 568*0Sstevel@tonic-gate * an M_PROTO type message. 569*0Sstevel@tonic-gate */ 570*0Sstevel@tonic-gate if ((bp = allocb(sizeof (char), BPRI_MED)) == (mblk_t *)NULL) { 571*0Sstevel@tonic-gate 572*0Sstevel@tonic-gate /* 573*0Sstevel@tonic-gate * There are two reasons to disable the q: 574*0Sstevel@tonic-gate * (1) Flow control reasons should not wake up the q. 575*0Sstevel@tonic-gate * (2) High priority messages will wakeup the q 576*0Sstevel@tonic-gate * immediately. Disallow this. 577*0Sstevel@tonic-gate */ 578*0Sstevel@tonic-gate noenable(q); 579*0Sstevel@tonic-gate if (pip->pi_bufcall_id = qbufcall(q, sizeof (char), BPRI_MED, 580*0Sstevel@tonic-gate add_ctl_wkup, q)) { 581*0Sstevel@tonic-gate /* 582*0Sstevel@tonic-gate * Add the message to the q. 583*0Sstevel@tonic-gate */ 584*0Sstevel@tonic-gate (void) putq(q, mp); 585*0Sstevel@tonic-gate } else { 586*0Sstevel@tonic-gate /* 587*0Sstevel@tonic-gate * Things are pretty bad and serious if bufcall fails! 588*0Sstevel@tonic-gate * Drop the message in this case. 589*0Sstevel@tonic-gate */ 590*0Sstevel@tonic-gate freemsg(mp); 591*0Sstevel@tonic-gate } 592*0Sstevel@tonic-gate 593*0Sstevel@tonic-gate return (NULL); 594*0Sstevel@tonic-gate } 595*0Sstevel@tonic-gate 596*0Sstevel@tonic-gate /* 597*0Sstevel@tonic-gate * Copy the message type information to this message. 598*0Sstevel@tonic-gate */ 599*0Sstevel@tonic-gate bp->b_datap->db_type = M_PROTO; 600*0Sstevel@tonic-gate *(unsigned char *)bp->b_rptr = mp->b_datap->db_type; 601*0Sstevel@tonic-gate bp->b_wptr++; 602*0Sstevel@tonic-gate 603*0Sstevel@tonic-gate #ifdef _MULTI_DATAMODEL 604*0Sstevel@tonic-gate /* 605*0Sstevel@tonic-gate * Check the datamodel and if the calling program is 606*0Sstevel@tonic-gate * an ILP32 application then we covert the M_IOCTLs and M_READs 607*0Sstevel@tonic-gate * into the native ILP32 format before passing them upstream 608*0Sstevel@tonic-gate * to user mode. 609*0Sstevel@tonic-gate */ 610*0Sstevel@tonic-gate switch (pip->model) { 611*0Sstevel@tonic-gate case DDI_MODEL_ILP32: 612*0Sstevel@tonic-gate switch (mp->b_datap->db_type) { 613*0Sstevel@tonic-gate /* 614*0Sstevel@tonic-gate * This structure must have the same shape as 615*0Sstevel@tonic-gate * the * ILP32 compilation of `struct iocblk' 616*0Sstevel@tonic-gate * from <sys/stream.h>. 617*0Sstevel@tonic-gate */ 618*0Sstevel@tonic-gate struct iocblk32 { 619*0Sstevel@tonic-gate int32_t ioc_cmd; 620*0Sstevel@tonic-gate caddr32_t ioc_cr; 621*0Sstevel@tonic-gate uint32_t ioc_id; 622*0Sstevel@tonic-gate int32_t ioc_count; 623*0Sstevel@tonic-gate int32_t ioc_error; 624*0Sstevel@tonic-gate int32_t ioc_rval; 625*0Sstevel@tonic-gate int32_t ioc_fill1; 626*0Sstevel@tonic-gate uint32_t ioc_flag; 627*0Sstevel@tonic-gate int32_t ioc_filler[2]; 628*0Sstevel@tonic-gate } niocblk_32; 629*0Sstevel@tonic-gate struct iocblk *iocblk_64; 630*0Sstevel@tonic-gate 631*0Sstevel@tonic-gate case M_IOCTL: 632*0Sstevel@tonic-gate if ((mp = pckt_reallocb(q, mp)) == (mblk_t *)0) 633*0Sstevel@tonic-gate return ((mblk_t *)0); 634*0Sstevel@tonic-gate 635*0Sstevel@tonic-gate bzero(&niocblk_32, sizeof (niocblk_32)); 636*0Sstevel@tonic-gate iocblk_64 = (struct iocblk *)mp->b_rptr; 637*0Sstevel@tonic-gate 638*0Sstevel@tonic-gate /* Leave the pointer to cred_t structure as it is. */ 639*0Sstevel@tonic-gate niocblk_32.ioc_cmd = iocblk_64->ioc_cmd; 640*0Sstevel@tonic-gate niocblk_32.ioc_cr = (caddr32_t)(uintptr_t) 641*0Sstevel@tonic-gate iocblk_64->ioc_cr; 642*0Sstevel@tonic-gate niocblk_32.ioc_id = iocblk_64->ioc_id; 643*0Sstevel@tonic-gate niocblk_32.ioc_count = iocblk_64->ioc_count; 644*0Sstevel@tonic-gate niocblk_32.ioc_error = iocblk_64->ioc_error; 645*0Sstevel@tonic-gate niocblk_32.ioc_rval = iocblk_64->ioc_rval; 646*0Sstevel@tonic-gate niocblk_32.ioc_flag = iocblk_64->ioc_flag; 647*0Sstevel@tonic-gate 648*0Sstevel@tonic-gate /* Copy the iocblk structure for ILP32 back */ 649*0Sstevel@tonic-gate *(struct iocblk32 *)mp->b_rptr = niocblk_32; 650*0Sstevel@tonic-gate mp->b_wptr = mp->b_rptr + sizeof (struct iocblk32); 651*0Sstevel@tonic-gate break; 652*0Sstevel@tonic-gate 653*0Sstevel@tonic-gate case M_READ: 654*0Sstevel@tonic-gate if ((mp = pckt_reallocb(q, mp)) == (mblk_t *)0) 655*0Sstevel@tonic-gate return ((mblk_t *)0); 656*0Sstevel@tonic-gate 657*0Sstevel@tonic-gate /* change the size_t to size32_t for ILP32 */ 658*0Sstevel@tonic-gate *(size32_t *)mp->b_rptr = *(size_t *)mp->b_rptr; 659*0Sstevel@tonic-gate mp->b_wptr = mp->b_rptr + sizeof (size32_t); 660*0Sstevel@tonic-gate break; 661*0Sstevel@tonic-gate } 662*0Sstevel@tonic-gate break; 663*0Sstevel@tonic-gate 664*0Sstevel@tonic-gate case DATAMODEL_NONE: 665*0Sstevel@tonic-gate break; 666*0Sstevel@tonic-gate } 667*0Sstevel@tonic-gate #endif /* _MULTI_DATAMODEL */ 668*0Sstevel@tonic-gate 669*0Sstevel@tonic-gate /* 670*0Sstevel@tonic-gate * Now change the orginal message type to M_DATA and tie them up. 671*0Sstevel@tonic-gate */ 672*0Sstevel@tonic-gate mp->b_datap->db_type = M_DATA; 673*0Sstevel@tonic-gate bp->b_cont = mp; 674*0Sstevel@tonic-gate 675*0Sstevel@tonic-gate return (bp); 676*0Sstevel@tonic-gate } 677*0Sstevel@tonic-gate 678*0Sstevel@tonic-gate static void 679*0Sstevel@tonic-gate add_ctl_wkup(void *arg) 680*0Sstevel@tonic-gate { 681*0Sstevel@tonic-gate queue_t *q = arg; /* ptr to the read queue */ 682*0Sstevel@tonic-gate struct pckt_info *pip = (struct pckt_info *)q->q_ptr; 683*0Sstevel@tonic-gate 684*0Sstevel@tonic-gate pip->pi_bufcall_id = 0; 685*0Sstevel@tonic-gate /* 686*0Sstevel@tonic-gate * Allow enabling of the q to allow the service 687*0Sstevel@tonic-gate * function to do its job. 688*0Sstevel@tonic-gate * 689*0Sstevel@tonic-gate * Also, qenable() to schedule the q immediately. 690*0Sstevel@tonic-gate * This is to ensure timely processing of high priority 691*0Sstevel@tonic-gate * messages if they are on the q. 692*0Sstevel@tonic-gate */ 693*0Sstevel@tonic-gate enableok(q); 694*0Sstevel@tonic-gate qenable(q); 695*0Sstevel@tonic-gate } 696