Home | History | Annotate | Line # | Download | only in librt
sem.c revision 1.6
      1 /*	$NetBSD: sem.c,v 1.6 2012/03/08 21:59:29 joerg Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2003 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Jason R. Thorpe.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 /*
     33  * Copyright (C) 2000 Jason Evans <jasone (at) freebsd.org>.
     34  * All rights reserved.
     35  *
     36  * Redistribution and use in source and binary forms, with or without
     37  * modification, are permitted provided that the following conditions
     38  * are met:
     39  * 1. Redistributions of source code must retain the above copyright
     40  *    notice(s), this list of conditions and the following disclaimer as
     41  *    the first lines of this file unmodified other than the possible
     42  *    addition of one or more copyright notices.
     43  * 2. Redistributions in binary form must reproduce the above copyright
     44  *    notice(s), this list of conditions and the following disclaimer in
     45  *    the documentation and/or other materials provided with the
     46  *    distribution.
     47  *
     48  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDER(S) ``AS IS'' AND ANY
     49  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     50  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     51  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) BE
     52  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     53  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     54  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
     55  * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
     56  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
     57  * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
     58  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     59  */
     60 
     61 #include <sys/cdefs.h>
     62 __RCSID("$NetBSD: sem.c,v 1.6 2012/03/08 21:59:29 joerg Exp $");
     63 
     64 /*
     65  * If an application is linked against both librt and libpthread, the
     66  * libpthread versions must be used.  Provide weak aliases to cause
     67  * this behavior.
     68  */
     69 #define	sem_init	_librt_sem_init
     70 #define	sem_destroy	_librt_sem_destroy
     71 #define	sem_open	_librt_sem_open
     72 #define	sem_close	_librt_sem_close
     73 #define	sem_unlink	_librt_sem_unlink
     74 #define	sem_wait	_librt_sem_wait
     75 #define	sem_timedwait	_librt_sem_timedwait
     76 #define	sem_trywait	_librt_sem_trywait
     77 #define	sem_post	_librt_sem_post
     78 #define	sem_getvalue	_librt_sem_getvalue
     79 
     80 #define	_LIBC
     81 
     82 #include <sys/types.h>
     83 #include <sys/ksem.h>
     84 #include <sys/queue.h>
     85 #include <stdlib.h>
     86 #include <errno.h>
     87 #include <fcntl.h>
     88 #include <semaphore.h>
     89 #include <stdarg.h>
     90 
     91 struct _sem_st {
     92 	unsigned int	ksem_magic;
     93 #define	KSEM_MAGIC	0x90af0421U
     94 
     95 	LIST_ENTRY(_sem_st) ksem_list;
     96 	intptr_t		ksem_semid;	/* 0 -> user (non-shared) */
     97 	sem_t		*ksem_identity;
     98 };
     99 
    100 static int sem_alloc(unsigned int value, intptr_t semid, sem_t *semp);
    101 static void sem_free(sem_t sem);
    102 
    103 static LIST_HEAD(, _sem_st) named_sems = LIST_HEAD_INITIALIZER(&named_sems);
    104 
    105 #ifdef __weak_alias
    106 __weak_alias(sem_init,_librt_sem_init)
    107 __weak_alias(sem_destroy,_librt_sem_destroy)
    108 __weak_alias(sem_open,_librt_sem_open)
    109 __weak_alias(sem_close,_librt_sem_close)
    110 __weak_alias(sem_unlink,_librt_sem_unlink)
    111 __weak_alias(sem_wait,_librt_sem_wait)
    112 __weak_alias(sem_timedwait,_librt_sem_timedwait)
    113 __weak_alias(sem_trywait,_librt_sem_trywait)
    114 __weak_alias(sem_post,_librt_sem_post)
    115 __weak_alias(sem_getvalue,_librt_sem_getvalue)
    116 #endif
    117 
    118 static void
    119 sem_free(sem_t sem)
    120 {
    121 
    122 	sem->ksem_magic = 0;
    123 	free(sem);
    124 }
    125 
    126 static int
    127 sem_alloc(unsigned int value, intptr_t semid, sem_t *semp)
    128 {
    129 	sem_t sem;
    130 
    131 	if (value > SEM_VALUE_MAX)
    132 		return (EINVAL);
    133 
    134 	if ((sem = malloc(sizeof(struct _sem_st))) == NULL)
    135 		return (ENOSPC);
    136 
    137 	sem->ksem_magic = KSEM_MAGIC;
    138 	sem->ksem_semid = semid;
    139 
    140 	*semp = sem;
    141 	return (0);
    142 }
    143 
    144 /* ARGSUSED */
    145 int
    146 sem_init(sem_t *sem, int pshared, unsigned int value)
    147 {
    148 	intptr_t	semid;
    149 	int error;
    150 
    151 	if (_ksem_init(value, &semid) == -1)
    152 		return (-1);
    153 
    154 	if ((error = sem_alloc(value, semid, sem)) != 0) {
    155 		_ksem_destroy(semid);
    156 		errno = error;
    157 		return (-1);
    158 	}
    159 
    160 	return (0);
    161 }
    162 
    163 int
    164 sem_destroy(sem_t *sem)
    165 {
    166 
    167 #ifdef ERRORCHECK
    168 	if (sem == NULL || *sem == NULL || (*sem)->ksem_magic != KSEM_MAGIC) {
    169 		errno = EINVAL;
    170 		return (-1);
    171 	}
    172 #endif
    173 
    174 	if (_ksem_destroy((*sem)->ksem_semid) == -1)
    175 		return (-1);
    176 
    177 	sem_free(*sem);
    178 
    179 	return (0);
    180 }
    181 
    182 sem_t *
    183 sem_open(const char *name, int oflag, ...)
    184 {
    185 	sem_t *sem, s;
    186 	intptr_t semid;
    187 	mode_t mode;
    188 	unsigned int value;
    189 	int error;
    190 	va_list ap;
    191 
    192 	mode = 0;
    193 	value = 0;
    194 
    195 	if (oflag & O_CREAT) {
    196 		va_start(ap, oflag);
    197 		mode = va_arg(ap, int);
    198 		value = va_arg(ap, unsigned int);
    199 		va_end(ap);
    200 	}
    201 
    202 	/*
    203 	 * We can be lazy and let the kernel handle the oflag,
    204 	 * we'll just merge duplicate IDs into our list.
    205 	 */
    206 	if (_ksem_open(name, oflag, mode, value, &semid) == -1)
    207 		return (SEM_FAILED);
    208 
    209 	/*
    210 	 * Search for a duplicate ID, we must return the same sem_t *
    211 	 * if we locate one.
    212 	 */
    213 	LIST_FOREACH(s, &named_sems, ksem_list) {
    214 		if (s->ksem_semid == semid)
    215 			return (s->ksem_identity);
    216 	}
    217 
    218 	if ((sem = malloc(sizeof(*sem))) == NULL) {
    219 		error = ENOSPC;
    220 		goto bad;
    221 	}
    222 	if ((error = sem_alloc(value, semid, sem)) != 0)
    223 		goto bad;
    224 
    225 	LIST_INSERT_HEAD(&named_sems, *sem, ksem_list);
    226 	(*sem)->ksem_identity = sem;
    227 
    228 	return (sem);
    229 
    230  bad:
    231 	_ksem_close(semid);
    232 	if (sem != NULL) {
    233 		if (*sem != NULL)
    234 			sem_free(*sem);
    235 		free(sem);
    236 	}
    237 	errno = error;
    238 	return (SEM_FAILED);
    239 }
    240 
    241 int
    242 sem_close(sem_t *sem)
    243 {
    244 
    245 #ifdef ERRORCHECK
    246 	if (sem == NULL || *sem == NULL || (*sem)->ksem_magic != KSEM_MAGIC) {
    247 		errno = EINVAL;
    248 		return (-1);
    249 	}
    250 #endif
    251 
    252 	if (_ksem_close((*sem)->ksem_semid) == -1)
    253 		return (-1);
    254 
    255 	LIST_REMOVE((*sem), ksem_list);
    256 	sem_free(*sem);
    257 	free(sem);
    258 	return (0);
    259 }
    260 
    261 int
    262 sem_unlink(const char *name)
    263 {
    264 
    265 	return (_ksem_unlink(name));
    266 }
    267 
    268 int
    269 sem_wait(sem_t *sem)
    270 {
    271 
    272 #ifdef ERRORCHECK
    273 	if (sem == NULL || *sem == NULL || (*sem)->ksem_magic != KSEM_MAGIC) {
    274 		errno = EINVAL;
    275 		return (-1);
    276 	}
    277 #endif
    278 
    279 	return (_ksem_wait((*sem)->ksem_semid));
    280 }
    281 
    282 int
    283 sem_timedwait(sem_t *sem, const struct timespec * __restrict abstime)
    284 {
    285 
    286 #ifdef ERRORCHECK
    287 	if (sem == NULL || *sem == NULL || (*sem)->ksem_magic != KSEM_MAGIC) {
    288 		errno = EINVAL;
    289 		return (-1);
    290 	}
    291 #endif
    292 
    293 	return (_ksem_timedwait((*sem)->ksem_semid, abstime));
    294 }
    295 
    296 int
    297 sem_trywait(sem_t *sem)
    298 {
    299 
    300 #ifdef ERRORCHECK
    301 	if (sem == NULL || *sem == NULL || (*sem)->ksem_magic != KSEM_MAGIC) {
    302 		errno = EINVAL;
    303 		return (-1);
    304 	}
    305 #endif
    306 
    307 	return (_ksem_trywait((*sem)->ksem_semid));
    308 }
    309 
    310 int
    311 sem_post(sem_t *sem)
    312 {
    313 
    314 #ifdef ERRORCHECK
    315 	if (sem == NULL || *sem == NULL || (*sem)->ksem_magic != KSEM_MAGIC) {
    316 		errno = EINVAL;
    317 		return (-1);
    318 	}
    319 #endif
    320 
    321 	return (_ksem_post((*sem)->ksem_semid));
    322 }
    323 
    324 int
    325 sem_getvalue(sem_t * __restrict sem, int * __restrict sval)
    326 {
    327 
    328 #ifdef ERRORCHECK
    329 	if (sem == NULL || *sem == NULL || (*sem)->ksem_magic != KSEM_MAGIC) {
    330 		errno = EINVAL;
    331 		return (-1);
    332 	}
    333 #endif
    334 	return (_ksem_getvalue((*sem)->ksem_semid, sval));
    335 }
    336