This source file includes following definitions.
- try_init_preload
- __get_lock_node
- is_static_lock
- alloc_lock
- free_lock
- __get_lock
- __del_lock
- pthread_mutex_init
- pthread_mutex_lock
- pthread_mutex_trylock
- pthread_mutex_unlock
- pthread_mutex_destroy
- pthread_rwlock_init
- pthread_rwlock_destroy
- pthread_rwlock_rdlock
- pthread_rwlock_tryrdlock
- pthread_rwlock_trywrlock
- pthread_rwlock_wrlock
- pthread_rwlock_unlock
- init_preload
1
2 #define _GNU_SOURCE
3 #include <pthread.h>
4 #include <stdio.h>
5 #include <dlfcn.h>
6 #include <stdlib.h>
7 #include <sysexits.h>
8 #include <unistd.h>
9 #include "include/liblockdep/mutex.h"
10 #include "../../include/linux/rbtree.h"
11
12
13
14
15
16
17
18
19
20 struct lock_lookup {
21 void *orig;
22 struct lockdep_map dep_map;
23
24
25
26
27
28
29
30
31
32 struct lock_class_key key;
33 struct rb_node node;
34 #define LIBLOCKDEP_MAX_LOCK_NAME 22
35 char name[LIBLOCKDEP_MAX_LOCK_NAME];
36 };
37
38
39 static struct rb_root locks = RB_ROOT;
40 static pthread_rwlock_t locks_rwlock = PTHREAD_RWLOCK_INITIALIZER;
41
42
43
44 #ifdef __GLIBC__
45 extern int __pthread_mutex_init(pthread_mutex_t *mutex, const pthread_mutexattr_t *attr);
46 extern int __pthread_mutex_lock(pthread_mutex_t *mutex);
47 extern int __pthread_mutex_trylock(pthread_mutex_t *mutex);
48 extern int __pthread_mutex_unlock(pthread_mutex_t *mutex);
49 extern int __pthread_mutex_destroy(pthread_mutex_t *mutex);
50 #else
51 #define __pthread_mutex_init NULL
52 #define __pthread_mutex_lock NULL
53 #define __pthread_mutex_trylock NULL
54 #define __pthread_mutex_unlock NULL
55 #define __pthread_mutex_destroy NULL
56 #endif
57 static int (*ll_pthread_mutex_init)(pthread_mutex_t *mutex,
58 const pthread_mutexattr_t *attr) = __pthread_mutex_init;
59 static int (*ll_pthread_mutex_lock)(pthread_mutex_t *mutex) = __pthread_mutex_lock;
60 static int (*ll_pthread_mutex_trylock)(pthread_mutex_t *mutex) = __pthread_mutex_trylock;
61 static int (*ll_pthread_mutex_unlock)(pthread_mutex_t *mutex) = __pthread_mutex_unlock;
62 static int (*ll_pthread_mutex_destroy)(pthread_mutex_t *mutex) = __pthread_mutex_destroy;
63
64
65
66 #ifdef __GLIBC__
67 extern int __pthread_rwlock_init(pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr);
68 extern int __pthread_rwlock_destroy(pthread_rwlock_t *rwlock);
69 extern int __pthread_rwlock_wrlock(pthread_rwlock_t *rwlock);
70 extern int __pthread_rwlock_trywrlock(pthread_rwlock_t *rwlock);
71 extern int __pthread_rwlock_rdlock(pthread_rwlock_t *rwlock);
72 extern int __pthread_rwlock_tryrdlock(pthread_rwlock_t *rwlock);
73 extern int __pthread_rwlock_unlock(pthread_rwlock_t *rwlock);
74 #else
75 #define __pthread_rwlock_init NULL
76 #define __pthread_rwlock_destroy NULL
77 #define __pthread_rwlock_wrlock NULL
78 #define __pthread_rwlock_trywrlock NULL
79 #define __pthread_rwlock_rdlock NULL
80 #define __pthread_rwlock_tryrdlock NULL
81 #define __pthread_rwlock_unlock NULL
82 #endif
83
84 static int (*ll_pthread_rwlock_init)(pthread_rwlock_t *rwlock,
85 const pthread_rwlockattr_t *attr) = __pthread_rwlock_init;
86 static int (*ll_pthread_rwlock_destroy)(pthread_rwlock_t *rwlock) = __pthread_rwlock_destroy;
87 static int (*ll_pthread_rwlock_rdlock)(pthread_rwlock_t *rwlock) = __pthread_rwlock_rdlock;
88 static int (*ll_pthread_rwlock_tryrdlock)(pthread_rwlock_t *rwlock) = __pthread_rwlock_tryrdlock;
89 static int (*ll_pthread_rwlock_trywrlock)(pthread_rwlock_t *rwlock) = __pthread_rwlock_trywrlock;
90 static int (*ll_pthread_rwlock_wrlock)(pthread_rwlock_t *rwlock) = __pthread_rwlock_wrlock;
91 static int (*ll_pthread_rwlock_unlock)(pthread_rwlock_t *rwlock) = __pthread_rwlock_unlock;
92
93 enum { none, prepare, done, } __init_state;
94 static void init_preload(void);
95 static void try_init_preload(void)
96 {
97 if (__init_state != done)
98 init_preload();
99 }
100
101 static struct rb_node **__get_lock_node(void *lock, struct rb_node **parent)
102 {
103 struct rb_node **node = &locks.rb_node;
104 struct lock_lookup *l;
105
106 *parent = NULL;
107
108 while (*node) {
109 l = rb_entry(*node, struct lock_lookup, node);
110
111 *parent = *node;
112 if (lock < l->orig)
113 node = &l->node.rb_left;
114 else if (lock > l->orig)
115 node = &l->node.rb_right;
116 else
117 return node;
118 }
119
120 return node;
121 }
122
123 #ifndef LIBLOCKDEP_STATIC_ENTRIES
124 #define LIBLOCKDEP_STATIC_ENTRIES 1024
125 #endif
126
127 static struct lock_lookup __locks[LIBLOCKDEP_STATIC_ENTRIES];
128 static int __locks_nr;
129
130 static inline bool is_static_lock(struct lock_lookup *lock)
131 {
132 return lock >= __locks && lock < __locks + ARRAY_SIZE(__locks);
133 }
134
135 static struct lock_lookup *alloc_lock(void)
136 {
137 if (__init_state != done) {
138
139
140
141
142
143
144
145
146
147
148
149
150 int idx = __locks_nr++;
151 if (idx >= ARRAY_SIZE(__locks)) {
152 dprintf(STDERR_FILENO,
153 "LOCKDEP error: insufficient LIBLOCKDEP_STATIC_ENTRIES\n");
154 exit(EX_UNAVAILABLE);
155 }
156 return __locks + idx;
157 }
158
159 return malloc(sizeof(struct lock_lookup));
160 }
161
162 static inline void free_lock(struct lock_lookup *lock)
163 {
164 if (likely(!is_static_lock(lock)))
165 free(lock);
166 }
167
168
169
170
171
172
173
174
175 static struct lock_lookup *__get_lock(void *lock)
176 {
177 struct rb_node **node, *parent;
178 struct lock_lookup *l;
179
180 ll_pthread_rwlock_rdlock(&locks_rwlock);
181 node = __get_lock_node(lock, &parent);
182 ll_pthread_rwlock_unlock(&locks_rwlock);
183 if (*node) {
184 return rb_entry(*node, struct lock_lookup, node);
185 }
186
187
188 l = alloc_lock();
189 if (l == NULL)
190 return NULL;
191
192 l->orig = lock;
193
194
195
196
197
198
199 sprintf(l->name, "%p", lock);
200 lockdep_init_map(&l->dep_map, l->name, &l->key, 0);
201
202 ll_pthread_rwlock_wrlock(&locks_rwlock);
203
204 node = __get_lock_node(lock, &parent);
205 rb_link_node(&l->node, parent, node);
206 rb_insert_color(&l->node, &locks);
207 ll_pthread_rwlock_unlock(&locks_rwlock);
208
209 return l;
210 }
211
212 static void __del_lock(struct lock_lookup *lock)
213 {
214 ll_pthread_rwlock_wrlock(&locks_rwlock);
215 rb_erase(&lock->node, &locks);
216 ll_pthread_rwlock_unlock(&locks_rwlock);
217 free_lock(lock);
218 }
219
220 int pthread_mutex_init(pthread_mutex_t *mutex,
221 const pthread_mutexattr_t *attr)
222 {
223 int r;
224
225
226
227
228
229
230
231
232
233
234
235 try_init_preload();
236
237 r = ll_pthread_mutex_init(mutex, attr);
238 if (r == 0)
239
240
241
242
243
244 __get_lock(mutex);
245
246 return r;
247 }
248
249 int pthread_mutex_lock(pthread_mutex_t *mutex)
250 {
251 int r;
252
253 try_init_preload();
254
255 lock_acquire(&__get_lock(mutex)->dep_map, 0, 0, 0, 1, NULL,
256 (unsigned long)_RET_IP_);
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271 r = ll_pthread_mutex_lock(mutex);
272 if (r)
273 lock_release(&__get_lock(mutex)->dep_map, 0, (unsigned long)_RET_IP_);
274
275 return r;
276 }
277
278 int pthread_mutex_trylock(pthread_mutex_t *mutex)
279 {
280 int r;
281
282 try_init_preload();
283
284 lock_acquire(&__get_lock(mutex)->dep_map, 0, 1, 0, 1, NULL, (unsigned long)_RET_IP_);
285 r = ll_pthread_mutex_trylock(mutex);
286 if (r)
287 lock_release(&__get_lock(mutex)->dep_map, 0, (unsigned long)_RET_IP_);
288
289 return r;
290 }
291
292 int pthread_mutex_unlock(pthread_mutex_t *mutex)
293 {
294 int r;
295
296 try_init_preload();
297
298 lock_release(&__get_lock(mutex)->dep_map, 0, (unsigned long)_RET_IP_);
299
300
301
302
303
304 r = ll_pthread_mutex_unlock(mutex);
305 if (r)
306 lock_acquire(&__get_lock(mutex)->dep_map, 0, 0, 0, 1, NULL, (unsigned long)_RET_IP_);
307
308 return r;
309 }
310
311 int pthread_mutex_destroy(pthread_mutex_t *mutex)
312 {
313 try_init_preload();
314
315
316
317
318
319
320 debug_check_no_locks_freed(mutex, sizeof(*mutex));
321 __del_lock(__get_lock(mutex));
322 return ll_pthread_mutex_destroy(mutex);
323 }
324
325
326 int pthread_rwlock_init(pthread_rwlock_t *rwlock,
327 const pthread_rwlockattr_t *attr)
328 {
329 int r;
330
331 try_init_preload();
332
333 r = ll_pthread_rwlock_init(rwlock, attr);
334 if (r == 0)
335 __get_lock(rwlock);
336
337 return r;
338 }
339
340 int pthread_rwlock_destroy(pthread_rwlock_t *rwlock)
341 {
342 try_init_preload();
343
344 debug_check_no_locks_freed(rwlock, sizeof(*rwlock));
345 __del_lock(__get_lock(rwlock));
346 return ll_pthread_rwlock_destroy(rwlock);
347 }
348
349 int pthread_rwlock_rdlock(pthread_rwlock_t *rwlock)
350 {
351 int r;
352
353 init_preload();
354
355 lock_acquire(&__get_lock(rwlock)->dep_map, 0, 0, 2, 1, NULL, (unsigned long)_RET_IP_);
356 r = ll_pthread_rwlock_rdlock(rwlock);
357 if (r)
358 lock_release(&__get_lock(rwlock)->dep_map, 0, (unsigned long)_RET_IP_);
359
360 return r;
361 }
362
363 int pthread_rwlock_tryrdlock(pthread_rwlock_t *rwlock)
364 {
365 int r;
366
367 init_preload();
368
369 lock_acquire(&__get_lock(rwlock)->dep_map, 0, 1, 2, 1, NULL, (unsigned long)_RET_IP_);
370 r = ll_pthread_rwlock_tryrdlock(rwlock);
371 if (r)
372 lock_release(&__get_lock(rwlock)->dep_map, 0, (unsigned long)_RET_IP_);
373
374 return r;
375 }
376
377 int pthread_rwlock_trywrlock(pthread_rwlock_t *rwlock)
378 {
379 int r;
380
381 init_preload();
382
383 lock_acquire(&__get_lock(rwlock)->dep_map, 0, 1, 0, 1, NULL, (unsigned long)_RET_IP_);
384 r = ll_pthread_rwlock_trywrlock(rwlock);
385 if (r)
386 lock_release(&__get_lock(rwlock)->dep_map, 0, (unsigned long)_RET_IP_);
387
388 return r;
389 }
390
391 int pthread_rwlock_wrlock(pthread_rwlock_t *rwlock)
392 {
393 int r;
394
395 init_preload();
396
397 lock_acquire(&__get_lock(rwlock)->dep_map, 0, 0, 0, 1, NULL, (unsigned long)_RET_IP_);
398 r = ll_pthread_rwlock_wrlock(rwlock);
399 if (r)
400 lock_release(&__get_lock(rwlock)->dep_map, 0, (unsigned long)_RET_IP_);
401
402 return r;
403 }
404
405 int pthread_rwlock_unlock(pthread_rwlock_t *rwlock)
406 {
407 int r;
408
409 init_preload();
410
411 lock_release(&__get_lock(rwlock)->dep_map, 0, (unsigned long)_RET_IP_);
412 r = ll_pthread_rwlock_unlock(rwlock);
413 if (r)
414 lock_acquire(&__get_lock(rwlock)->dep_map, 0, 0, 0, 1, NULL, (unsigned long)_RET_IP_);
415
416 return r;
417 }
418
419 __attribute__((constructor)) static void init_preload(void)
420 {
421 if (__init_state == done)
422 return;
423
424 #ifndef __GLIBC__
425 __init_state = prepare;
426
427 ll_pthread_mutex_init = dlsym(RTLD_NEXT, "pthread_mutex_init");
428 ll_pthread_mutex_lock = dlsym(RTLD_NEXT, "pthread_mutex_lock");
429 ll_pthread_mutex_trylock = dlsym(RTLD_NEXT, "pthread_mutex_trylock");
430 ll_pthread_mutex_unlock = dlsym(RTLD_NEXT, "pthread_mutex_unlock");
431 ll_pthread_mutex_destroy = dlsym(RTLD_NEXT, "pthread_mutex_destroy");
432
433 ll_pthread_rwlock_init = dlsym(RTLD_NEXT, "pthread_rwlock_init");
434 ll_pthread_rwlock_destroy = dlsym(RTLD_NEXT, "pthread_rwlock_destroy");
435 ll_pthread_rwlock_rdlock = dlsym(RTLD_NEXT, "pthread_rwlock_rdlock");
436 ll_pthread_rwlock_tryrdlock = dlsym(RTLD_NEXT, "pthread_rwlock_tryrdlock");
437 ll_pthread_rwlock_wrlock = dlsym(RTLD_NEXT, "pthread_rwlock_wrlock");
438 ll_pthread_rwlock_trywrlock = dlsym(RTLD_NEXT, "pthread_rwlock_trywrlock");
439 ll_pthread_rwlock_unlock = dlsym(RTLD_NEXT, "pthread_rwlock_unlock");
440 #endif
441
442 __init_state = done;
443 }