1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/mutex.h>
21#include <linux/ww_mutex.h>
22#include <linux/sched.h>
23#include <linux/sched/rt.h>
24#include <linux/export.h>
25#include <linux/spinlock.h>
26#include <linux/interrupt.h>
27#include <linux/debug_locks.h>
28#include "mcs_spinlock.h"
29
30
31
32
33
34#ifdef CONFIG_DEBUG_MUTEXES
35# include "mutex-debug.h"
36# include <asm-generic/mutex-null.h>
37
38
39
40
41
42# undef __mutex_slowpath_needs_to_unlock
43# define __mutex_slowpath_needs_to_unlock() 0
44#else
45# include "mutex.h"
46# include <asm/mutex.h>
47#endif
48
49
50
51
52
53#define MUTEX_SHOW_NO_WAITER(mutex) (atomic_read(&(mutex)->count) >= 0)
54
55void
56__mutex_init(struct mutex *lock, const char *name, struct lock_class_key *key)
57{
58 atomic_set(&lock->count, 1);
59 spin_lock_init(&lock->wait_lock);
60 INIT_LIST_HEAD(&lock->wait_list);
61 mutex_clear_owner(lock);
62#ifdef CONFIG_MUTEX_SPIN_ON_OWNER
63 lock->osq = NULL;
64#endif
65
66 debug_mutex_init(lock, name, key);
67}
68
69EXPORT_SYMBOL(__mutex_init);
70
71#ifndef CONFIG_DEBUG_LOCK_ALLOC
72
73
74
75
76
77
78__visible void __sched __mutex_lock_slowpath(atomic_t *lock_count);
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101void __sched mutex_lock(struct mutex *lock)
102{
103 might_sleep();
104
105
106
107
108 __mutex_fastpath_lock(&lock->count, __mutex_lock_slowpath);
109 mutex_set_owner(lock);
110}
111
112EXPORT_SYMBOL(mutex_lock);
113#endif
114
115#ifdef CONFIG_MUTEX_SPIN_ON_OWNER
116
117
118
119
120
121
122
123
124
125
126
127static inline bool owner_running(struct mutex *lock, struct task_struct *owner)
128{
129 if (lock->owner != owner)
130 return false;
131
132
133
134
135
136
137
138 barrier();
139
140 return owner->on_cpu;
141}
142
143
144
145
146
147static noinline
148int mutex_spin_on_owner(struct mutex *lock, struct task_struct *owner)
149{
150 rcu_read_lock();
151 while (owner_running(lock, owner)) {
152 if (need_resched())
153 break;
154
155 arch_mutex_cpu_relax();
156 }
157 rcu_read_unlock();
158
159
160
161
162
163
164 return lock->owner == NULL;
165}
166
167
168
169
170static inline int mutex_can_spin_on_owner(struct mutex *lock)
171{
172 struct task_struct *owner;
173 int retval = 1;
174
175 if (need_resched())
176 return 0;
177
178 rcu_read_lock();
179 owner = ACCESS_ONCE(lock->owner);
180 if (owner)
181 retval = owner->on_cpu;
182 rcu_read_unlock();
183
184
185
186
187 return retval;
188}
189#endif
190
191__visible __used noinline
192void __sched __mutex_unlock_slowpath(atomic_t *lock_count);
193
194
195
196
197
198
199
200
201
202
203
204
205void __sched mutex_unlock(struct mutex *lock)
206{
207
208
209
210
211#ifndef CONFIG_DEBUG_MUTEXES
212
213
214
215
216
217 mutex_clear_owner(lock);
218#endif
219 __mutex_fastpath_unlock(&lock->count, __mutex_unlock_slowpath);
220}
221
222EXPORT_SYMBOL(mutex_unlock);
223
224
225
226
227
228
229
230
231
232
233
234
235void __sched ww_mutex_unlock(struct ww_mutex *lock)
236{
237
238
239
240
241 if (lock->ctx) {
242#ifdef CONFIG_DEBUG_MUTEXES
243 DEBUG_LOCKS_WARN_ON(!lock->ctx->acquired);
244#endif
245 if (lock->ctx->acquired > 0)
246 lock->ctx->acquired--;
247 lock->ctx = NULL;
248 }
249
250#ifndef CONFIG_DEBUG_MUTEXES
251
252
253
254
255
256 mutex_clear_owner(&lock->base);
257#endif
258 __mutex_fastpath_unlock(&lock->base.count, __mutex_unlock_slowpath);
259}
260EXPORT_SYMBOL(ww_mutex_unlock);
261
262static inline int __sched
263__mutex_lock_check_stamp(struct mutex *lock, struct ww_acquire_ctx *ctx)
264{
265 struct ww_mutex *ww = container_of(lock, struct ww_mutex, base);
266 struct ww_acquire_ctx *hold_ctx = ACCESS_ONCE(ww->ctx);
267
268 if (!hold_ctx)
269 return 0;
270
271 if (unlikely(ctx == hold_ctx))
272 return -EALREADY;
273
274 if (ctx->stamp - hold_ctx->stamp <= LONG_MAX &&
275 (ctx->stamp != hold_ctx->stamp || ctx > hold_ctx)) {
276#ifdef CONFIG_DEBUG_MUTEXES
277 DEBUG_LOCKS_WARN_ON(ctx->contending_lock);
278 ctx->contending_lock = ww;
279#endif
280 return -EDEADLK;
281 }
282
283 return 0;
284}
285
286static __always_inline void ww_mutex_lock_acquired(struct ww_mutex *ww,
287 struct ww_acquire_ctx *ww_ctx)
288{
289#ifdef CONFIG_DEBUG_MUTEXES
290
291
292
293
294
295
296 DEBUG_LOCKS_WARN_ON(ww->ctx);
297
298
299
300
301 DEBUG_LOCKS_WARN_ON(ww_ctx->done_acquire);
302
303 if (ww_ctx->contending_lock) {
304
305
306
307
308 DEBUG_LOCKS_WARN_ON(ww_ctx->contending_lock != ww);
309
310
311
312
313
314 DEBUG_LOCKS_WARN_ON(ww_ctx->acquired > 0);
315 ww_ctx->contending_lock = NULL;
316 }
317
318
319
320
321 DEBUG_LOCKS_WARN_ON(ww_ctx->ww_class != ww->ww_class);
322#endif
323 ww_ctx->acquired++;
324}
325
326
327
328
329
330
331
332
333static __always_inline void
334ww_mutex_set_context_fastpath(struct ww_mutex *lock,
335 struct ww_acquire_ctx *ctx)
336{
337 unsigned long flags;
338 struct mutex_waiter *cur;
339
340 ww_mutex_lock_acquired(lock, ctx);
341
342 lock->ctx = ctx;
343
344
345
346
347
348
349
350
351 smp_mb();
352
353
354
355
356 if (likely(atomic_read(&lock->base.count) == 0))
357 return;
358
359
360
361
362
363 spin_lock_mutex(&lock->base.wait_lock, flags);
364 list_for_each_entry(cur, &lock->base.wait_list, list) {
365 debug_mutex_wake_waiter(&lock->base, cur);
366 wake_up_process(cur->task);
367 }
368 spin_unlock_mutex(&lock->base.wait_lock, flags);
369}
370
371
372
373
374static __always_inline int __sched
375__mutex_lock_common(struct mutex *lock, long state, unsigned int subclass,
376 struct lockdep_map *nest_lock, unsigned long ip,
377 struct ww_acquire_ctx *ww_ctx, const bool use_ww_ctx)
378{
379 struct task_struct *task = current;
380 struct mutex_waiter waiter;
381 unsigned long flags;
382 int ret;
383
384 preempt_disable();
385 mutex_acquire_nest(&lock->dep_map, subclass, 0, nest_lock, ip);
386
387#ifdef CONFIG_MUTEX_SPIN_ON_OWNER
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410 if (!mutex_can_spin_on_owner(lock))
411 goto slowpath;
412
413 if (!osq_lock(&lock->osq))
414 goto slowpath;
415
416 for (;;) {
417 struct task_struct *owner;
418
419 if (use_ww_ctx && ww_ctx->acquired > 0) {
420 struct ww_mutex *ww;
421
422 ww = container_of(lock, struct ww_mutex, base);
423
424
425
426
427
428
429
430
431 if (ACCESS_ONCE(ww->ctx))
432 break;
433 }
434
435
436
437
438
439 owner = ACCESS_ONCE(lock->owner);
440 if (owner && !mutex_spin_on_owner(lock, owner))
441 break;
442
443 if ((atomic_read(&lock->count) == 1) &&
444 (atomic_cmpxchg(&lock->count, 1, 0) == 1)) {
445 lock_acquired(&lock->dep_map, ip);
446 if (use_ww_ctx) {
447 struct ww_mutex *ww;
448 ww = container_of(lock, struct ww_mutex, base);
449
450 ww_mutex_set_context_fastpath(ww, ww_ctx);
451 }
452
453 mutex_set_owner(lock);
454 osq_unlock(&lock->osq);
455 preempt_enable();
456 return 0;
457 }
458
459
460
461
462
463
464
465 if (!owner && (need_resched() || rt_task(task)))
466 break;
467
468
469
470
471
472
473
474 arch_mutex_cpu_relax();
475 }
476 osq_unlock(&lock->osq);
477slowpath:
478
479
480
481
482
483 if (need_resched())
484 schedule_preempt_disabled();
485#endif
486 spin_lock_mutex(&lock->wait_lock, flags);
487
488
489 if (MUTEX_SHOW_NO_WAITER(lock) && (atomic_xchg(&lock->count, 0) == 1))
490 goto skip_wait;
491
492 debug_mutex_lock_common(lock, &waiter);
493 debug_mutex_add_waiter(lock, &waiter, task_thread_info(task));
494
495
496 list_add_tail(&waiter.list, &lock->wait_list);
497 waiter.task = task;
498
499 lock_contended(&lock->dep_map, ip);
500
501 for (;;) {
502
503
504
505
506
507
508
509
510
511 if (MUTEX_SHOW_NO_WAITER(lock) &&
512 (atomic_xchg(&lock->count, -1) == 1))
513 break;
514
515
516
517
518
519 if (unlikely(signal_pending_state(state, task))) {
520 ret = -EINTR;
521 goto err;
522 }
523
524 if (use_ww_ctx && ww_ctx->acquired > 0) {
525 ret = __mutex_lock_check_stamp(lock, ww_ctx);
526 if (ret)
527 goto err;
528 }
529
530 __set_task_state(task, state);
531
532
533 spin_unlock_mutex(&lock->wait_lock, flags);
534 schedule_preempt_disabled();
535 spin_lock_mutex(&lock->wait_lock, flags);
536 }
537 mutex_remove_waiter(lock, &waiter, current_thread_info());
538
539 if (likely(list_empty(&lock->wait_list)))
540 atomic_set(&lock->count, 0);
541 debug_mutex_free_waiter(&waiter);
542
543skip_wait:
544
545 lock_acquired(&lock->dep_map, ip);
546 mutex_set_owner(lock);
547
548 if (use_ww_ctx) {
549 struct ww_mutex *ww = container_of(lock, struct ww_mutex, base);
550 struct mutex_waiter *cur;
551
552
553
554
555
556 ww_mutex_lock_acquired(ww, ww_ctx);
557 ww->ctx = ww_ctx;
558
559
560
561
562
563 list_for_each_entry(cur, &lock->wait_list, list) {
564 debug_mutex_wake_waiter(lock, cur);
565 wake_up_process(cur->task);
566 }
567 }
568
569 spin_unlock_mutex(&lock->wait_lock, flags);
570 preempt_enable();
571 return 0;
572
573err:
574 mutex_remove_waiter(lock, &waiter, task_thread_info(task));
575 spin_unlock_mutex(&lock->wait_lock, flags);
576 debug_mutex_free_waiter(&waiter);
577 mutex_release(&lock->dep_map, 1, ip);
578 preempt_enable();
579 return ret;
580}
581
582#ifdef CONFIG_DEBUG_LOCK_ALLOC
583void __sched
584mutex_lock_nested(struct mutex *lock, unsigned int subclass)
585{
586 might_sleep();
587 __mutex_lock_common(lock, TASK_UNINTERRUPTIBLE,
588 subclass, NULL, _RET_IP_, NULL, 0);
589}
590
591EXPORT_SYMBOL_GPL(mutex_lock_nested);
592
593void __sched
594_mutex_lock_nest_lock(struct mutex *lock, struct lockdep_map *nest)
595{
596 might_sleep();
597 __mutex_lock_common(lock, TASK_UNINTERRUPTIBLE,
598 0, nest, _RET_IP_, NULL, 0);
599}
600
601EXPORT_SYMBOL_GPL(_mutex_lock_nest_lock);
602
603int __sched
604mutex_lock_killable_nested(struct mutex *lock, unsigned int subclass)
605{
606 might_sleep();
607 return __mutex_lock_common(lock, TASK_KILLABLE,
608 subclass, NULL, _RET_IP_, NULL, 0);
609}
610EXPORT_SYMBOL_GPL(mutex_lock_killable_nested);
611
612int __sched
613mutex_lock_interruptible_nested(struct mutex *lock, unsigned int subclass)
614{
615 might_sleep();
616 return __mutex_lock_common(lock, TASK_INTERRUPTIBLE,
617 subclass, NULL, _RET_IP_, NULL, 0);
618}
619
620EXPORT_SYMBOL_GPL(mutex_lock_interruptible_nested);
621
622static inline int
623ww_mutex_deadlock_injection(struct ww_mutex *lock, struct ww_acquire_ctx *ctx)
624{
625#ifdef CONFIG_DEBUG_WW_MUTEX_SLOWPATH
626 unsigned tmp;
627
628 if (ctx->deadlock_inject_countdown-- == 0) {
629 tmp = ctx->deadlock_inject_interval;
630 if (tmp > UINT_MAX/4)
631 tmp = UINT_MAX;
632 else
633 tmp = tmp*2 + tmp + tmp/2;
634
635 ctx->deadlock_inject_interval = tmp;
636 ctx->deadlock_inject_countdown = tmp;
637 ctx->contending_lock = lock;
638
639 ww_mutex_unlock(lock);
640
641 return -EDEADLK;
642 }
643#endif
644
645 return 0;
646}
647
648int __sched
649__ww_mutex_lock(struct ww_mutex *lock, struct ww_acquire_ctx *ctx)
650{
651 int ret;
652
653 might_sleep();
654 ret = __mutex_lock_common(&lock->base, TASK_UNINTERRUPTIBLE,
655 0, &ctx->dep_map, _RET_IP_, ctx, 1);
656 if (!ret && ctx->acquired > 1)
657 return ww_mutex_deadlock_injection(lock, ctx);
658
659 return ret;
660}
661EXPORT_SYMBOL_GPL(__ww_mutex_lock);
662
663int __sched
664__ww_mutex_lock_interruptible(struct ww_mutex *lock, struct ww_acquire_ctx *ctx)
665{
666 int ret;
667
668 might_sleep();
669 ret = __mutex_lock_common(&lock->base, TASK_INTERRUPTIBLE,
670 0, &ctx->dep_map, _RET_IP_, ctx, 1);
671
672 if (!ret && ctx->acquired > 1)
673 return ww_mutex_deadlock_injection(lock, ctx);
674
675 return ret;
676}
677EXPORT_SYMBOL_GPL(__ww_mutex_lock_interruptible);
678
679#endif
680
681
682
683
684static inline void
685__mutex_unlock_common_slowpath(atomic_t *lock_count, int nested)
686{
687 struct mutex *lock = container_of(lock_count, struct mutex, count);
688 unsigned long flags;
689
690
691
692
693
694
695 if (__mutex_slowpath_needs_to_unlock())
696 atomic_set(&lock->count, 1);
697
698 spin_lock_mutex(&lock->wait_lock, flags);
699 mutex_release(&lock->dep_map, nested, _RET_IP_);
700 debug_mutex_unlock(lock);
701
702 if (!list_empty(&lock->wait_list)) {
703
704 struct mutex_waiter *waiter =
705 list_entry(lock->wait_list.next,
706 struct mutex_waiter, list);
707
708 debug_mutex_wake_waiter(lock, waiter);
709
710 wake_up_process(waiter->task);
711 }
712
713 spin_unlock_mutex(&lock->wait_lock, flags);
714}
715
716
717
718
719__visible void
720__mutex_unlock_slowpath(atomic_t *lock_count)
721{
722 __mutex_unlock_common_slowpath(lock_count, 1);
723}
724
725#ifndef CONFIG_DEBUG_LOCK_ALLOC
726
727
728
729
730static noinline int __sched
731__mutex_lock_killable_slowpath(struct mutex *lock);
732
733static noinline int __sched
734__mutex_lock_interruptible_slowpath(struct mutex *lock);
735
736
737
738
739
740
741
742
743
744
745
746
747int __sched mutex_lock_interruptible(struct mutex *lock)
748{
749 int ret;
750
751 might_sleep();
752 ret = __mutex_fastpath_lock_retval(&lock->count);
753 if (likely(!ret)) {
754 mutex_set_owner(lock);
755 return 0;
756 } else
757 return __mutex_lock_interruptible_slowpath(lock);
758}
759
760EXPORT_SYMBOL(mutex_lock_interruptible);
761
762int __sched mutex_lock_killable(struct mutex *lock)
763{
764 int ret;
765
766 might_sleep();
767 ret = __mutex_fastpath_lock_retval(&lock->count);
768 if (likely(!ret)) {
769 mutex_set_owner(lock);
770 return 0;
771 } else
772 return __mutex_lock_killable_slowpath(lock);
773}
774EXPORT_SYMBOL(mutex_lock_killable);
775
776__visible void __sched
777__mutex_lock_slowpath(atomic_t *lock_count)
778{
779 struct mutex *lock = container_of(lock_count, struct mutex, count);
780
781 __mutex_lock_common(lock, TASK_UNINTERRUPTIBLE, 0,
782 NULL, _RET_IP_, NULL, 0);
783}
784
785static noinline int __sched
786__mutex_lock_killable_slowpath(struct mutex *lock)
787{
788 return __mutex_lock_common(lock, TASK_KILLABLE, 0,
789 NULL, _RET_IP_, NULL, 0);
790}
791
792static noinline int __sched
793__mutex_lock_interruptible_slowpath(struct mutex *lock)
794{
795 return __mutex_lock_common(lock, TASK_INTERRUPTIBLE, 0,
796 NULL, _RET_IP_, NULL, 0);
797}
798
799static noinline int __sched
800__ww_mutex_lock_slowpath(struct ww_mutex *lock, struct ww_acquire_ctx *ctx)
801{
802 return __mutex_lock_common(&lock->base, TASK_UNINTERRUPTIBLE, 0,
803 NULL, _RET_IP_, ctx, 1);
804}
805
806static noinline int __sched
807__ww_mutex_lock_interruptible_slowpath(struct ww_mutex *lock,
808 struct ww_acquire_ctx *ctx)
809{
810 return __mutex_lock_common(&lock->base, TASK_INTERRUPTIBLE, 0,
811 NULL, _RET_IP_, ctx, 1);
812}
813
814#endif
815
816
817
818
819
820static inline int __mutex_trylock_slowpath(atomic_t *lock_count)
821{
822 struct mutex *lock = container_of(lock_count, struct mutex, count);
823 unsigned long flags;
824 int prev;
825
826 spin_lock_mutex(&lock->wait_lock, flags);
827
828 prev = atomic_xchg(&lock->count, -1);
829 if (likely(prev == 1)) {
830 mutex_set_owner(lock);
831 mutex_acquire(&lock->dep_map, 0, 1, _RET_IP_);
832 }
833
834
835 if (likely(list_empty(&lock->wait_list)))
836 atomic_set(&lock->count, 0);
837
838 spin_unlock_mutex(&lock->wait_lock, flags);
839
840 return prev == 1;
841}
842
843
844
845
846
847
848
849
850
851
852
853
854
855
856
857int __sched mutex_trylock(struct mutex *lock)
858{
859 int ret;
860
861 ret = __mutex_fastpath_trylock(&lock->count, __mutex_trylock_slowpath);
862 if (ret)
863 mutex_set_owner(lock);
864
865 return ret;
866}
867EXPORT_SYMBOL(mutex_trylock);
868
869#ifndef CONFIG_DEBUG_LOCK_ALLOC
870int __sched
871__ww_mutex_lock(struct ww_mutex *lock, struct ww_acquire_ctx *ctx)
872{
873 int ret;
874
875 might_sleep();
876
877 ret = __mutex_fastpath_lock_retval(&lock->base.count);
878
879 if (likely(!ret)) {
880 ww_mutex_set_context_fastpath(lock, ctx);
881 mutex_set_owner(&lock->base);
882 } else
883 ret = __ww_mutex_lock_slowpath(lock, ctx);
884 return ret;
885}
886EXPORT_SYMBOL(__ww_mutex_lock);
887
888int __sched
889__ww_mutex_lock_interruptible(struct ww_mutex *lock, struct ww_acquire_ctx *ctx)
890{
891 int ret;
892
893 might_sleep();
894
895 ret = __mutex_fastpath_lock_retval(&lock->base.count);
896
897 if (likely(!ret)) {
898 ww_mutex_set_context_fastpath(lock, ctx);
899 mutex_set_owner(&lock->base);
900 } else
901 ret = __ww_mutex_lock_interruptible_slowpath(lock, ctx);
902 return ret;
903}
904EXPORT_SYMBOL(__ww_mutex_lock_interruptible);
905
906#endif
907
908
909
910
911
912
913
914
915int atomic_dec_and_mutex_lock(atomic_t *cnt, struct mutex *lock)
916{
917
918 if (atomic_add_unless(cnt, -1, 1))
919 return 0;
920
921 mutex_lock(lock);
922 if (!atomic_dec_and_test(cnt)) {
923
924 mutex_unlock(lock);
925 return 0;
926 }
927
928 return 1;
929}
930EXPORT_SYMBOL(atomic_dec_and_mutex_lock);
931