1*7c478bd9Sstevel@tonic-gate /*
2*7c478bd9Sstevel@tonic-gate * CDDL HEADER START
3*7c478bd9Sstevel@tonic-gate *
4*7c478bd9Sstevel@tonic-gate * The contents of this file are subject to the terms of the
5*7c478bd9Sstevel@tonic-gate * Common Development and Distribution License, Version 1.0 only
6*7c478bd9Sstevel@tonic-gate * (the "License"). You may not use this file except in compliance
7*7c478bd9Sstevel@tonic-gate * with the License.
8*7c478bd9Sstevel@tonic-gate *
9*7c478bd9Sstevel@tonic-gate * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10*7c478bd9Sstevel@tonic-gate * or http://www.opensolaris.org/os/licensing.
11*7c478bd9Sstevel@tonic-gate * See the License for the specific language governing permissions
12*7c478bd9Sstevel@tonic-gate * and limitations under the License.
13*7c478bd9Sstevel@tonic-gate *
14*7c478bd9Sstevel@tonic-gate * When distributing Covered Code, include this CDDL HEADER in each
15*7c478bd9Sstevel@tonic-gate * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16*7c478bd9Sstevel@tonic-gate * If applicable, add the following below this CDDL HEADER, with the
17*7c478bd9Sstevel@tonic-gate * fields enclosed by brackets "[]" replaced with your own identifying
18*7c478bd9Sstevel@tonic-gate * information: Portions Copyright [yyyy] [name of copyright owner]
19*7c478bd9Sstevel@tonic-gate *
20*7c478bd9Sstevel@tonic-gate * CDDL HEADER END
21*7c478bd9Sstevel@tonic-gate */
22*7c478bd9Sstevel@tonic-gate /*
23*7c478bd9Sstevel@tonic-gate * Copyright 2002 Sun Microsystems, Inc. All rights reserved.
24*7c478bd9Sstevel@tonic-gate * Use is subject to license terms.
25*7c478bd9Sstevel@tonic-gate */
26*7c478bd9Sstevel@tonic-gate
27*7c478bd9Sstevel@tonic-gate /*
28*7c478bd9Sstevel@tonic-gate * av1394 queue
29*7c478bd9Sstevel@tonic-gate * Based on av1394 list, plus locking, works only with mblk's,
30*7c478bd9Sstevel@tonic-gate * counts and limits amount of data on the queue.
31*7c478bd9Sstevel@tonic-gate */
32*7c478bd9Sstevel@tonic-gate #include <sys/stream.h>
33*7c478bd9Sstevel@tonic-gate #include <sys/strsun.h>
34*7c478bd9Sstevel@tonic-gate #include <sys/1394/targets/av1394/av1394_impl.h>
35*7c478bd9Sstevel@tonic-gate
36*7c478bd9Sstevel@tonic-gate typedef void (*putfunc_t)(av1394_list_t *, void *);
37*7c478bd9Sstevel@tonic-gate
38*7c478bd9Sstevel@tonic-gate static mblk_t *av1394_getq_locked(av1394_queue_t *);
39*7c478bd9Sstevel@tonic-gate static int av1394_put_common(av1394_queue_t *, mblk_t *, putfunc_t);
40*7c478bd9Sstevel@tonic-gate
41*7c478bd9Sstevel@tonic-gate void
av1394_initq(av1394_queue_t * q,ddi_iblock_cookie_t ibc,int max)42*7c478bd9Sstevel@tonic-gate av1394_initq(av1394_queue_t *q, ddi_iblock_cookie_t ibc, int max)
43*7c478bd9Sstevel@tonic-gate {
44*7c478bd9Sstevel@tonic-gate bzero(q, sizeof (av1394_queue_t));
45*7c478bd9Sstevel@tonic-gate
46*7c478bd9Sstevel@tonic-gate mutex_init(&q->q_mutex, NULL, MUTEX_DRIVER, ibc);
47*7c478bd9Sstevel@tonic-gate cv_init(&q->q_cv, NULL, CV_DRIVER, NULL);
48*7c478bd9Sstevel@tonic-gate
49*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
50*7c478bd9Sstevel@tonic-gate av1394_list_init(&q->q_list);
51*7c478bd9Sstevel@tonic-gate q->q_max = max;
52*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
53*7c478bd9Sstevel@tonic-gate }
54*7c478bd9Sstevel@tonic-gate
55*7c478bd9Sstevel@tonic-gate void
av1394_destroyq(av1394_queue_t * q)56*7c478bd9Sstevel@tonic-gate av1394_destroyq(av1394_queue_t *q)
57*7c478bd9Sstevel@tonic-gate {
58*7c478bd9Sstevel@tonic-gate av1394_flushq(q);
59*7c478bd9Sstevel@tonic-gate mutex_destroy(&q->q_mutex);
60*7c478bd9Sstevel@tonic-gate cv_destroy(&q->q_cv);
61*7c478bd9Sstevel@tonic-gate }
62*7c478bd9Sstevel@tonic-gate
63*7c478bd9Sstevel@tonic-gate void
av1394_setmaxq(av1394_queue_t * q,int max)64*7c478bd9Sstevel@tonic-gate av1394_setmaxq(av1394_queue_t *q, int max)
65*7c478bd9Sstevel@tonic-gate {
66*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
67*7c478bd9Sstevel@tonic-gate q->q_max = max;
68*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
69*7c478bd9Sstevel@tonic-gate }
70*7c478bd9Sstevel@tonic-gate
71*7c478bd9Sstevel@tonic-gate int
av1394_getmaxq(av1394_queue_t * q)72*7c478bd9Sstevel@tonic-gate av1394_getmaxq(av1394_queue_t *q)
73*7c478bd9Sstevel@tonic-gate {
74*7c478bd9Sstevel@tonic-gate int max;
75*7c478bd9Sstevel@tonic-gate
76*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
77*7c478bd9Sstevel@tonic-gate max = q->q_max;
78*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
79*7c478bd9Sstevel@tonic-gate return (max);
80*7c478bd9Sstevel@tonic-gate }
81*7c478bd9Sstevel@tonic-gate
82*7c478bd9Sstevel@tonic-gate void
av1394_flushq(av1394_queue_t * q)83*7c478bd9Sstevel@tonic-gate av1394_flushq(av1394_queue_t *q)
84*7c478bd9Sstevel@tonic-gate {
85*7c478bd9Sstevel@tonic-gate mblk_t *bp;
86*7c478bd9Sstevel@tonic-gate
87*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
88*7c478bd9Sstevel@tonic-gate while ((bp = av1394_getq_locked(q)) != NULL) {
89*7c478bd9Sstevel@tonic-gate freemsg(bp);
90*7c478bd9Sstevel@tonic-gate }
91*7c478bd9Sstevel@tonic-gate ASSERT(q->q_size == 0);
92*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
93*7c478bd9Sstevel@tonic-gate }
94*7c478bd9Sstevel@tonic-gate
95*7c478bd9Sstevel@tonic-gate int
av1394_putq(av1394_queue_t * q,mblk_t * bp)96*7c478bd9Sstevel@tonic-gate av1394_putq(av1394_queue_t *q, mblk_t *bp)
97*7c478bd9Sstevel@tonic-gate {
98*7c478bd9Sstevel@tonic-gate return (av1394_put_common(q, bp, av1394_list_put_tail));
99*7c478bd9Sstevel@tonic-gate }
100*7c478bd9Sstevel@tonic-gate
101*7c478bd9Sstevel@tonic-gate int
av1394_putbq(av1394_queue_t * q,mblk_t * bp)102*7c478bd9Sstevel@tonic-gate av1394_putbq(av1394_queue_t *q, mblk_t *bp)
103*7c478bd9Sstevel@tonic-gate {
104*7c478bd9Sstevel@tonic-gate return (av1394_put_common(q, bp, av1394_list_put_head));
105*7c478bd9Sstevel@tonic-gate }
106*7c478bd9Sstevel@tonic-gate
107*7c478bd9Sstevel@tonic-gate mblk_t *
av1394_getq(av1394_queue_t * q)108*7c478bd9Sstevel@tonic-gate av1394_getq(av1394_queue_t *q)
109*7c478bd9Sstevel@tonic-gate {
110*7c478bd9Sstevel@tonic-gate mblk_t *bp;
111*7c478bd9Sstevel@tonic-gate
112*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
113*7c478bd9Sstevel@tonic-gate bp = av1394_getq_locked(q);
114*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
115*7c478bd9Sstevel@tonic-gate
116*7c478bd9Sstevel@tonic-gate return (bp);
117*7c478bd9Sstevel@tonic-gate }
118*7c478bd9Sstevel@tonic-gate
119*7c478bd9Sstevel@tonic-gate mblk_t *
av1394_peekq(av1394_queue_t * q)120*7c478bd9Sstevel@tonic-gate av1394_peekq(av1394_queue_t *q)
121*7c478bd9Sstevel@tonic-gate {
122*7c478bd9Sstevel@tonic-gate mblk_t *mp;
123*7c478bd9Sstevel@tonic-gate
124*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
125*7c478bd9Sstevel@tonic-gate mp = av1394_peekq_locked(q);
126*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
127*7c478bd9Sstevel@tonic-gate return (mp);
128*7c478bd9Sstevel@tonic-gate }
129*7c478bd9Sstevel@tonic-gate
130*7c478bd9Sstevel@tonic-gate mblk_t *
av1394_peekq_locked(av1394_queue_t * q)131*7c478bd9Sstevel@tonic-gate av1394_peekq_locked(av1394_queue_t *q)
132*7c478bd9Sstevel@tonic-gate {
133*7c478bd9Sstevel@tonic-gate ASSERT(mutex_owned(&q->q_mutex));
134*7c478bd9Sstevel@tonic-gate return (av1394_list_head(&q->q_list));
135*7c478bd9Sstevel@tonic-gate }
136*7c478bd9Sstevel@tonic-gate
137*7c478bd9Sstevel@tonic-gate /*
138*7c478bd9Sstevel@tonic-gate * wait until queue is not empty or a signal arrives
139*7c478bd9Sstevel@tonic-gate */
140*7c478bd9Sstevel@tonic-gate int
av1394_qwait_sig(av1394_queue_t * q)141*7c478bd9Sstevel@tonic-gate av1394_qwait_sig(av1394_queue_t *q)
142*7c478bd9Sstevel@tonic-gate {
143*7c478bd9Sstevel@tonic-gate int ret = 1;
144*7c478bd9Sstevel@tonic-gate
145*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
146*7c478bd9Sstevel@tonic-gate while (av1394_peekq_locked(q) == NULL) {
147*7c478bd9Sstevel@tonic-gate if ((ret = cv_wait_sig(&q->q_cv, &q->q_mutex)) <= 0) {
148*7c478bd9Sstevel@tonic-gate break;
149*7c478bd9Sstevel@tonic-gate }
150*7c478bd9Sstevel@tonic-gate }
151*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
152*7c478bd9Sstevel@tonic-gate
153*7c478bd9Sstevel@tonic-gate return (ret);
154*7c478bd9Sstevel@tonic-gate }
155*7c478bd9Sstevel@tonic-gate
156*7c478bd9Sstevel@tonic-gate static int
av1394_put_common(av1394_queue_t * q,mblk_t * bp,putfunc_t put)157*7c478bd9Sstevel@tonic-gate av1394_put_common(av1394_queue_t *q, mblk_t *bp, putfunc_t put)
158*7c478bd9Sstevel@tonic-gate {
159*7c478bd9Sstevel@tonic-gate int ret;
160*7c478bd9Sstevel@tonic-gate int len = MBLKL(bp);
161*7c478bd9Sstevel@tonic-gate
162*7c478bd9Sstevel@tonic-gate AV1394_ENTERQ(q);
163*7c478bd9Sstevel@tonic-gate if (q->q_size + len > q->q_max) {
164*7c478bd9Sstevel@tonic-gate ret = 0;
165*7c478bd9Sstevel@tonic-gate } else {
166*7c478bd9Sstevel@tonic-gate put(&q->q_list, bp);
167*7c478bd9Sstevel@tonic-gate q->q_size += len;
168*7c478bd9Sstevel@tonic-gate cv_broadcast(&q->q_cv);
169*7c478bd9Sstevel@tonic-gate ret = 1;
170*7c478bd9Sstevel@tonic-gate }
171*7c478bd9Sstevel@tonic-gate AV1394_LEAVEQ(q);
172*7c478bd9Sstevel@tonic-gate
173*7c478bd9Sstevel@tonic-gate return (ret);
174*7c478bd9Sstevel@tonic-gate }
175*7c478bd9Sstevel@tonic-gate
176*7c478bd9Sstevel@tonic-gate static mblk_t *
av1394_getq_locked(av1394_queue_t * q)177*7c478bd9Sstevel@tonic-gate av1394_getq_locked(av1394_queue_t *q)
178*7c478bd9Sstevel@tonic-gate {
179*7c478bd9Sstevel@tonic-gate mblk_t *bp;
180*7c478bd9Sstevel@tonic-gate
181*7c478bd9Sstevel@tonic-gate if ((bp = av1394_list_get_head(&q->q_list)) != NULL) {
182*7c478bd9Sstevel@tonic-gate q->q_size -= MBLKL(bp);
183*7c478bd9Sstevel@tonic-gate ASSERT(q->q_size >= 0);
184*7c478bd9Sstevel@tonic-gate }
185*7c478bd9Sstevel@tonic-gate return (bp);
186*7c478bd9Sstevel@tonic-gate }
187