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; |
7e92a66a | 159 | struct timespec base; |
656b1393 JA |
160 | struct timespec t; |
161 | int ret = 0; | |
162 | ||
8f801ad5 | 163 | assert(mutex->magic == FIO_MUTEX_MAGIC); |
8b4e954c | 164 | |
b11e4ccf | 165 | gettimeofday(&tv_s, NULL); |
7e92a66a YS |
166 | base.tv_sec = t.tv_sec = tv_s.tv_sec; |
167 | base.tv_nsec = t.tv_nsec = tv_s.tv_usec * 1000; | |
656b1393 | 168 | |
09400a60 | 169 | t.tv_sec += msecs / 1000; |
90eff1c9 | 170 | t.tv_nsec += ((msecs * 1000000ULL) % 1000000000); |
09400a60 JA |
171 | if (t.tv_nsec >= 1000000000) { |
172 | t.tv_nsec -= 1000000000; | |
173 | t.tv_sec++; | |
174 | } | |
175 | ||
656b1393 JA |
176 | pthread_mutex_lock(&mutex->lock); |
177 | ||
09400a60 | 178 | mutex->waiters++; |
656b1393 | 179 | while (!mutex->value && !ret) { |
ef635057 JA |
180 | /* |
181 | * Some platforms (FreeBSD 9?) seems to return timed out | |
182 | * way too early, double check. | |
183 | */ | |
656b1393 | 184 | ret = pthread_cond_timedwait(&mutex->cond, &mutex->lock, &t); |
7e92a66a | 185 | if (ret == ETIMEDOUT && !mutex_timed_out(&base, msecs)) |
ef635057 | 186 | ret = 0; |
656b1393 | 187 | } |
09400a60 | 188 | mutex->waiters--; |
656b1393 JA |
189 | |
190 | if (!ret) { | |
191 | mutex->value--; | |
192 | pthread_mutex_unlock(&mutex->lock); | |
42e833fa | 193 | return 0; |
656b1393 JA |
194 | } |
195 | ||
09400a60 | 196 | pthread_mutex_unlock(&mutex->lock); |
656b1393 JA |
197 | return ret; |
198 | } | |
199 | ||
66608372 | 200 | bool fio_mutex_down_trylock(struct fio_mutex *mutex) |
72242057 | 201 | { |
66608372 | 202 | bool ret = true; |
72242057 JA |
203 | |
204 | assert(mutex->magic == FIO_MUTEX_MAGIC); | |
205 | ||
206 | pthread_mutex_lock(&mutex->lock); | |
207 | if (mutex->value) { | |
208 | mutex->value--; | |
66608372 | 209 | ret = false; |
72242057 JA |
210 | } |
211 | pthread_mutex_unlock(&mutex->lock); | |
212 | ||
213 | return ret; | |
214 | } | |
215 | ||
cdd18ad8 | 216 | void fio_mutex_down(struct fio_mutex *mutex) |
07739b57 | 217 | { |
8f801ad5 | 218 | assert(mutex->magic == FIO_MUTEX_MAGIC); |
8b4e954c | 219 | |
cdd18ad8 | 220 | pthread_mutex_lock(&mutex->lock); |
4d4e80f2 JA |
221 | |
222 | while (!mutex->value) { | |
223 | mutex->waiters++; | |
cdd18ad8 | 224 | pthread_cond_wait(&mutex->cond, &mutex->lock); |
4d4e80f2 JA |
225 | mutex->waiters--; |
226 | } | |
227 | ||
cdd18ad8 JA |
228 | mutex->value--; |
229 | pthread_mutex_unlock(&mutex->lock); | |
07739b57 JA |
230 | } |
231 | ||
cdd18ad8 | 232 | void fio_mutex_up(struct fio_mutex *mutex) |
07739b57 | 233 | { |
6899b6cb JA |
234 | int do_wake = 0; |
235 | ||
8f801ad5 | 236 | assert(mutex->magic == FIO_MUTEX_MAGIC); |
8b4e954c | 237 | |
cdd18ad8 | 238 | pthread_mutex_lock(&mutex->lock); |
4d4e80f2 JA |
239 | read_barrier(); |
240 | if (!mutex->value && mutex->waiters) | |
6899b6cb | 241 | do_wake = 1; |
cdd18ad8 JA |
242 | mutex->value++; |
243 | pthread_mutex_unlock(&mutex->lock); | |
6899b6cb JA |
244 | |
245 | if (do_wake) | |
246 | pthread_cond_signal(&mutex->cond); | |
07739b57 | 247 | } |
64d4d313 | 248 | |
d7df1d13 | 249 | void fio_rwlock_write(struct fio_rwlock *lock) |
64d4d313 | 250 | { |
8f801ad5 | 251 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 | 252 | pthread_rwlock_wrlock(&lock->lock); |
64d4d313 JA |
253 | } |
254 | ||
d7df1d13 | 255 | void fio_rwlock_read(struct fio_rwlock *lock) |
64d4d313 | 256 | { |
8f801ad5 | 257 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 JA |
258 | pthread_rwlock_rdlock(&lock->lock); |
259 | } | |
4d4e80f2 | 260 | |
d7df1d13 JA |
261 | void fio_rwlock_unlock(struct fio_rwlock *lock) |
262 | { | |
8f801ad5 | 263 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 | 264 | pthread_rwlock_unlock(&lock->lock); |
64d4d313 JA |
265 | } |
266 | ||
d7df1d13 | 267 | void fio_rwlock_remove(struct fio_rwlock *lock) |
64d4d313 | 268 | { |
8f801ad5 | 269 | assert(lock->magic == FIO_RWLOCK_MAGIC); |
d7df1d13 | 270 | munmap((void *) lock, sizeof(*lock)); |
64d4d313 JA |
271 | } |
272 | ||
d7df1d13 | 273 | struct fio_rwlock *fio_rwlock_init(void) |
64d4d313 | 274 | { |
d7df1d13 | 275 | struct fio_rwlock *lock; |
33980f5d | 276 | pthread_rwlockattr_t attr; |
d7df1d13 JA |
277 | int ret; |
278 | ||
279 | lock = (void *) mmap(NULL, sizeof(struct fio_rwlock), | |
280 | PROT_READ | PROT_WRITE, | |
281 | OS_MAP_ANON | MAP_SHARED, -1, 0); | |
282 | if (lock == MAP_FAILED) { | |
283 | perror("mmap rwlock"); | |
284 | lock = NULL; | |
285 | goto err; | |
286 | } | |
287 | ||
8b4e954c JA |
288 | lock->magic = FIO_RWLOCK_MAGIC; |
289 | ||
33980f5d | 290 | ret = pthread_rwlockattr_init(&attr); |
d7df1d13 | 291 | if (ret) { |
cdb57fe2 | 292 | log_err("pthread_rwlockattr_init: %s\n", strerror(ret)); |
d7df1d13 JA |
293 | goto err; |
294 | } | |
06eac6b2 | 295 | #ifdef CONFIG_PSHARED |
33980f5d SL |
296 | ret = pthread_rwlockattr_setpshared(&attr, PTHREAD_PROCESS_SHARED); |
297 | if (ret) { | |
cdb57fe2 | 298 | log_err("pthread_rwlockattr_setpshared: %s\n", strerror(ret)); |
33980f5d SL |
299 | goto destroy_attr; |
300 | } | |
33980f5d SL |
301 | |
302 | ret = pthread_rwlock_init(&lock->lock, &attr); | |
09f17d62 BC |
303 | #else |
304 | ret = pthread_rwlock_init(&lock->lock, NULL); | |
305 | #endif | |
306 | ||
33980f5d SL |
307 | if (ret) { |
308 | log_err("pthread_rwlock_init: %s\n", strerror(ret)); | |
309 | goto destroy_attr; | |
310 | } | |
311 | ||
312 | pthread_rwlockattr_destroy(&attr); | |
d7df1d13 JA |
313 | |
314 | return lock; | |
33980f5d SL |
315 | destroy_attr: |
316 | pthread_rwlockattr_destroy(&attr); | |
d7df1d13 JA |
317 | err: |
318 | if (lock) | |
319 | fio_rwlock_remove(lock); | |
320 | return NULL; | |
64d4d313 | 321 | } |