xref: /titanic_44/usr/src/uts/common/io/ptm.c (revision da2e3ebdc1edfbc5028edf1354e7dd2fa69a7968)
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License (the "License").
6  * You may not use this file except in compliance with the License.
7  *
8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9  * or http://www.opensolaris.org/os/licensing.
10  * See the License for the specific language governing permissions
11  * and limitations under the License.
12  *
13  * When distributing Covered Code, include this CDDL HEADER in each
14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15  * If applicable, add the following below this CDDL HEADER, with the
16  * fields enclosed by brackets "[]" replaced with your own identifying
17  * information: Portions Copyright [yyyy] [name of copyright owner]
18  *
19  * CDDL HEADER END
20  */
21 /*
22  * Copyright 2007 Sun Microsystems, Inc.  All rights reserved.
23  * Use is subject to license terms.
24  */
25 /*	Copyright (c) 1984, 1986, 1987, 1988, 1989 AT&T	*/
26 /*	  All Rights Reserved  	*/
27 
28 
29 #pragma ident	"%Z%%M%	%I%	%E% SMI"
30 
31 /*
32  * Pseudo Terminal Master Driver.
33  *
34  * The pseudo-tty subsystem simulates a terminal connection, where the master
35  * side represents the terminal and the slave represents the user process's
36  * special device end point. The master device is set up as a cloned device
37  * where its major device number is the major for the clone device and its minor
38  * device number is the major for the ptm driver. There are no nodes in the file
39  * system for master devices. The master pseudo driver is opened using the
40  * open(2) system call with /dev/ptmx as the device parameter.  The clone open
41  * finds the next available minor device for the ptm major device.
42  *
43  * A master device is available only if it and its corresponding slave device
44  * are not already open. When the master device is opened, the corresponding
45  * slave device is automatically locked out. Only one open is allowed on a
46  * master device.  Multiple opens are allowed on the slave device.  After both
47  * the master and slave have been opened, the user has two file descriptors
48  * which are the end points of a full duplex connection composed of two streams
49  * which are automatically connected at the master and slave drivers. The user
50  * may then push modules onto either side of the stream pair.
51  *
52  * The master and slave drivers pass all messages to their adjacent queues.
53  * Only the M_FLUSH needs some processing.  Because the read queue of one side
54  * is connected to the write queue of the other, the FLUSHR flag is changed to
55  * the FLUSHW flag and vice versa. When the master device is closed an M_HANGUP
56  * message is sent to the slave device which will render the device
57  * unusable. The process on the slave side gets the EIO when attempting to write
58  * on that stream but it will be able to read any data remaining on the stream
59  * head read queue.  When all the data has been read, read() returns 0
60  * indicating that the stream can no longer be used.  On the last close of the
61  * slave device, a 0-length message is sent to the master device. When the
62  * application on the master side issues a read() or getmsg() and 0 is returned,
63  * the user of the master device decides whether to issue a close() that
64  * dismantles the pseudo-terminal subsystem. If the master device is not closed,
65  * the pseudo-tty subsystem will be available to another user to open the slave
66  * device.
67  *
68  * If O_NONBLOCK or O_NDELAY is set, read on the master side returns -1 with
69  * errno set to EAGAIN if no data is available, and write returns -1 with errno
70  * set to EAGAIN if there is internal flow control.
71  *
72  * IOCTLS:
73  *
74  *  ISPTM: determines whether the file descriptor is that of an open master
75  *	   device. Return code of zero indicates that the file descriptor
76  *	   represents master device.
77  *
78  *  UNLKPT: unlocks the master and slave devices.  It returns 0 on success. On
79  *	    failure, the errno is set to EINVAL indicating that the master
80  *	    device is not open.
81  *
82  *  ZONEPT: sets the zone membership of the associated pts device.
83  *
84  *  GRPPT:  sets the group owner of the associated pts device.
85  *
86  * Synchronization:
87  *
88  *   All global data synchronization between ptm/pts is done via global
89  *   ptms_lock mutex which is initialized at system boot time from
90  *   ptms_initspace (called from space.c).
91  *
92  *   Individual fields of pt_ttys structure (except ptm_rdq, pts_rdq and
93  *   pt_nullmsg) are protected by pt_ttys.pt_lock mutex.
94  *
95  *   PT_ENTER_READ/PT_ENTER_WRITE are reference counter based read-write locks
96  *   which allow reader locks to be reacquired by the same thread (usual
97  *   reader/writer locks can't be used for that purpose since it is illegal for
98  *   a thread to acquire a lock it already holds, even as a reader). The sole
99  *   purpose of these macros is to guarantee that the peer queue will not
100  *   disappear (due to closing peer) while it is used. It is safe to use
101  *   PT_ENTER_READ/PT_EXIT_READ brackets across calls like putq/putnext (since
102  *   they are not real locks but reference counts).
103  *
104  *   PT_ENTER_WRITE/PT_EXIT_WRITE brackets are used ONLY in master/slave
105  *   open/close paths to modify ptm_rdq and pts_rdq fields. These fields should
106  *   be set to appropriate queues *after* qprocson() is called during open (to
107  *   prevent peer from accessing the queue with incomplete plumbing) and set to
108  *   NULL before qprocsoff() is called during close.
109  *
110  *   The pt_nullmsg field is only used in open/close routines and it is also
111  *   protected by PT_ENTER_WRITE/PT_EXIT_WRITE brackets to avoid extra mutex
112  *   holds.
113  *
114  * Lock Ordering:
115  *
116  *   If both ptms_lock and per-pty lock should be held, ptms_lock should always
117  *   be entered first, followed by per-pty lock.
118  *
119  * See ptms.h, pts.c and ptms_conf.c for more information.
120  */
121 
122 #include <sys/types.h>
123 #include <sys/param.h>
124 #include <sys/file.h>
125 #include <sys/sysmacros.h>
126 #include <sys/stream.h>
127 #include <sys/stropts.h>
128 #include <sys/proc.h>
129 #include <sys/errno.h>
130 #include <sys/debug.h>
131 #include <sys/cmn_err.h>
132 #include <sys/ptms.h>
133 #include <sys/stat.h>
134 #include <sys/strsun.h>
135 #include <sys/systm.h>
136 #include <sys/modctl.h>
137 #include <sys/conf.h>
138 #include <sys/ddi.h>
139 #include <sys/sunddi.h>
140 #include <sys/zone.h>
141 
142 #ifdef DEBUG
143 int ptm_debug = 0;
144 #define	DBG(a)	 if (ptm_debug) cmn_err(CE_NOTE, a)
145 #else
146 #define	DBG(a)
147 #endif
148 
149 static int ptmopen(queue_t *, dev_t *, int, int, cred_t *);
150 static int ptmclose(queue_t *, int, cred_t *);
151 static void ptmwput(queue_t *, mblk_t *);
152 static void ptmrsrv(queue_t *);
153 static void ptmwsrv(queue_t *);
154 
155 /*
156  * Master Stream Pseudo Terminal Module: stream data structure definitions
157  */
158 
159 static struct module_info ptm_info = {
160 	0xdead,
161 	"ptm",
162 	0,
163 	512,
164 	512,
165 	128
166 };
167 
168 static struct qinit ptmrint = {
169 	NULL,
170 	(int (*)()) ptmrsrv,
171 	ptmopen,
172 	ptmclose,
173 	NULL,
174 	&ptm_info,
175 	NULL
176 };
177 
178 static struct qinit ptmwint = {
179 	(int (*)()) ptmwput,
180 	(int (*)()) ptmwsrv,
181 	NULL,
182 	NULL,
183 	NULL,
184 	&ptm_info,
185 	NULL
186 };
187 
188 static struct streamtab ptminfo = {
189 	&ptmrint,
190 	&ptmwint,
191 	NULL,
192 	NULL
193 };
194 
195 static int ptm_attach(dev_info_t *, ddi_attach_cmd_t);
196 static int ptm_detach(dev_info_t *, ddi_detach_cmd_t);
197 static int ptm_devinfo(dev_info_t *, ddi_info_cmd_t, void *, void **);
198 
199 static dev_info_t	*ptm_dip;		/* private devinfo pointer */
200 
201 /*
202  * this will define (struct cb_ops cb_ptm_ops) and (struct dev_ops ptm_ops)
203  */
204 DDI_DEFINE_STREAM_OPS(ptm_ops, nulldev, nulldev, ptm_attach, ptm_detach,
205     nodev, ptm_devinfo, D_MP, &ptminfo);
206 
207 /*
208  * Module linkage information for the kernel.
209  */
210 
211 static struct modldrv modldrv = {
212 	&mod_driverops, /* Type of module.  This one is a pseudo driver */
213 	"Master streams driver 'ptm' %I%",
214 	&ptm_ops,	/* driver ops */
215 };
216 
217 static struct modlinkage modlinkage = {
218 	MODREV_1,
219 	&modldrv,
220 	NULL
221 };
222 
223 int
224 _init(void)
225 {
226 	int rc;
227 
228 	if ((rc = mod_install(&modlinkage)) == 0)
229 		ptms_init();
230 	return (rc);
231 }
232 
233 int
234 _fini(void)
235 {
236 	return (mod_remove(&modlinkage));
237 }
238 
239 int
240 _info(struct modinfo *modinfop)
241 {
242 	return (mod_info(&modlinkage, modinfop));
243 }
244 
245 static int
246 ptm_attach(dev_info_t *devi, ddi_attach_cmd_t cmd)
247 {
248 	if (cmd != DDI_ATTACH)
249 		return (DDI_FAILURE);
250 
251 	if (ddi_create_minor_node(devi, "ptmajor", S_IFCHR,
252 	    0, DDI_PSEUDO, NULL) == DDI_FAILURE) {
253 		ddi_remove_minor_node(devi, NULL);
254 		return (DDI_FAILURE);
255 	}
256 	if (ddi_create_minor_node(devi, "ptmx", S_IFCHR,
257 	    0, DDI_PSEUDO, CLONE_DEV) == DDI_FAILURE) {
258 		ddi_remove_minor_node(devi, NULL);
259 		return (DDI_FAILURE);
260 	}
261 	ptm_dip = devi;
262 
263 	return (DDI_SUCCESS);
264 }
265 
266 static int
267 ptm_detach(dev_info_t *devi, ddi_detach_cmd_t cmd)
268 {
269 	if (cmd != DDI_DETACH)
270 		return (DDI_FAILURE);
271 
272 	ddi_remove_minor_node(devi, NULL);
273 	return (DDI_SUCCESS);
274 }
275 
276 /*ARGSUSED*/
277 static int
278 ptm_devinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
279     void **result)
280 {
281 	int error;
282 
283 	switch (infocmd) {
284 	case DDI_INFO_DEVT2DEVINFO:
285 		if (ptm_dip == NULL) {
286 			error = DDI_FAILURE;
287 		} else {
288 			*result = (void *)ptm_dip;
289 			error = DDI_SUCCESS;
290 		}
291 		break;
292 	case DDI_INFO_DEVT2INSTANCE:
293 		*result = (void *)0;
294 		error = DDI_SUCCESS;
295 		break;
296 	default:
297 		error = DDI_FAILURE;
298 	}
299 	return (error);
300 }
301 
302 
303 /* ARGSUSED */
304 /*
305  * Open a minor of the master device. Store the write queue pointer and set the
306  * pt_state field to (PTMOPEN | PTLOCK).
307  * This code will work properly with both clone opens and direct opens of the
308  * master device.
309  */
310 static int
311 ptmopen(
312 	queue_t *rqp,		/* pointer to the read side queue */
313 	dev_t   *devp,		/* pointer to stream tail's dev */
314 	int	oflag,		/* the user open(2) supplied flags */
315 	int	sflag,		/* open state flag */
316 	cred_t  *credp)		/* credentials */
317 {
318 	struct pt_ttys	*ptmp;
319 	mblk_t		*mop;		/* ptr to a setopts message block */
320 	struct stroptions *sop;
321 	minor_t		dminor = getminor(*devp);
322 
323 	/* Allow reopen */
324 	if (rqp->q_ptr != NULL)
325 		return (0);
326 
327 	if (sflag & MODOPEN)
328 		return (ENXIO);
329 
330 	if (!(sflag & CLONEOPEN) && dminor != 0) {
331 		/*
332 		 * This is a direct open to specific master device through an
333 		 * artificially created entry with specific minor in
334 		 * /dev/directory. Such behavior is not supported.
335 		 */
336 		return (ENXIO);
337 	}
338 
339 	/*
340 	 * The master open requires that the slave be attached
341 	 * before it returns so that attempts to open the slave will
342 	 * succeeed
343 	 */
344 	if (ptms_attach_slave() != 0) {
345 		return (ENXIO);
346 	}
347 
348 	mop = allocb(sizeof (struct stroptions), BPRI_MED);
349 	if (mop == NULL) {
350 		DDBG("ptmopen(): mop allocation failed\n", 0);
351 		return (ENOMEM);
352 	}
353 
354 	if ((ptmp = pt_ttys_alloc()) == NULL) {
355 		DDBG("ptmopen(): pty allocation failed\n", 0);
356 		freemsg(mop);
357 		return (ENOMEM);
358 	}
359 
360 	dminor = ptmp->pt_minor;
361 
362 	DDBGP("ptmopen(): allocated ptmp %p\n", (uintptr_t)ptmp);
363 	DDBG("ptmopen(): allocated minor %d\n", dminor);
364 
365 	WR(rqp)->q_ptr = rqp->q_ptr = ptmp;
366 
367 	qprocson(rqp);
368 
369 	/* Allow slave to send messages to master */
370 	PT_ENTER_WRITE(ptmp);
371 	ptmp->ptm_rdq = rqp;
372 	PT_EXIT_WRITE(ptmp);
373 
374 	/*
375 	 * set up hi/lo water marks on stream head read queue
376 	 * and add controlling tty if not set
377 	 */
378 	mop->b_datap->db_type = M_SETOPTS;
379 	mop->b_wptr += sizeof (struct stroptions);
380 	sop = (struct stroptions *)mop->b_rptr;
381 	if (oflag & FNOCTTY)
382 		sop->so_flags = SO_HIWAT | SO_LOWAT;
383 	else
384 		sop->so_flags = SO_HIWAT | SO_LOWAT | SO_ISTTY;
385 	sop->so_hiwat = 512;
386 	sop->so_lowat = 256;
387 	putnext(rqp, mop);
388 
389 	/*
390 	 * The input, devp, is a major device number, the output is put
391 	 * into the same parm as a major,minor pair.
392 	 */
393 	*devp = makedevice(getmajor(*devp), dminor);
394 
395 	return (0);
396 }
397 
398 
399 /*
400  * Find the address to private data identifying the slave's write queue.
401  * Send a hang-up message up the slave's read queue to designate the
402  * master/slave pair is tearing down. Uattach the master and slave by
403  * nulling out the write queue fields in the private data structure.
404  * Finally, unlock the master/slave pair and mark the master as closed.
405  */
406 /*ARGSUSED1*/
407 static int
408 ptmclose(queue_t *rqp, int flag, cred_t *credp)
409 {
410 	struct pt_ttys	*ptmp;
411 	queue_t *pts_rdq;
412 
413 	ASSERT(rqp->q_ptr);
414 
415 	ptmp = (struct pt_ttys *)rqp->q_ptr;
416 	PT_ENTER_READ(ptmp);
417 	if (ptmp->pts_rdq) {
418 		pts_rdq = ptmp->pts_rdq;
419 		if (pts_rdq->q_next) {
420 			DBG(("send hangup message to slave\n"));
421 			(void) putnextctl(pts_rdq, M_HANGUP);
422 		}
423 	}
424 	PT_EXIT_READ(ptmp);
425 	/*
426 	 * ptm_rdq should be cleared before call to qprocsoff() to prevent pts
427 	 * write procedure to attempt using ptm_rdq after qprocsoff.
428 	 */
429 	PT_ENTER_WRITE(ptmp);
430 	ptmp->ptm_rdq = NULL;
431 	freemsg(ptmp->pt_nullmsg);
432 	ptmp->pt_nullmsg = NULL;
433 	/*
434 	 * qenable slave side write queue so that it can flush
435 	 * its messages as master's read queue is going away
436 	 */
437 	if (ptmp->pts_rdq)
438 		qenable(WR(ptmp->pts_rdq));
439 	PT_EXIT_WRITE(ptmp);
440 
441 	qprocsoff(rqp);
442 
443 	/* Finish the close */
444 	rqp->q_ptr = NULL;
445 	WR(rqp)->q_ptr = NULL;
446 
447 	ptms_close(ptmp, PTMOPEN | PTLOCK);
448 
449 	return (0);
450 }
451 
452 static boolean_t
453 ptmptsopencb(ptmptsopencb_arg_t arg)
454 {
455 	struct pt_ttys	*ptmp = (struct pt_ttys *)arg;
456 	boolean_t rval;
457 
458 	PT_ENTER_READ(ptmp);
459 	rval = (ptmp->pt_nullmsg != NULL);
460 	PT_EXIT_READ(ptmp);
461 	return (rval);
462 }
463 
464 /*
465  * The wput procedure will only handle ioctl and flush messages.
466  */
467 static void
468 ptmwput(queue_t *qp, mblk_t *mp)
469 {
470 	struct pt_ttys	*ptmp;
471 	struct iocblk	*iocp;
472 
473 	DBG(("entering ptmwput\n"));
474 	ASSERT(qp->q_ptr);
475 
476 	ptmp = (struct pt_ttys *)qp->q_ptr;
477 	PT_ENTER_READ(ptmp);
478 
479 	switch (mp->b_datap->db_type) {
480 	/*
481 	 * if write queue request, flush master's write
482 	 * queue and send FLUSHR up slave side. If read
483 	 * queue request, convert to FLUSHW and putnext().
484 	 */
485 	case M_FLUSH:
486 		{
487 			unsigned char flush_flg = 0;
488 
489 			DBG(("ptm got flush request\n"));
490 			if (*mp->b_rptr & FLUSHW) {
491 				DBG(("got FLUSHW, flush ptm write Q\n"));
492 				if (*mp->b_rptr & FLUSHBAND)
493 					/*
494 					 * if it is a FLUSHBAND, do flushband.
495 					 */
496 					flushband(qp, *(mp->b_rptr + 1),
497 					    FLUSHDATA);
498 				else
499 					flushq(qp, FLUSHDATA);
500 				flush_flg = (*mp->b_rptr & ~FLUSHW) | FLUSHR;
501 			}
502 			if (*mp->b_rptr & FLUSHR) {
503 				DBG(("got FLUSHR, set FLUSHW\n"));
504 				flush_flg |= (*mp->b_rptr & ~FLUSHR) | FLUSHW;
505 			}
506 			if (flush_flg != 0 && ptmp->pts_rdq &&
507 			    !(ptmp->pt_state & PTLOCK)) {
508 				DBG(("putnext to pts\n"));
509 				*mp->b_rptr = flush_flg;
510 				putnext(ptmp->pts_rdq, mp);
511 			} else
512 				freemsg(mp);
513 			break;
514 		}
515 
516 	case M_IOCTL:
517 		iocp = (struct iocblk *)mp->b_rptr;
518 		switch (iocp->ioc_cmd) {
519 		default:
520 			if ((ptmp->pt_state & PTLOCK) ||
521 			    (ptmp->pts_rdq == NULL)) {
522 				DBG(("got M_IOCTL but no slave\n"));
523 				miocnak(qp, mp, 0, EINVAL);
524 				PT_EXIT_READ(ptmp);
525 				return;
526 			}
527 			(void) putq(qp, mp);
528 			break;
529 		case UNLKPT:
530 			mutex_enter(&ptmp->pt_lock);
531 			ptmp->pt_state &= ~PTLOCK;
532 			mutex_exit(&ptmp->pt_lock);
533 			/*FALLTHROUGH*/
534 		case ISPTM:
535 			DBG(("ack the UNLKPT/ISPTM\n"));
536 			miocack(qp, mp, 0, 0);
537 			break;
538 		case ZONEPT:
539 		{
540 			zoneid_t z;
541 			int error;
542 
543 			if ((error = drv_priv(iocp->ioc_cr)) != 0) {
544 				miocnak(qp, mp, 0, error);
545 				break;
546 			}
547 			if ((error = miocpullup(mp, sizeof (zoneid_t))) != 0) {
548 				miocnak(qp, mp, 0, error);
549 				break;
550 			}
551 			z = *((zoneid_t *)mp->b_cont->b_rptr);
552 			if (z < MIN_ZONEID || z > MAX_ZONEID) {
553 				miocnak(qp, mp, 0, EINVAL);
554 				break;
555 			}
556 
557 			mutex_enter(&ptmp->pt_lock);
558 			ptmp->pt_zoneid = z;
559 			mutex_exit(&ptmp->pt_lock);
560 			miocack(qp, mp, 0, 0);
561 			break;
562 		}
563 		case OWNERPT:
564 		{
565 			pt_own_t *ptop;
566 			int error;
567 
568 			if ((error = miocpullup(mp, sizeof (pt_own_t))) != 0) {
569 				miocnak(qp, mp, 0, error);
570 				break;
571 			}
572 
573 			ptop = (pt_own_t *)mp->b_cont->b_rptr;
574 
575 			if (!VALID_UID(ptop->pto_ruid) ||
576 			    !VALID_GID(ptop->pto_rgid)) {
577 				miocnak(qp, mp, 0, EINVAL);
578 				break;
579 			}
580 
581 			mutex_enter(&ptmp->pt_lock);
582 			ptmp->pt_ruid = ptop->pto_ruid;
583 			ptmp->pt_rgid = ptop->pto_rgid;
584 			mutex_exit(&ptmp->pt_lock);
585 			miocack(qp, mp, 0, 0);
586 			break;
587 		}
588 		case PTMPTSOPENCB:
589 		{
590 			mblk_t		*dp;	/* ioctl reply data */
591 			ptmptsopencb_t	*ppocb;
592 
593 			/* only allow the kernel to invoke this ioctl */
594 			if (iocp->ioc_cr != kcred) {
595 				miocnak(qp, mp, 0, EINVAL);
596 				break;
597 			}
598 
599 			/* we don't support transparent ioctls */
600 			ASSERT(iocp->ioc_count != TRANSPARENT);
601 			if (iocp->ioc_count == TRANSPARENT) {
602 				miocnak(qp, mp, 0, EINVAL);
603 				break;
604 			}
605 
606 			/* allocate a response message */
607 			dp = allocb(sizeof (ptmptsopencb_t), BPRI_MED);
608 			if (dp == NULL) {
609 				miocnak(qp, mp, 0, EAGAIN);
610 				break;
611 			}
612 
613 			/* initialize the ioctl results */
614 			ppocb = (ptmptsopencb_t *)dp->b_rptr;
615 			ppocb->ppocb_func = ptmptsopencb;
616 			ppocb->ppocb_arg = (ptmptsopencb_arg_t)ptmp;
617 
618 			/* send the reply data */
619 			mioc2ack(mp, dp, sizeof (ptmptsopencb_t), 0);
620 			qreply(qp, mp);
621 			break;
622 		}
623 		}
624 		break;
625 
626 	case M_READ:
627 		/* Caused by ldterm - can not pass to slave */
628 		freemsg(mp);
629 		break;
630 
631 	/*
632 	 * send other messages to slave
633 	 */
634 	default:
635 		if ((ptmp->pt_state  & PTLOCK) || (ptmp->pts_rdq == NULL)) {
636 			DBG(("got msg. but no slave\n"));
637 			mp = mexchange(NULL, mp, 2, M_ERROR, -1);
638 			if (mp != NULL) {
639 				mp->b_rptr[0] = NOERROR;
640 				mp->b_rptr[1] = EINVAL;
641 				qreply(qp, mp);
642 			}
643 			PT_EXIT_READ(ptmp);
644 			return;
645 		}
646 		DBG(("put msg on master's write queue\n"));
647 		(void) putq(qp, mp);
648 		break;
649 	}
650 	DBG(("return from ptmwput()\n"));
651 	PT_EXIT_READ(ptmp);
652 }
653 
654 
655 /*
656  * enable the write side of the slave. This triggers the
657  * slave to send any messages queued on its write side to
658  * the read side of this master.
659  */
660 static void
661 ptmrsrv(queue_t *qp)
662 {
663 	struct pt_ttys	*ptmp;
664 
665 	DBG(("entering ptmrsrv\n"));
666 	ASSERT(qp->q_ptr);
667 
668 	ptmp = (struct pt_ttys *)qp->q_ptr;
669 	PT_ENTER_READ(ptmp);
670 	if (ptmp->pts_rdq) {
671 		qenable(WR(ptmp->pts_rdq));
672 	}
673 	PT_EXIT_READ(ptmp);
674 	DBG(("leaving ptmrsrv\n"));
675 }
676 
677 
678 /*
679  * If there are messages on this queue that can be sent to
680  * slave, send them via putnext(). Else, if queued messages
681  * cannot be sent, leave them on this queue. If priority
682  * messages on this queue, send them to slave no matter what.
683  */
684 static void
685 ptmwsrv(queue_t *qp)
686 {
687 	struct pt_ttys	*ptmp;
688 	mblk_t 		*mp;
689 
690 	DBG(("entering ptmwsrv\n"));
691 	ASSERT(qp->q_ptr);
692 
693 	ptmp = (struct pt_ttys *)qp->q_ptr;
694 
695 	if ((mp = getq(qp)) == NULL) {
696 		/* If there are no messages there's nothing to do. */
697 		DBG(("leaving ptmwsrv (no messages)\n"));
698 		return;
699 	}
700 
701 	PT_ENTER_READ(ptmp);
702 	if ((ptmp->pt_state  & PTLOCK) || (ptmp->pts_rdq == NULL)) {
703 		DBG(("in master write srv proc but no slave\n"));
704 		/*
705 		 * Free messages on the write queue and send
706 		 * NAK for any M_IOCTL type messages to wakeup
707 		 * the user process waiting for ACK/NAK from
708 		 * the ioctl invocation
709 		 */
710 		do {
711 			if (mp->b_datap->db_type == M_IOCTL)
712 				miocnak(qp, mp, 0, EINVAL);
713 			else
714 				freemsg(mp);
715 		} while ((mp = getq(qp)) != NULL);
716 		flushq(qp, FLUSHALL);
717 
718 		mp = mexchange(NULL, NULL, 2, M_ERROR, -1);
719 		if (mp != NULL) {
720 			mp->b_rptr[0] = NOERROR;
721 			mp->b_rptr[1] = EINVAL;
722 			qreply(qp, mp);
723 		}
724 		PT_EXIT_READ(ptmp);
725 		return;
726 	}
727 	/*
728 	 * while there are messages on this write queue...
729 	 */
730 	do {
731 		/*
732 		 * if don't have control message and cannot put
733 		 * msg. on slave's read queue, put it back on
734 		 * this queue.
735 		 */
736 		if (mp->b_datap->db_type <= QPCTL &&
737 		    !bcanputnext(ptmp->pts_rdq, mp->b_band)) {
738 			DBG(("put msg. back on queue\n"));
739 			(void) putbq(qp, mp);
740 			break;
741 		}
742 		/*
743 		 * else send the message up slave's stream
744 		 */
745 		DBG(("send message to slave\n"));
746 		putnext(ptmp->pts_rdq, mp);
747 	} while ((mp = getq(qp)) != NULL);
748 	DBG(("leaving ptmwsrv\n"));
749 	PT_EXIT_READ(ptmp);
750 }
751