Commit | Line | Data |
---|---|---|
07739b57 JA |
1 | #include <stdio.h> |
2 | #include <string.h> | |
3 | #include <unistd.h> | |
4 | #include <stdlib.h> | |
5 | #include <fcntl.h> | |
656b1393 | 6 | #include <time.h> |
ef635057 | 7 | #include <errno.h> |
07739b57 JA |
8 | #include <pthread.h> |
9 | #include <sys/mman.h> | |
8b4e954c | 10 | #include <assert.h> |
07739b57 | 11 | |
b4c1fb36 | 12 | #include "fio.h" |
4fa6d0f8 | 13 | #include "log.h" |
07739b57 | 14 | #include "mutex.h" |
4d4e80f2 | 15 | #include "arch/arch.h" |
3c2d93ed | 16 | #include "os/os.h" |
3b2e1464 | 17 | #include "helpers.h" |
ef3c94b6 | 18 | #include "fio_time.h" |
ef635057 | 19 | #include "gettime.h" |
07739b57 | 20 | |
f5a42524 | 21 | void __fio_mutex_remove(struct fio_mutex *mutex) |
07739b57 | 22 | { |
8f801ad5 | 23 | assert(mutex->magic == FIO_MUTEX_MAGIC); |
58a157d4 | 24 | pthread_cond_destroy(&mutex->cond); |
4e1cc8e6 JA |
25 | |
26 | /* | |
27 | * Ensure any subsequent attempt to grab this mutex will fail | |
28 | * with an assert, instead of just silently hanging. | |
29 | */ | |
30 | memset(mutex, 0, sizeof(*mutex)); | |
f5a42524 JA |
31 | } |
32 | ||
33 | void fio_mutex_remove(struct fio_mutex *mutex) | |
34 | { | |
35 | __fio_mutex_remove(mutex); | |
5921e80c | 36 | munmap((void *) mutex, sizeof(*mutex)); |
07739b57 JA |
37 | } |
38 | ||
34febb23 | 39 | int cond_init_pshared(pthread_cond_t *cond) |
07739b57 | 40 | { |
34febb23 | 41 | pthread_condattr_t cattr; |
e721c57f | 42 | int ret; |
07739b57 | 43 | |
34febb23 JA |
44 | ret = pthread_condattr_init(&cattr); |
45 | if (ret) { | |
46 | log_err("pthread_condattr_init: %s\n", strerror(ret)); | |
47 | return ret; | |
48 | } | |
49 | ||
06eac6b2 | 50 | #ifdef CONFIG_PSHARED |
34febb23 JA |
51 | ret = pthread_condattr_setpshared(&cattr, PTHREAD_PROCESS_SHARED); |
52 | if (ret) { | |
53 | log_err("pthread_condattr_setpshared: %s\n", strerror(ret)); | |
54 | return ret; | |
55 | } | |
56 | #endif | |
57 | ret = pthread_cond_init(cond, &cattr); | |
58 | if (ret) { | |
59 | log_err("pthread_cond_init: %s\n", strerror(ret)); | |
60 | return ret; | |
61 | } | |
62 | ||
63 | return 0; | |
64 | } | |
07739b57 | 65 | |
34febb23 JA |
66 | int mutex_init_pshared(pthread_mutex_t *mutex) |
67 | { | |
68 | pthread_mutexattr_t mattr; | |
69 | int ret; | |
70 | ||
71 | ret = pthread_mutexattr_init(&mattr); | |
4fa6d0f8 JA |
72 | if (ret) { |
73 | log_err("pthread_mutexattr_init: %s\n", strerror(ret)); | |
72242057 | 74 | return ret; |
07739b57 | 75 | } |
e721c57f JA |
76 | |
77 | /* | |
78 | * Not all platforms support process shared mutexes (FreeBSD) | |
79 | */ | |
06eac6b2 | 80 | #ifdef CONFIG_PSHARED |
34febb23 | 81 | ret = pthread_mutexattr_setpshared(&mattr, PTHREAD_PROCESS_SHARED); |
4fa6d0f8 JA |
82 | if (ret) { |
83 | log_err("pthread_mutexattr_setpshared: %s\n", strerror(ret)); | |
72242057 | 84 | return ret; |
07739b57 | 85 | } |
7452440e | 86 | #endif |
34febb23 | 87 | ret = pthread_mutex_init(mutex, &mattr); |
4fa6d0f8 JA |
88 | if (ret) { |
89 | log_err("pthread_mutex_init: %s\n", strerror(ret)); | |
72242057 | 90 | return ret; |
07739b57 JA |
91 | } |
92 | ||
34febb23 JA |
93 | return 0; |
94 | } | |
95 | ||
96 | int mutex_cond_init_pshared(pthread_mutex_t *mutex, pthread_cond_t *cond) | |
97 | { | |
98 | int ret; | |
99 | ||
100 | ret = mutex_init_pshared(mutex); | |
101 | if (ret) | |
102 | return ret; | |
103 | ||
104 | ret = cond_init_pshared(cond); | |
105 | if (ret) | |
106 | return ret; | |
107 | ||
108 | return 0; | |
109 | } | |
110 | ||
111 | int __fio_mutex_init(struct fio_mutex *mutex, int value) | |
112 | { | |
113 | int ret; | |
114 | ||
115 | mutex->value = value; | |
116 | mutex->magic = FIO_MUTEX_MAGIC; | |
117 | ||
118 | ret = mutex_cond_init_pshared(&mutex->lock, &mutex->cond); | |
119 | if (ret) | |
120 | return ret; | |
121 | ||
72242057 JA |
122 | return 0; |
123 | } | |
124 | ||
125 | struct fio_mutex *fio_mutex_init(int value) | |
126 | { | |
127 | struct fio_mutex *mutex = NULL; | |
128 | ||
129 | mutex = (void *) mmap(NULL, sizeof(struct fio_mutex), | |
130 | PROT_READ | PROT_WRITE, | |
131 | OS_MAP_ANON | MAP_SHARED, -1, 0); | |
132 | if (mutex == MAP_FAILED) { | |
133 | perror("mmap mutex"); | |
134 | return NULL; | |
135 | } | |
03e20d68 | 136 | |
72242057 JA |
137 | if (!__fio_mutex_init(mutex, value)) |
138 | return mutex; | |
f7c9e00e | 139 | |
72242057 | 140 | fio_mutex_remove(mutex); |
07739b57 JA |
141 | return NULL; |
142 | } | |
143 | ||
8b6a404c | 144 | static bool mutex_timed_out(struct timespec *t, unsigned int msecs) |
ef635057 | 145 | { |
8b6a404c VF |
146 | struct timeval tv; |
147 | struct timespec now; | |
148 | ||
149 | gettimeofday(&tv, NULL); | |
150 | now.tv_sec = tv.tv_sec; | |
151 | now.tv_nsec = tv.tv_usec * 1000; | |
09400a60 | 152 | |
09400a60 | 153 | return mtime_since(t, &now) >= msecs; |
ef635057 JA |
154 | } |
155 | ||
09400a60 | 156 | int fio_mutex_down_timeout(struct fio_mutex *mutex, unsigned int msecs) |
656b1393 | 157 | { |
ef635057 | 158 | struct timeval tv_s; |
656b1393 JA |
159 | struct timespec t; |
160 | int ret = 0; | |
161 | ||
8f801ad5 | 162 | assert(mutex->magic == FIO_MUTEX_MAGIC); |
8b4e954c | 163 | |
b11e4ccf | 164 | gettimeofday(&tv_s, NULL); |
09400a60 | 165 | t.tv_sec = tv_s.tv_sec; |
b11e4ccf | 166 | t.tv_nsec = tv_s.tv_usec * 1000; |
656b1393 | 167 | |
09400a60 | 168 | t.tv_sec += msecs / 1000; |
90eff1c9 | 169 | t.tv_nsec += ((msecs * 1000000ULL) % 1000000000); |
09400a60 JA |
170 | if (t.tv_nsec >= 1000000000) { |
171 | t.tv_nsec -= 1000000000; | |
172 | t.tv_sec++; | |
173 | } | |
174 | ||
656b1393 JA |
175 | pthread_mutex_lock(&mutex->lock); |
176 | ||
09400a60 | 177 | mutex->waiters++; |
656b1393 | 178 | while (!mutex->value && !ret) { |
ef635057 JA |
179 | /* |
180 | * Some platforms (FreeBSD 9?) seems to return timed out | |
181 | * way too early, double check. | |
182 | */ | |
656b1393 | 183 | ret = pthread_cond_timedwait(&mutex->cond, &mutex->lock, &t); |
8b6a404c | 184 | if (ret == ETIMEDOUT && !mutex_timed_out(&t, msecs)) |
ef635057 | 185 | ret = 0; |
656b1393 | 186 | } |
09400a60 | 187 | mutex->waiters--; |
656b1393 JA |
188 | |
189 | if (!ret) { | |
190 | mutex->value--; | |
191 | pthread_mutex_unlock(&mutex->lock); | |
42e833fa | 192 | return 0; |
656b1393 JA |
193 | } |
194 | ||
09400a60 | 195 | pthread_mutex_unlock(&mutex->lock); |
656b1393 JA |
196 | return ret; |
197 | } | |
198 | ||
66608372 | 199 | bool fio_mutex_down_trylock(struct fio_mutex *mutex) |
72242057 | 200 | { |
66608372 | 201 | bool ret = true; |
72242057 JA |
202 | |
203 | assert(mutex->magic == FIO_MUTEX_MAGIC); | |
204 | ||
205 | pthread_mutex_lock(&mutex->lock); | |
206 | if (mutex->value) { | |
207 | mutex->value--; | |
66608372 | 208 | ret = false; |
72242057 JA |
209 | } |
210 | pthread_mutex_unlock(&mutex->lock); | |
211 | ||
212 | return ret; | |
213 | } | |
214 | ||
cdd18ad8 | 215 | void fio_mutex_down(struct fio_mutex *mutex) |
07739b57 | 216 | { |
8f801ad5 | 217 | assert(mutex->magic == FIO_MUTEX_MAGIC); |
8b4e954c | 218 | |
cdd18ad8 | 219 | pthread_mutex_lock(&mutex->lock); |
4d4e80f2 JA |
220 | |
221 | while (!mutex->value) { | |
222 | mutex->waiters++; | |
cdd18ad8 | 223 | pthread_cond_wait(&mutex->cond, &mutex->lock); |
4d4e80f2 JA |
224 | mutex->waiters--; |
225 | } | |
226 | ||
cdd18ad8 JA |
227 | mutex->value--; |
228 | pthread_mutex_unlock(&mutex->lock); | |
07739b57 JA |
229 | } |
230 | ||
cdd18ad8 | 231 | void fio_mutex_up(struct fio_mutex *mutex) |
07739b57 | 232 | { |
6899b6cb JA |
233 | int do_wake = 0; |
234 | ||
8f801ad5 | 235 | assert(mutex->magic == FIO_MUTEX_MAGIC); |
8b4e954c | 236 | |
cdd18ad8 | 237 | pthread_mutex_lock(&mutex->lock); |
4d4e80f2 JA |
238 | read_barrier(); |
239 | if (!mutex->value && mutex->waiters) | |
6899b6cb | 240 | do_wake = 1; |
cdd18ad8 JA |
241 | mutex->value++; |
242 | pthread_mutex_unlock(&mutex->lock); | |
6899b6cb JA |
243 | |
244 | if (do_wake) | |
245 | pthread_cond_signal(&mutex->cond); | |
07739b57 | 246 | } |
64d4d313 | 247 | |
d7df1d13 | 248 | void fio_rwlock_write(struct fio_rwlock *lock) |
64d4d313 | 249 | { |
8f801ad5 | 250 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 | 251 | pthread_rwlock_wrlock(&lock->lock); |
64d4d313 JA |
252 | } |
253 | ||
d7df1d13 | 254 | void fio_rwlock_read(struct fio_rwlock *lock) |
64d4d313 | 255 | { |
8f801ad5 | 256 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 JA |
257 | pthread_rwlock_rdlock(&lock->lock); |
258 | } | |
4d4e80f2 | 259 | |
d7df1d13 JA |
260 | void fio_rwlock_unlock(struct fio_rwlock *lock) |
261 | { | |
8f801ad5 | 262 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 | 263 | pthread_rwlock_unlock(&lock->lock); |
64d4d313 JA |
264 | } |
265 | ||
d7df1d13 | 266 | void fio_rwlock_remove(struct fio_rwlock *lock) |
64d4d313 | 267 | { |
8f801ad5 | 268 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 | 269 | munmap((void *) lock, sizeof(*lock)); |
64d4d313 JA |
270 | } |
271 | ||
d7df1d13 | 272 | struct fio_rwlock *fio_rwlock_init(void) |
64d4d313 | 273 | { |
d7df1d13 | 274 | struct fio_rwlock *lock; |
33980f5d | 275 | pthread_rwlockattr_t attr; |
d7df1d13 JA |
276 | int ret; |
277 | ||
278 | lock = (void *) mmap(NULL, sizeof(struct fio_rwlock), | |
279 | PROT_READ | PROT_WRITE, | |
280 | OS_MAP_ANON | MAP_SHARED, -1, 0); | |
281 | if (lock == MAP_FAILED) { | |
282 | perror("mmap rwlock"); | |
283 | lock = NULL; | |
284 | goto err; | |
285 | } | |
286 | ||
8b4e954c JA |
287 | lock->magic = FIO_RWLOCK_MAGIC; |
288 | ||
33980f5d | 289 | ret = pthread_rwlockattr_init(&attr); |
d7df1d13 | 290 | if (ret) { |
cdb57fe2 | 291 | log_err("pthread_rwlockattr_init: %s\n", strerror(ret)); |
d7df1d13 JA |
292 | goto err; |
293 | } | |
06eac6b2 | 294 | #ifdef CONFIG_PSHARED |
33980f5d SL |
295 | ret = pthread_rwlockattr_setpshared(&attr, PTHREAD_PROCESS_SHARED); |
296 | if (ret) { | |
cdb57fe2 | 297 | log_err("pthread_rwlockattr_setpshared: %s\n", strerror(ret)); |
33980f5d SL |
298 | goto destroy_attr; |
299 | } | |
33980f5d SL |
300 | |
301 | ret = pthread_rwlock_init(&lock->lock, &attr); | |
09f17d62 BC |
302 | #else |
303 | ret = pthread_rwlock_init(&lock->lock, NULL); | |
304 | #endif | |
305 | ||
33980f5d SL |
306 | if (ret) { |
307 | log_err("pthread_rwlock_init: %s\n", strerror(ret)); | |
308 | goto destroy_attr; | |
309 | } | |
310 | ||
311 | pthread_rwlockattr_destroy(&attr); | |
d7df1d13 JA |
312 | |
313 | return lock; | |
33980f5d SL |
314 | destroy_attr: |
315 | pthread_rwlockattr_destroy(&attr); | |
d7df1d13 JA |
316 | err: |
317 | if (lock) | |
318 | fio_rwlock_remove(lock); | |
319 | return NULL; | |
64d4d313 | 320 | } |