1*a9ca1710Skamil /* $NetBSD: mtx.c,v 1.1 2019/04/24 11:43:19 kamil Exp $ */
2*a9ca1710Skamil
3*a9ca1710Skamil /*-
4*a9ca1710Skamil * Copyright (c) 2016 The NetBSD Foundation, Inc.
5*a9ca1710Skamil * All rights reserved.
6*a9ca1710Skamil *
7*a9ca1710Skamil * This code is derived from software contributed to The NetBSD Foundation
8*a9ca1710Skamil * by Kamil Rytarowski.
9*a9ca1710Skamil *
10*a9ca1710Skamil * Redistribution and use in source and binary forms, with or without
11*a9ca1710Skamil * modification, are permitted provided that the following conditions
12*a9ca1710Skamil * are met:
13*a9ca1710Skamil * 1. Redistributions of source code must retain the above copyright
14*a9ca1710Skamil * notice, this list of conditions and the following disclaimer.
15*a9ca1710Skamil * 2. Redistributions in binary form must reproduce the above copyright
16*a9ca1710Skamil * notice, this list of conditions and the following disclaimer in the
17*a9ca1710Skamil * documentation and/or other materials provided with the distribution.
18*a9ca1710Skamil *
19*a9ca1710Skamil * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20*a9ca1710Skamil * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21*a9ca1710Skamil * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22*a9ca1710Skamil * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23*a9ca1710Skamil * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24*a9ca1710Skamil * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25*a9ca1710Skamil * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26*a9ca1710Skamil * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27*a9ca1710Skamil * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28*a9ca1710Skamil * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29*a9ca1710Skamil * POSSIBILITY OF SUCH DAMAGE.
30*a9ca1710Skamil */
31*a9ca1710Skamil
32*a9ca1710Skamil #include <sys/cdefs.h>
33*a9ca1710Skamil __RCSID("$NetBSD: mtx.c,v 1.1 2019/04/24 11:43:19 kamil Exp $");
34*a9ca1710Skamil
35*a9ca1710Skamil #include <assert.h>
36*a9ca1710Skamil #include <errno.h>
37*a9ca1710Skamil #include <pthread.h>
38*a9ca1710Skamil #include <threads.h>
39*a9ca1710Skamil
40*a9ca1710Skamil void
mtx_destroy(mtx_t * mtx)41*a9ca1710Skamil mtx_destroy(mtx_t *mtx)
42*a9ca1710Skamil {
43*a9ca1710Skamil
44*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
45*a9ca1710Skamil
46*a9ca1710Skamil /*
47*a9ca1710Skamil * The cnd_destroy(3) function that conforms to C11 returns no value.
48*a9ca1710Skamil */
49*a9ca1710Skamil (void)pthread_mutex_destroy(mtx);
50*a9ca1710Skamil }
51*a9ca1710Skamil
52*a9ca1710Skamil static inline int
mtx_init_default(mtx_t * mtx)53*a9ca1710Skamil mtx_init_default(mtx_t *mtx)
54*a9ca1710Skamil {
55*a9ca1710Skamil
56*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
57*a9ca1710Skamil
58*a9ca1710Skamil if (pthread_mutex_init(mtx, NULL) != 0)
59*a9ca1710Skamil return thrd_error;
60*a9ca1710Skamil
61*a9ca1710Skamil return thrd_success;
62*a9ca1710Skamil }
63*a9ca1710Skamil
64*a9ca1710Skamil static inline int
mtx_init_recursive(mtx_t * mtx)65*a9ca1710Skamil mtx_init_recursive(mtx_t *mtx)
66*a9ca1710Skamil {
67*a9ca1710Skamil pthread_mutexattr_t attr;
68*a9ca1710Skamil
69*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
70*a9ca1710Skamil
71*a9ca1710Skamil if (pthread_mutexattr_init(&attr) != 0)
72*a9ca1710Skamil return thrd_error;
73*a9ca1710Skamil
74*a9ca1710Skamil if (pthread_mutexattr_settype(&attr, PTHREAD_MUTEX_RECURSIVE) != 0) {
75*a9ca1710Skamil pthread_mutexattr_destroy(&attr);
76*a9ca1710Skamil
77*a9ca1710Skamil return thrd_error;
78*a9ca1710Skamil }
79*a9ca1710Skamil
80*a9ca1710Skamil if (pthread_mutex_init(mtx, &attr) == 0)
81*a9ca1710Skamil return thrd_success;
82*a9ca1710Skamil
83*a9ca1710Skamil pthread_mutexattr_destroy(&attr);
84*a9ca1710Skamil
85*a9ca1710Skamil return thrd_error;
86*a9ca1710Skamil }
87*a9ca1710Skamil
88*a9ca1710Skamil int
mtx_init(mtx_t * mtx,int type)89*a9ca1710Skamil mtx_init(mtx_t *mtx, int type)
90*a9ca1710Skamil {
91*a9ca1710Skamil
92*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
93*a9ca1710Skamil
94*a9ca1710Skamil switch (type) {
95*a9ca1710Skamil case mtx_plain:
96*a9ca1710Skamil case mtx_timed:
97*a9ca1710Skamil return mtx_init_default(mtx);
98*a9ca1710Skamil case mtx_plain | mtx_recursive:
99*a9ca1710Skamil case mtx_timed | mtx_recursive:
100*a9ca1710Skamil return mtx_init_recursive(mtx);
101*a9ca1710Skamil default:
102*a9ca1710Skamil return thrd_error;
103*a9ca1710Skamil }
104*a9ca1710Skamil }
105*a9ca1710Skamil
106*a9ca1710Skamil int
mtx_lock(mtx_t * mtx)107*a9ca1710Skamil mtx_lock(mtx_t *mtx)
108*a9ca1710Skamil {
109*a9ca1710Skamil
110*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
111*a9ca1710Skamil
112*a9ca1710Skamil if (pthread_mutex_lock(mtx) == 0)
113*a9ca1710Skamil return thrd_success;
114*a9ca1710Skamil
115*a9ca1710Skamil return thrd_error;
116*a9ca1710Skamil }
117*a9ca1710Skamil
118*a9ca1710Skamil int
mtx_timedlock(mtx_t * __restrict mtx,const struct timespec * __restrict ts)119*a9ca1710Skamil mtx_timedlock(mtx_t *__restrict mtx, const struct timespec *__restrict ts)
120*a9ca1710Skamil {
121*a9ca1710Skamil
122*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
123*a9ca1710Skamil _DIAGASSERT(ts != NULL);
124*a9ca1710Skamil
125*a9ca1710Skamil switch(pthread_mutex_timedlock(mtx, ts)) {
126*a9ca1710Skamil case 0:
127*a9ca1710Skamil return thrd_success;
128*a9ca1710Skamil case ETIMEDOUT:
129*a9ca1710Skamil return thrd_timedout;
130*a9ca1710Skamil default:
131*a9ca1710Skamil return thrd_error;
132*a9ca1710Skamil }
133*a9ca1710Skamil }
134*a9ca1710Skamil
135*a9ca1710Skamil int
mtx_trylock(mtx_t * mtx)136*a9ca1710Skamil mtx_trylock(mtx_t *mtx)
137*a9ca1710Skamil {
138*a9ca1710Skamil
139*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
140*a9ca1710Skamil
141*a9ca1710Skamil switch(pthread_mutex_trylock(mtx)) {
142*a9ca1710Skamil case 0:
143*a9ca1710Skamil return thrd_success;
144*a9ca1710Skamil case EBUSY:
145*a9ca1710Skamil return thrd_busy;
146*a9ca1710Skamil default:
147*a9ca1710Skamil return thrd_error;
148*a9ca1710Skamil }
149*a9ca1710Skamil }
150*a9ca1710Skamil
151*a9ca1710Skamil int
mtx_unlock(mtx_t * mtx)152*a9ca1710Skamil mtx_unlock(mtx_t *mtx)
153*a9ca1710Skamil {
154*a9ca1710Skamil
155*a9ca1710Skamil _DIAGASSERT(mtx != NULL);
156*a9ca1710Skamil
157*a9ca1710Skamil if (pthread_mutex_unlock(mtx) == 0)
158*a9ca1710Skamil return thrd_success;
159*a9ca1710Skamil
160*a9ca1710Skamil return thrd_error;
161*a9ca1710Skamil }
162