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 1996-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 #pragma ident "%Z%%M% %I% %E% SMI" 28*7c478bd9Sstevel@tonic-gate 29*7c478bd9Sstevel@tonic-gate #include <pthread.h> 30*7c478bd9Sstevel@tonic-gate #include <malloc.h> 31*7c478bd9Sstevel@tonic-gate #include <memory.h> 32*7c478bd9Sstevel@tonic-gate #include "dataq.h" 33*7c478bd9Sstevel@tonic-gate #include <assert.h> 34*7c478bd9Sstevel@tonic-gate 35*7c478bd9Sstevel@tonic-gate #ifndef NDEBUG 36*7c478bd9Sstevel@tonic-gate static int 37*7c478bd9Sstevel@tonic-gate dataq_check(dataq_t *ptr) /* call while holding lock! */ 38*7c478bd9Sstevel@tonic-gate { 39*7c478bd9Sstevel@tonic-gate assert(ptr->num_data == ll_check(&ptr->data)); 40*7c478bd9Sstevel@tonic-gate assert(ptr->num_waiters == ll_check(&ptr->waiters)); 41*7c478bd9Sstevel@tonic-gate return (1); 42*7c478bd9Sstevel@tonic-gate } 43*7c478bd9Sstevel@tonic-gate #endif 44*7c478bd9Sstevel@tonic-gate 45*7c478bd9Sstevel@tonic-gate int 46*7c478bd9Sstevel@tonic-gate dataq_init(dataq_t *ptr) 47*7c478bd9Sstevel@tonic-gate { 48*7c478bd9Sstevel@tonic-gate ptr->num_data = 0; 49*7c478bd9Sstevel@tonic-gate ptr->num_waiters = 0; 50*7c478bd9Sstevel@tonic-gate ll_init(&ptr->data); 51*7c478bd9Sstevel@tonic-gate ll_init(&ptr->waiters); 52*7c478bd9Sstevel@tonic-gate pthread_mutex_init(&ptr->lock, NULL); 53*7c478bd9Sstevel@tonic-gate assert((pthread_mutex_lock(&ptr->lock) == 0) && 54*7c478bd9Sstevel@tonic-gate (dataq_check(ptr) == 1) && 55*7c478bd9Sstevel@tonic-gate (pthread_mutex_unlock(&ptr->lock) == 0)); 56*7c478bd9Sstevel@tonic-gate return (0); 57*7c478bd9Sstevel@tonic-gate } 58*7c478bd9Sstevel@tonic-gate 59*7c478bd9Sstevel@tonic-gate int 60*7c478bd9Sstevel@tonic-gate dataq_enqueue(dataq_t *dataq, void *in) 61*7c478bd9Sstevel@tonic-gate { 62*7c478bd9Sstevel@tonic-gate dataq_data_t *ptr = (dataq_data_t *)malloc(sizeof (*ptr)); 63*7c478bd9Sstevel@tonic-gate dataq_waiter_t *sleeper; 64*7c478bd9Sstevel@tonic-gate 65*7c478bd9Sstevel@tonic-gate if (ptr == NULL) 66*7c478bd9Sstevel@tonic-gate return (-1); 67*7c478bd9Sstevel@tonic-gate ptr->data = in; 68*7c478bd9Sstevel@tonic-gate pthread_mutex_lock(&dataq->lock); 69*7c478bd9Sstevel@tonic-gate assert(dataq_check(dataq)); 70*7c478bd9Sstevel@tonic-gate ll_enqueue(&dataq->data, &ptr->list); 71*7c478bd9Sstevel@tonic-gate dataq->num_data++; 72*7c478bd9Sstevel@tonic-gate if (dataq->num_waiters) { 73*7c478bd9Sstevel@tonic-gate /*LINTED*/ 74*7c478bd9Sstevel@tonic-gate sleeper = (dataq_waiter_t *)ll_peek(&dataq->waiters); 75*7c478bd9Sstevel@tonic-gate sleeper->wakeup = 1; 76*7c478bd9Sstevel@tonic-gate pthread_cond_signal(&sleeper->cv); 77*7c478bd9Sstevel@tonic-gate } 78*7c478bd9Sstevel@tonic-gate assert(dataq_check(dataq)); 79*7c478bd9Sstevel@tonic-gate pthread_mutex_unlock(&dataq->lock); 80*7c478bd9Sstevel@tonic-gate return (0); 81*7c478bd9Sstevel@tonic-gate } 82*7c478bd9Sstevel@tonic-gate 83*7c478bd9Sstevel@tonic-gate int 84*7c478bd9Sstevel@tonic-gate dataq_dequeue(dataq_t *dataq, void **outptr, int try) 85*7c478bd9Sstevel@tonic-gate { 86*7c478bd9Sstevel@tonic-gate dataq_data_t *dptr; 87*7c478bd9Sstevel@tonic-gate dataq_waiter_t *sleeper; 88*7c478bd9Sstevel@tonic-gate 89*7c478bd9Sstevel@tonic-gate pthread_mutex_lock(&dataq->lock); 90*7c478bd9Sstevel@tonic-gate if ((dataq->num_waiters > 0) || 91*7c478bd9Sstevel@tonic-gate ((dptr = (dataq_data_t *)ll_dequeue(&dataq->data)) == NULL)) { 92*7c478bd9Sstevel@tonic-gate dataq_waiter_t wait; 93*7c478bd9Sstevel@tonic-gate if (try) { 94*7c478bd9Sstevel@tonic-gate pthread_mutex_unlock(&dataq->lock); 95*7c478bd9Sstevel@tonic-gate return (1); 96*7c478bd9Sstevel@tonic-gate } 97*7c478bd9Sstevel@tonic-gate wait.wakeup = 0; 98*7c478bd9Sstevel@tonic-gate pthread_cond_init(&wait.cv, NULL); 99*7c478bd9Sstevel@tonic-gate dataq->num_waiters++; 100*7c478bd9Sstevel@tonic-gate ll_enqueue(&dataq->waiters, &wait.list); 101*7c478bd9Sstevel@tonic-gate while (wait.wakeup == 0) 102*7c478bd9Sstevel@tonic-gate pthread_cond_wait(&wait.cv, &dataq->lock); 103*7c478bd9Sstevel@tonic-gate ll_dequeue(&dataq->waiters); 104*7c478bd9Sstevel@tonic-gate dataq->num_waiters--; 105*7c478bd9Sstevel@tonic-gate pthread_cond_destroy(&wait.cv); 106*7c478bd9Sstevel@tonic-gate dptr = (dataq_data_t *)ll_dequeue(&dataq->data); 107*7c478bd9Sstevel@tonic-gate } 108*7c478bd9Sstevel@tonic-gate dataq->num_data--; 109*7c478bd9Sstevel@tonic-gate if (dataq->num_data && dataq->num_waiters) { 110*7c478bd9Sstevel@tonic-gate /*LINTED*/ 111*7c478bd9Sstevel@tonic-gate sleeper = (dataq_waiter_t *)ll_peek(&dataq->waiters); 112*7c478bd9Sstevel@tonic-gate sleeper->wakeup = 1; 113*7c478bd9Sstevel@tonic-gate pthread_cond_signal(&sleeper->cv); 114*7c478bd9Sstevel@tonic-gate } 115*7c478bd9Sstevel@tonic-gate pthread_mutex_unlock(&dataq->lock); 116*7c478bd9Sstevel@tonic-gate *outptr = dptr->data; 117*7c478bd9Sstevel@tonic-gate free(dptr); 118*7c478bd9Sstevel@tonic-gate return (0); 119*7c478bd9Sstevel@tonic-gate } 120*7c478bd9Sstevel@tonic-gate 121*7c478bd9Sstevel@tonic-gate static void 122*7c478bd9Sstevel@tonic-gate dataq_data_destroy(void * p) 123*7c478bd9Sstevel@tonic-gate { 124*7c478bd9Sstevel@tonic-gate dataq_data_t *d = (dataq_data_t *)p; 125*7c478bd9Sstevel@tonic-gate free(d->data); 126*7c478bd9Sstevel@tonic-gate free(d); 127*7c478bd9Sstevel@tonic-gate } 128*7c478bd9Sstevel@tonic-gate 129*7c478bd9Sstevel@tonic-gate static void 130*7c478bd9Sstevel@tonic-gate dataq_waiters_destroy(void * p) 131*7c478bd9Sstevel@tonic-gate { 132*7c478bd9Sstevel@tonic-gate dataq_waiter_t *d = (dataq_waiter_t *)p; 133*7c478bd9Sstevel@tonic-gate pthread_cond_destroy(&d->cv); 134*7c478bd9Sstevel@tonic-gate free(d); 135*7c478bd9Sstevel@tonic-gate } 136*7c478bd9Sstevel@tonic-gate 137*7c478bd9Sstevel@tonic-gate int 138*7c478bd9Sstevel@tonic-gate dataq_destroy(dataq_t *dataq) 139*7c478bd9Sstevel@tonic-gate { 140*7c478bd9Sstevel@tonic-gate pthread_mutex_destroy(&dataq->lock); 141*7c478bd9Sstevel@tonic-gate ll_mapf(&dataq->data, dataq_data_destroy); 142*7c478bd9Sstevel@tonic-gate ll_mapf(&dataq->waiters, dataq_waiters_destroy); 143*7c478bd9Sstevel@tonic-gate return (0); 144*7c478bd9Sstevel@tonic-gate } 145