Home | History | Annotate | Line # | Download | only in kern
kern_mutex.c revision 1.98
      1  1.98   thorpej /*	$NetBSD: kern_mutex.c,v 1.98 2021/08/25 04:13:42 thorpej Exp $	*/
      2   1.2        ad 
      3   1.2        ad /*-
      4  1.92        ad  * Copyright (c) 2002, 2006, 2007, 2008, 2019 The NetBSD Foundation, Inc.
      5   1.2        ad  * All rights reserved.
      6   1.2        ad  *
      7   1.2        ad  * This code is derived from software contributed to The NetBSD Foundation
      8   1.2        ad  * by Jason R. Thorpe and Andrew Doran.
      9   1.2        ad  *
     10   1.2        ad  * Redistribution and use in source and binary forms, with or without
     11   1.2        ad  * modification, are permitted provided that the following conditions
     12   1.2        ad  * are met:
     13   1.2        ad  * 1. Redistributions of source code must retain the above copyright
     14   1.2        ad  *    notice, this list of conditions and the following disclaimer.
     15   1.2        ad  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.2        ad  *    notice, this list of conditions and the following disclaimer in the
     17   1.2        ad  *    documentation and/or other materials provided with the distribution.
     18   1.2        ad  *
     19   1.2        ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.2        ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.2        ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.2        ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.2        ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.2        ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.2        ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.2        ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.2        ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.2        ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.2        ad  * POSSIBILITY OF SUCH DAMAGE.
     30   1.2        ad  */
     31   1.2        ad 
     32   1.2        ad /*
     33   1.2        ad  * Kernel mutex implementation, modeled after those found in Solaris,
     34   1.2        ad  * a description of which can be found in:
     35   1.2        ad  *
     36   1.2        ad  *	Solaris Internals: Core Kernel Architecture, Jim Mauro and
     37   1.2        ad  *	    Richard McDougall.
     38   1.2        ad  */
     39   1.2        ad 
     40   1.2        ad #define	__MUTEX_PRIVATE
     41   1.2        ad 
     42   1.2        ad #include <sys/cdefs.h>
     43  1.98   thorpej __KERNEL_RCSID(0, "$NetBSD: kern_mutex.c,v 1.98 2021/08/25 04:13:42 thorpej Exp $");
     44   1.2        ad 
     45   1.2        ad #include <sys/param.h>
     46  1.46     pooka #include <sys/atomic.h>
     47   1.2        ad #include <sys/proc.h>
     48   1.2        ad #include <sys/mutex.h>
     49   1.2        ad #include <sys/sched.h>
     50   1.2        ad #include <sys/sleepq.h>
     51   1.2        ad #include <sys/systm.h>
     52   1.2        ad #include <sys/lockdebug.h>
     53   1.2        ad #include <sys/kernel.h>
     54  1.24        ad #include <sys/intr.h>
     55  1.29   xtraeme #include <sys/lock.h>
     56  1.50     rmind #include <sys/types.h>
     57  1.72     ozaki #include <sys/cpu.h>
     58  1.74     ozaki #include <sys/pserialize.h>
     59   1.2        ad 
     60   1.2        ad #include <dev/lockstat.h>
     61   1.2        ad 
     62  1.28        ad #include <machine/lock.h>
     63  1.28        ad 
     64   1.2        ad /*
     65   1.2        ad  * When not running a debug kernel, spin mutexes are not much
     66   1.2        ad  * more than an splraiseipl() and splx() pair.
     67   1.2        ad  */
     68   1.2        ad 
     69   1.2        ad #if defined(DIAGNOSTIC) || defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
     70   1.2        ad #define	FULL
     71   1.2        ad #endif
     72   1.2        ad 
     73   1.2        ad /*
     74   1.2        ad  * Debugging support.
     75   1.2        ad  */
     76   1.2        ad 
     77   1.2        ad #define	MUTEX_WANTLOCK(mtx)					\
     78  1.23      yamt     LOCKDEBUG_WANTLOCK(MUTEX_DEBUG_P(mtx), (mtx),		\
     79  1.54   mlelstv         (uintptr_t)__builtin_return_address(0), 0)
     80  1.65  pgoyette #define	MUTEX_TESTLOCK(mtx)					\
     81  1.65  pgoyette     LOCKDEBUG_WANTLOCK(MUTEX_DEBUG_P(mtx), (mtx),		\
     82  1.65  pgoyette         (uintptr_t)__builtin_return_address(0), -1)
     83   1.2        ad #define	MUTEX_LOCKED(mtx)					\
     84  1.42        ad     LOCKDEBUG_LOCKED(MUTEX_DEBUG_P(mtx), (mtx), NULL,		\
     85   1.2        ad         (uintptr_t)__builtin_return_address(0), 0)
     86   1.2        ad #define	MUTEX_UNLOCKED(mtx)					\
     87  1.23      yamt     LOCKDEBUG_UNLOCKED(MUTEX_DEBUG_P(mtx), (mtx),		\
     88   1.2        ad         (uintptr_t)__builtin_return_address(0), 0)
     89   1.2        ad #define	MUTEX_ABORT(mtx, msg)					\
     90  1.64  christos     mutex_abort(__func__, __LINE__, mtx, msg)
     91   1.2        ad 
     92   1.2        ad #if defined(LOCKDEBUG)
     93   1.2        ad 
     94   1.2        ad #define	MUTEX_DASSERT(mtx, cond)				\
     95   1.2        ad do {								\
     96  1.75     ozaki 	if (__predict_false(!(cond)))				\
     97   1.2        ad 		MUTEX_ABORT(mtx, "assertion failed: " #cond);	\
     98  1.76     skrll } while (/* CONSTCOND */ 0)
     99   1.2        ad 
    100   1.2        ad #else	/* LOCKDEBUG */
    101   1.2        ad 
    102   1.2        ad #define	MUTEX_DASSERT(mtx, cond)	/* nothing */
    103   1.2        ad 
    104   1.2        ad #endif /* LOCKDEBUG */
    105   1.2        ad 
    106   1.2        ad #if defined(DIAGNOSTIC)
    107   1.2        ad 
    108   1.2        ad #define	MUTEX_ASSERT(mtx, cond)					\
    109   1.2        ad do {								\
    110  1.75     ozaki 	if (__predict_false(!(cond)))				\
    111   1.2        ad 		MUTEX_ABORT(mtx, "assertion failed: " #cond);	\
    112   1.2        ad } while (/* CONSTCOND */ 0)
    113   1.2        ad 
    114   1.2        ad #else	/* DIAGNOSTIC */
    115   1.2        ad 
    116   1.2        ad #define	MUTEX_ASSERT(mtx, cond)	/* nothing */
    117   1.2        ad 
    118   1.2        ad #endif	/* DIAGNOSTIC */
    119   1.2        ad 
    120   1.2        ad /*
    121  1.60      matt  * Some architectures can't use __cpu_simple_lock as is so allow a way
    122  1.60      matt  * for them to use an alternate definition.
    123  1.60      matt  */
    124  1.60      matt #ifndef MUTEX_SPINBIT_LOCK_INIT
    125  1.60      matt #define MUTEX_SPINBIT_LOCK_INIT(mtx)	__cpu_simple_lock_init(&(mtx)->mtx_lock)
    126  1.60      matt #endif
    127  1.60      matt #ifndef MUTEX_SPINBIT_LOCKED_P
    128  1.60      matt #define MUTEX_SPINBIT_LOCKED_P(mtx)	__SIMPLELOCK_LOCKED_P(&(mtx)->mtx_lock)
    129  1.60      matt #endif
    130  1.60      matt #ifndef MUTEX_SPINBIT_LOCK_TRY
    131  1.60      matt #define MUTEX_SPINBIT_LOCK_TRY(mtx)	__cpu_simple_lock_try(&(mtx)->mtx_lock)
    132  1.60      matt #endif
    133  1.60      matt #ifndef MUTEX_SPINBIT_LOCK_UNLOCK
    134  1.60      matt #define MUTEX_SPINBIT_LOCK_UNLOCK(mtx)	__cpu_simple_unlock(&(mtx)->mtx_lock)
    135  1.60      matt #endif
    136  1.60      matt 
    137  1.60      matt #ifndef MUTEX_INITIALIZE_SPIN_IPL
    138  1.60      matt #define MUTEX_INITIALIZE_SPIN_IPL(mtx, ipl) \
    139  1.60      matt 					((mtx)->mtx_ipl = makeiplcookie((ipl)))
    140  1.60      matt #endif
    141  1.60      matt 
    142  1.60      matt /*
    143   1.2        ad  * Spin mutex SPL save / restore.
    144   1.2        ad  */
    145   1.2        ad 
    146   1.2        ad #define	MUTEX_SPIN_SPLRAISE(mtx)					\
    147   1.2        ad do {									\
    148  1.36        ad 	struct cpu_info *x__ci;						\
    149   1.2        ad 	int x__cnt, s;							\
    150  1.60      matt 	s = splraiseipl(MUTEX_SPIN_IPL(mtx));				\
    151  1.36        ad 	x__ci = curcpu();						\
    152   1.2        ad 	x__cnt = x__ci->ci_mtx_count--;					\
    153  1.37        ad 	__insn_barrier();						\
    154  1.51     rmind 	if (x__cnt == 0)						\
    155   1.2        ad 		x__ci->ci_mtx_oldspl = (s);				\
    156   1.2        ad } while (/* CONSTCOND */ 0)
    157   1.2        ad 
    158   1.2        ad #define	MUTEX_SPIN_SPLRESTORE(mtx)					\
    159   1.2        ad do {									\
    160   1.2        ad 	struct cpu_info *x__ci = curcpu();				\
    161   1.2        ad 	int s = x__ci->ci_mtx_oldspl;					\
    162   1.2        ad 	__insn_barrier();						\
    163  1.96       rin 	if (++(x__ci->ci_mtx_count) == 0)				\
    164   1.2        ad 		splx(s);						\
    165   1.2        ad } while (/* CONSTCOND */ 0)
    166   1.2        ad 
    167   1.2        ad /*
    168  1.80        ad  * Memory barriers.
    169  1.80        ad  */
    170  1.80        ad #ifdef __HAVE_ATOMIC_AS_MEMBAR
    171  1.80        ad #define	MUTEX_MEMBAR_ENTER()
    172  1.80        ad #define	MUTEX_MEMBAR_EXIT()
    173  1.80        ad #else
    174  1.80        ad #define	MUTEX_MEMBAR_ENTER()		membar_enter()
    175  1.80        ad #define	MUTEX_MEMBAR_EXIT()		membar_exit()
    176  1.80        ad #endif
    177  1.80        ad 
    178  1.80        ad /*
    179   1.2        ad  * For architectures that provide 'simple' mutexes: they provide a
    180   1.2        ad  * CAS function that is either MP-safe, or does not need to be MP
    181   1.2        ad  * safe.  Adaptive mutexes on these architectures do not require an
    182   1.2        ad  * additional interlock.
    183   1.2        ad  */
    184   1.2        ad 
    185   1.2        ad #ifdef __HAVE_SIMPLE_MUTEXES
    186   1.2        ad 
    187   1.2        ad #define	MUTEX_OWNER(owner)						\
    188   1.2        ad 	(owner & MUTEX_THREAD)
    189  1.88        ad #define	MUTEX_HAS_WAITERS(mtx)						\
    190  1.88        ad 	(((int)(mtx)->mtx_owner & MUTEX_BIT_WAITERS) != 0)
    191   1.2        ad 
    192  1.23      yamt #define	MUTEX_INITIALIZE_ADAPTIVE(mtx, dodebug)				\
    193  1.76     skrll do {									\
    194  1.49     skrll 	if (!dodebug)							\
    195  1.49     skrll 		(mtx)->mtx_owner |= MUTEX_BIT_NODEBUG;			\
    196  1.76     skrll } while (/* CONSTCOND */ 0)
    197   1.2        ad 
    198  1.23      yamt #define	MUTEX_INITIALIZE_SPIN(mtx, dodebug, ipl)			\
    199   1.2        ad do {									\
    200   1.2        ad 	(mtx)->mtx_owner = MUTEX_BIT_SPIN;				\
    201  1.49     skrll 	if (!dodebug)							\
    202  1.49     skrll 		(mtx)->mtx_owner |= MUTEX_BIT_NODEBUG;			\
    203  1.60      matt 	MUTEX_INITIALIZE_SPIN_IPL((mtx), (ipl));			\
    204  1.60      matt 	MUTEX_SPINBIT_LOCK_INIT((mtx));					\
    205   1.2        ad } while (/* CONSTCOND */ 0)
    206   1.2        ad 
    207   1.2        ad #define	MUTEX_DESTROY(mtx)						\
    208   1.2        ad do {									\
    209   1.2        ad 	(mtx)->mtx_owner = MUTEX_THREAD;				\
    210  1.76     skrll } while (/* CONSTCOND */ 0)
    211   1.2        ad 
    212  1.87        ad #define	MUTEX_SPIN_P(owner)		\
    213  1.87        ad     (((owner) & MUTEX_BIT_SPIN) != 0)
    214  1.87        ad #define	MUTEX_ADAPTIVE_P(owner)		\
    215  1.87        ad     (((owner) & MUTEX_BIT_SPIN) == 0)
    216   1.2        ad 
    217  1.98   thorpej #ifndef MUTEX_CAS
    218  1.98   thorpej #define	MUTEX_CAS(p, o, n)		\
    219  1.98   thorpej 	(atomic_cas_ulong((volatile unsigned long *)(p), (o), (n)) == (o))
    220  1.98   thorpej #endif /* MUTEX_CAS */
    221  1.98   thorpej 
    222  1.49     skrll #define	MUTEX_DEBUG_P(mtx)	(((mtx)->mtx_owner & MUTEX_BIT_NODEBUG) == 0)
    223  1.23      yamt #if defined(LOCKDEBUG)
    224  1.49     skrll #define	MUTEX_OWNED(owner)		(((owner) & ~MUTEX_BIT_NODEBUG) != 0)
    225  1.59      matt #define	MUTEX_INHERITDEBUG(n, o)	(n) |= (o) & MUTEX_BIT_NODEBUG
    226  1.23      yamt #else /* defined(LOCKDEBUG) */
    227  1.23      yamt #define	MUTEX_OWNED(owner)		((owner) != 0)
    228  1.59      matt #define	MUTEX_INHERITDEBUG(n, o)	/* nothing */
    229  1.23      yamt #endif /* defined(LOCKDEBUG) */
    230   1.2        ad 
    231   1.2        ad static inline int
    232   1.2        ad MUTEX_ACQUIRE(kmutex_t *mtx, uintptr_t curthread)
    233   1.2        ad {
    234   1.2        ad 	int rv;
    235  1.59      matt 	uintptr_t oldown = 0;
    236  1.59      matt 	uintptr_t newown = curthread;
    237  1.23      yamt 
    238  1.59      matt 	MUTEX_INHERITDEBUG(oldown, mtx->mtx_owner);
    239  1.59      matt 	MUTEX_INHERITDEBUG(newown, oldown);
    240  1.59      matt 	rv = MUTEX_CAS(&mtx->mtx_owner, oldown, newown);
    241  1.80        ad 	MUTEX_MEMBAR_ENTER();
    242   1.2        ad 	return rv;
    243   1.2        ad }
    244   1.2        ad 
    245   1.2        ad static inline int
    246   1.2        ad MUTEX_SET_WAITERS(kmutex_t *mtx, uintptr_t owner)
    247   1.2        ad {
    248   1.2        ad 	int rv;
    249   1.2        ad 	rv = MUTEX_CAS(&mtx->mtx_owner, owner, owner | MUTEX_BIT_WAITERS);
    250  1.80        ad 	MUTEX_MEMBAR_ENTER();
    251   1.2        ad 	return rv;
    252   1.2        ad }
    253   1.2        ad 
    254   1.2        ad static inline void
    255   1.2        ad MUTEX_RELEASE(kmutex_t *mtx)
    256   1.2        ad {
    257  1.59      matt 	uintptr_t newown;
    258  1.23      yamt 
    259  1.80        ad 	MUTEX_MEMBAR_EXIT();
    260  1.59      matt 	newown = 0;
    261  1.59      matt 	MUTEX_INHERITDEBUG(newown, mtx->mtx_owner);
    262  1.59      matt 	mtx->mtx_owner = newown;
    263   1.2        ad }
    264   1.2        ad #endif	/* __HAVE_SIMPLE_MUTEXES */
    265   1.2        ad 
    266   1.2        ad /*
    267   1.2        ad  * Patch in stubs via strong alias where they are not available.
    268   1.2        ad  */
    269   1.2        ad 
    270   1.2        ad #if defined(LOCKDEBUG)
    271   1.2        ad #undef	__HAVE_MUTEX_STUBS
    272   1.2        ad #undef	__HAVE_SPIN_MUTEX_STUBS
    273   1.2        ad #endif
    274   1.2        ad 
    275   1.2        ad #ifndef __HAVE_MUTEX_STUBS
    276   1.8     itohy __strong_alias(mutex_enter,mutex_vector_enter);
    277   1.8     itohy __strong_alias(mutex_exit,mutex_vector_exit);
    278   1.2        ad #endif
    279   1.2        ad 
    280   1.2        ad #ifndef __HAVE_SPIN_MUTEX_STUBS
    281   1.8     itohy __strong_alias(mutex_spin_enter,mutex_vector_enter);
    282   1.8     itohy __strong_alias(mutex_spin_exit,mutex_vector_exit);
    283   1.2        ad #endif
    284   1.2        ad 
    285  1.67  christos static void	mutex_abort(const char *, size_t, const kmutex_t *,
    286  1.67  christos     const char *);
    287  1.79     ozaki static void	mutex_dump(const volatile void *, lockop_printer_t);
    288   1.2        ad 
    289   1.2        ad lockops_t mutex_spin_lockops = {
    290  1.68     ozaki 	.lo_name = "Mutex",
    291  1.68     ozaki 	.lo_type = LOCKOPS_SPIN,
    292  1.68     ozaki 	.lo_dump = mutex_dump,
    293   1.2        ad };
    294   1.2        ad 
    295   1.2        ad lockops_t mutex_adaptive_lockops = {
    296  1.68     ozaki 	.lo_name = "Mutex",
    297  1.68     ozaki 	.lo_type = LOCKOPS_SLEEP,
    298  1.68     ozaki 	.lo_dump = mutex_dump,
    299   1.2        ad };
    300   1.2        ad 
    301   1.5      yamt syncobj_t mutex_syncobj = {
    302  1.70     ozaki 	.sobj_flag	= SOBJ_SLEEPQ_SORTED,
    303  1.70     ozaki 	.sobj_unsleep	= turnstile_unsleep,
    304  1.70     ozaki 	.sobj_changepri	= turnstile_changepri,
    305  1.70     ozaki 	.sobj_lendpri	= sleepq_lendpri,
    306  1.70     ozaki 	.sobj_owner	= (void *)mutex_owner,
    307   1.5      yamt };
    308   1.5      yamt 
    309   1.2        ad /*
    310   1.2        ad  * mutex_dump:
    311   1.2        ad  *
    312   1.2        ad  *	Dump the contents of a mutex structure.
    313   1.2        ad  */
    314  1.78     ozaki static void
    315  1.79     ozaki mutex_dump(const volatile void *cookie, lockop_printer_t pr)
    316   1.2        ad {
    317  1.67  christos 	const volatile kmutex_t *mtx = cookie;
    318  1.87        ad 	uintptr_t owner = mtx->mtx_owner;
    319   1.2        ad 
    320  1.79     ozaki 	pr("owner field  : %#018lx wait/spin: %16d/%d\n",
    321  1.88        ad 	    (long)MUTEX_OWNER(owner), MUTEX_HAS_WAITERS(mtx),
    322  1.87        ad 	    MUTEX_SPIN_P(owner));
    323   1.2        ad }
    324   1.2        ad 
    325   1.2        ad /*
    326   1.2        ad  * mutex_abort:
    327   1.2        ad  *
    328   1.3        ad  *	Dump information about an error and panic the system.  This
    329   1.3        ad  *	generates a lot of machine code in the DIAGNOSTIC case, so
    330   1.3        ad  *	we ask the compiler to not inline it.
    331   1.2        ad  */
    332  1.78     ozaki static void __noinline
    333  1.67  christos mutex_abort(const char *func, size_t line, const kmutex_t *mtx, const char *msg)
    334   1.2        ad {
    335   1.2        ad 
    336  1.87        ad 	LOCKDEBUG_ABORT(func, line, mtx, (MUTEX_SPIN_P(mtx->mtx_owner) ?
    337  1.64  christos 	    &mutex_spin_lockops : &mutex_adaptive_lockops), msg);
    338   1.2        ad }
    339   1.2        ad 
    340   1.2        ad /*
    341   1.2        ad  * mutex_init:
    342   1.2        ad  *
    343   1.2        ad  *	Initialize a mutex for use.  Note that adaptive mutexes are in
    344   1.2        ad  *	essence spin mutexes that can sleep to avoid deadlock and wasting
    345   1.2        ad  *	CPU time.  We can't easily provide a type of mutex that always
    346   1.2        ad  *	sleeps - see comments in mutex_vector_enter() about releasing
    347   1.2        ad  *	mutexes unlocked.
    348   1.2        ad  */
    349  1.71     ozaki void _mutex_init(kmutex_t *, kmutex_type_t, int, uintptr_t);
    350   1.2        ad void
    351  1.71     ozaki _mutex_init(kmutex_t *mtx, kmutex_type_t type, int ipl,
    352  1.71     ozaki     uintptr_t return_address)
    353   1.2        ad {
    354  1.81        ad 	lockops_t *lockops __unused;
    355  1.23      yamt 	bool dodebug;
    356   1.2        ad 
    357   1.2        ad 	memset(mtx, 0, sizeof(*mtx));
    358   1.2        ad 
    359  1.81        ad 	if (ipl == IPL_NONE || ipl == IPL_SOFTCLOCK ||
    360  1.81        ad 	    ipl == IPL_SOFTBIO || ipl == IPL_SOFTNET ||
    361  1.81        ad 	    ipl == IPL_SOFTSERIAL) {
    362  1.81        ad 		lockops = (type == MUTEX_NODEBUG ?
    363  1.81        ad 		    NULL : &mutex_adaptive_lockops);
    364  1.81        ad 		dodebug = LOCKDEBUG_ALLOC(mtx, lockops, return_address);
    365  1.23      yamt 		MUTEX_INITIALIZE_ADAPTIVE(mtx, dodebug);
    366  1.81        ad 	} else {
    367  1.81        ad 		lockops = (type == MUTEX_NODEBUG ?
    368  1.81        ad 		    NULL : &mutex_spin_lockops);
    369  1.81        ad 		dodebug = LOCKDEBUG_ALLOC(mtx, lockops, return_address);
    370  1.23      yamt 		MUTEX_INITIALIZE_SPIN(mtx, dodebug, ipl);
    371   1.2        ad 	}
    372   1.2        ad }
    373   1.2        ad 
    374  1.71     ozaki void
    375  1.71     ozaki mutex_init(kmutex_t *mtx, kmutex_type_t type, int ipl)
    376  1.71     ozaki {
    377  1.71     ozaki 
    378  1.71     ozaki 	_mutex_init(mtx, type, ipl, (uintptr_t)__builtin_return_address(0));
    379  1.71     ozaki }
    380  1.71     ozaki 
    381   1.2        ad /*
    382   1.2        ad  * mutex_destroy:
    383   1.2        ad  *
    384   1.2        ad  *	Tear down a mutex.
    385   1.2        ad  */
    386   1.2        ad void
    387   1.2        ad mutex_destroy(kmutex_t *mtx)
    388   1.2        ad {
    389  1.87        ad 	uintptr_t owner = mtx->mtx_owner;
    390   1.2        ad 
    391  1.87        ad 	if (MUTEX_ADAPTIVE_P(owner)) {
    392  1.90       chs 		MUTEX_ASSERT(mtx, !MUTEX_OWNED(owner));
    393  1.90       chs 		MUTEX_ASSERT(mtx, !MUTEX_HAS_WAITERS(mtx));
    394   1.2        ad 	} else {
    395  1.60      matt 		MUTEX_ASSERT(mtx, !MUTEX_SPINBIT_LOCKED_P(mtx));
    396   1.2        ad 	}
    397   1.2        ad 
    398  1.23      yamt 	LOCKDEBUG_FREE(MUTEX_DEBUG_P(mtx), mtx);
    399   1.2        ad 	MUTEX_DESTROY(mtx);
    400   1.2        ad }
    401   1.2        ad 
    402  1.50     rmind #ifdef MULTIPROCESSOR
    403   1.2        ad /*
    404  1.50     rmind  * mutex_oncpu:
    405   1.2        ad  *
    406   1.2        ad  *	Return true if an adaptive mutex owner is running on a CPU in the
    407   1.2        ad  *	system.  If the target is waiting on the kernel big lock, then we
    408  1.15        ad  *	must release it.  This is necessary to avoid deadlock.
    409   1.2        ad  */
    410  1.50     rmind static bool
    411  1.50     rmind mutex_oncpu(uintptr_t owner)
    412   1.2        ad {
    413   1.2        ad 	struct cpu_info *ci;
    414  1.50     rmind 	lwp_t *l;
    415   1.2        ad 
    416  1.50     rmind 	KASSERT(kpreempt_disabled());
    417  1.50     rmind 
    418  1.50     rmind 	if (!MUTEX_OWNED(owner)) {
    419  1.50     rmind 		return false;
    420  1.50     rmind 	}
    421   1.2        ad 
    422  1.50     rmind 	/*
    423  1.50     rmind 	 * See lwp_dtor() why dereference of the LWP pointer is safe.
    424  1.50     rmind 	 * We must have kernel preemption disabled for that.
    425  1.50     rmind 	 */
    426  1.50     rmind 	l = (lwp_t *)MUTEX_OWNER(owner);
    427  1.50     rmind 	ci = l->l_cpu;
    428   1.2        ad 
    429  1.50     rmind 	if (ci && ci->ci_curlwp == l) {
    430  1.50     rmind 		/* Target is running; do we need to block? */
    431  1.50     rmind 		return (ci->ci_biglock_wanted != l);
    432  1.50     rmind 	}
    433  1.15        ad 
    434  1.50     rmind 	/* Not running.  It may be safe to block now. */
    435  1.50     rmind 	return false;
    436   1.2        ad }
    437  1.15        ad #endif	/* MULTIPROCESSOR */
    438   1.2        ad 
    439   1.2        ad /*
    440   1.2        ad  * mutex_vector_enter:
    441   1.2        ad  *
    442  1.45     rmind  *	Support routine for mutex_enter() that must handle all cases.  In
    443   1.2        ad  *	the LOCKDEBUG case, mutex_enter() is always aliased here, even if
    444  1.62     prlw1  *	fast-path stubs are available.  If a mutex_spin_enter() stub is
    445   1.2        ad  *	not available, then it is also aliased directly here.
    446   1.2        ad  */
    447   1.2        ad void
    448   1.2        ad mutex_vector_enter(kmutex_t *mtx)
    449   1.2        ad {
    450   1.2        ad 	uintptr_t owner, curthread;
    451   1.2        ad 	turnstile_t *ts;
    452   1.2        ad #ifdef MULTIPROCESSOR
    453   1.2        ad 	u_int count;
    454   1.2        ad #endif
    455   1.2        ad 	LOCKSTAT_COUNTER(spincnt);
    456   1.2        ad 	LOCKSTAT_COUNTER(slpcnt);
    457   1.2        ad 	LOCKSTAT_TIMER(spintime);
    458   1.2        ad 	LOCKSTAT_TIMER(slptime);
    459   1.2        ad 	LOCKSTAT_FLAG(lsflag);
    460   1.2        ad 
    461   1.2        ad 	/*
    462   1.2        ad 	 * Handle spin mutexes.
    463   1.2        ad 	 */
    464  1.92        ad 	KPREEMPT_DISABLE(curlwp);
    465  1.87        ad 	owner = mtx->mtx_owner;
    466  1.87        ad 	if (MUTEX_SPIN_P(owner)) {
    467   1.2        ad #if defined(LOCKDEBUG) && defined(MULTIPROCESSOR)
    468   1.2        ad 		u_int spins = 0;
    469   1.2        ad #endif
    470  1.92        ad 		KPREEMPT_ENABLE(curlwp);
    471   1.2        ad 		MUTEX_SPIN_SPLRAISE(mtx);
    472   1.2        ad 		MUTEX_WANTLOCK(mtx);
    473   1.2        ad #ifdef FULL
    474  1.60      matt 		if (MUTEX_SPINBIT_LOCK_TRY(mtx)) {
    475   1.2        ad 			MUTEX_LOCKED(mtx);
    476   1.2        ad 			return;
    477   1.2        ad 		}
    478   1.2        ad #if !defined(MULTIPROCESSOR)
    479   1.2        ad 		MUTEX_ABORT(mtx, "locking against myself");
    480   1.2        ad #else /* !MULTIPROCESSOR */
    481   1.2        ad 
    482   1.2        ad 		LOCKSTAT_ENTER(lsflag);
    483   1.2        ad 		LOCKSTAT_START_TIMER(lsflag, spintime);
    484   1.2        ad 		count = SPINLOCK_BACKOFF_MIN;
    485   1.2        ad 
    486   1.2        ad 		/*
    487   1.2        ad 		 * Spin testing the lock word and do exponential backoff
    488   1.2        ad 		 * to reduce cache line ping-ponging between CPUs.
    489   1.2        ad 		 */
    490   1.2        ad 		do {
    491  1.60      matt 			while (MUTEX_SPINBIT_LOCKED_P(mtx)) {
    492  1.97   thorpej 				SPINLOCK_SPIN_HOOK;
    493  1.63   msaitoh 				SPINLOCK_BACKOFF(count);
    494   1.2        ad #ifdef LOCKDEBUG
    495   1.2        ad 				if (SPINLOCK_SPINOUT(spins))
    496   1.2        ad 					MUTEX_ABORT(mtx, "spinout");
    497   1.2        ad #endif	/* LOCKDEBUG */
    498   1.2        ad 			}
    499  1.60      matt 		} while (!MUTEX_SPINBIT_LOCK_TRY(mtx));
    500   1.2        ad 
    501   1.2        ad 		if (count != SPINLOCK_BACKOFF_MIN) {
    502   1.2        ad 			LOCKSTAT_STOP_TIMER(lsflag, spintime);
    503   1.2        ad 			LOCKSTAT_EVENT(lsflag, mtx,
    504   1.2        ad 			    LB_SPIN_MUTEX | LB_SPIN, 1, spintime);
    505   1.2        ad 		}
    506   1.2        ad 		LOCKSTAT_EXIT(lsflag);
    507   1.2        ad #endif	/* !MULTIPROCESSOR */
    508   1.2        ad #endif	/* FULL */
    509   1.2        ad 		MUTEX_LOCKED(mtx);
    510   1.2        ad 		return;
    511   1.2        ad 	}
    512   1.2        ad 
    513   1.2        ad 	curthread = (uintptr_t)curlwp;
    514   1.2        ad 
    515  1.87        ad 	MUTEX_DASSERT(mtx, MUTEX_ADAPTIVE_P(owner));
    516   1.2        ad 	MUTEX_ASSERT(mtx, curthread != 0);
    517  1.72     ozaki 	MUTEX_ASSERT(mtx, !cpu_intr_p());
    518   1.2        ad 	MUTEX_WANTLOCK(mtx);
    519   1.2        ad 
    520   1.2        ad 	if (panicstr == NULL) {
    521  1.77     ozaki 		KDASSERT(pserialize_not_in_read_section());
    522   1.2        ad 		LOCKDEBUG_BARRIER(&kernel_lock, 1);
    523   1.2        ad 	}
    524   1.2        ad 
    525   1.2        ad 	LOCKSTAT_ENTER(lsflag);
    526   1.2        ad 
    527   1.2        ad 	/*
    528   1.2        ad 	 * Adaptive mutex; spin trying to acquire the mutex.  If we
    529   1.2        ad 	 * determine that the owner is not running on a processor,
    530   1.2        ad 	 * then we stop spinning, and sleep instead.
    531   1.2        ad 	 */
    532  1.87        ad 	for (;;) {
    533   1.2        ad 		if (!MUTEX_OWNED(owner)) {
    534   1.2        ad 			/*
    535   1.2        ad 			 * Mutex owner clear could mean two things:
    536   1.2        ad 			 *
    537   1.2        ad 			 *	* The mutex has been released.
    538   1.2        ad 			 *	* The owner field hasn't been set yet.
    539   1.2        ad 			 *
    540   1.2        ad 			 * Try to acquire it again.  If that fails,
    541   1.2        ad 			 * we'll just loop again.
    542   1.2        ad 			 */
    543   1.2        ad 			if (MUTEX_ACQUIRE(mtx, curthread))
    544   1.2        ad 				break;
    545  1.34        ad 			owner = mtx->mtx_owner;
    546   1.2        ad 			continue;
    547   1.2        ad 		}
    548  1.50     rmind 		if (__predict_false(MUTEX_OWNER(owner) == curthread)) {
    549   1.2        ad 			MUTEX_ABORT(mtx, "locking against myself");
    550  1.50     rmind 		}
    551   1.2        ad #ifdef MULTIPROCESSOR
    552   1.2        ad 		/*
    553   1.2        ad 		 * Check to see if the owner is running on a processor.
    554   1.2        ad 		 * If so, then we should just spin, as the owner will
    555  1.92        ad 		 * likely release the lock very soon.
    556   1.2        ad 		 */
    557  1.50     rmind 		if (mutex_oncpu(owner)) {
    558   1.2        ad 			LOCKSTAT_START_TIMER(lsflag, spintime);
    559   1.2        ad 			count = SPINLOCK_BACKOFF_MIN;
    560  1.50     rmind 			do {
    561  1.53     rmind 				KPREEMPT_ENABLE(curlwp);
    562  1.34        ad 				SPINLOCK_BACKOFF(count);
    563  1.53     rmind 				KPREEMPT_DISABLE(curlwp);
    564   1.2        ad 				owner = mtx->mtx_owner;
    565  1.50     rmind 			} while (mutex_oncpu(owner));
    566   1.2        ad 			LOCKSTAT_STOP_TIMER(lsflag, spintime);
    567   1.2        ad 			LOCKSTAT_COUNT(spincnt, 1);
    568   1.2        ad 			if (!MUTEX_OWNED(owner))
    569   1.2        ad 				continue;
    570   1.2        ad 		}
    571   1.2        ad #endif
    572   1.2        ad 
    573   1.2        ad 		ts = turnstile_lookup(mtx);
    574   1.2        ad 
    575   1.2        ad 		/*
    576   1.2        ad 		 * Once we have the turnstile chain interlock, mark the
    577  1.69     skrll 		 * mutex as having waiters.  If that fails, spin again:
    578   1.2        ad 		 * chances are that the mutex has been released.
    579   1.2        ad 		 */
    580   1.2        ad 		if (!MUTEX_SET_WAITERS(mtx, owner)) {
    581   1.2        ad 			turnstile_exit(mtx);
    582  1.34        ad 			owner = mtx->mtx_owner;
    583   1.2        ad 			continue;
    584   1.2        ad 		}
    585   1.2        ad 
    586   1.2        ad #ifdef MULTIPROCESSOR
    587   1.2        ad 		/*
    588   1.2        ad 		 * mutex_exit() is permitted to release the mutex without
    589   1.2        ad 		 * any interlocking instructions, and the following can
    590   1.2        ad 		 * occur as a result:
    591   1.2        ad 		 *
    592   1.2        ad 		 *  CPU 1: MUTEX_SET_WAITERS()      CPU2: mutex_exit()
    593   1.2        ad 		 * ---------------------------- ----------------------------
    594   1.2        ad 		 *		..		    acquire cache line
    595   1.2        ad 		 *		..                   test for waiters
    596   1.2        ad 		 *	acquire cache line    <-      lose cache line
    597   1.2        ad 		 *	 lock cache line	           ..
    598   1.2        ad 		 *     verify mutex is held                ..
    599   1.2        ad 		 *	    set waiters  	           ..
    600   1.2        ad 		 *	 unlock cache line		   ..
    601   1.2        ad 		 *	  lose cache line     ->    acquire cache line
    602  1.93     skrll 		 *		..	          clear lock word, waiters
    603   1.2        ad 		 *	  return success
    604   1.2        ad 		 *
    605  1.50     rmind 		 * There is another race that can occur: a third CPU could
    606   1.2        ad 		 * acquire the mutex as soon as it is released.  Since
    607   1.2        ad 		 * adaptive mutexes are primarily spin mutexes, this is not
    608   1.2        ad 		 * something that we need to worry about too much.  What we
    609   1.2        ad 		 * do need to ensure is that the waiters bit gets set.
    610   1.2        ad 		 *
    611   1.2        ad 		 * To allow the unlocked release, we need to make some
    612   1.2        ad 		 * assumptions here:
    613   1.2        ad 		 *
    614   1.2        ad 		 * o Release is the only non-atomic/unlocked operation
    615   1.2        ad 		 *   that can be performed on the mutex.  (It must still
    616   1.2        ad 		 *   be atomic on the local CPU, e.g. in case interrupted
    617   1.2        ad 		 *   or preempted).
    618   1.2        ad 		 *
    619   1.2        ad 		 * o At any given time, MUTEX_SET_WAITERS() can only ever
    620  1.21     pooka 		 *   be in progress on one CPU in the system - guaranteed
    621   1.2        ad 		 *   by the turnstile chain lock.
    622   1.2        ad 		 *
    623   1.2        ad 		 * o No other operations other than MUTEX_SET_WAITERS()
    624   1.2        ad 		 *   and release can modify a mutex with a non-zero
    625   1.2        ad 		 *   owner field.
    626   1.2        ad 		 *
    627   1.2        ad 		 * o The result of a successful MUTEX_SET_WAITERS() call
    628   1.2        ad 		 *   is an unbuffered write that is immediately visible
    629   1.2        ad 		 *   to all other processors in the system.
    630   1.2        ad 		 *
    631   1.2        ad 		 * o If the holding LWP switches away, it posts a store
    632   1.2        ad 		 *   fence before changing curlwp, ensuring that any
    633   1.2        ad 		 *   overwrite of the mutex waiters flag by mutex_exit()
    634   1.2        ad 		 *   completes before the modification of curlwp becomes
    635   1.2        ad 		 *   visible to this CPU.
    636   1.2        ad 		 *
    637  1.95     skrll 		 * o cpu_switchto() posts a store fence after setting curlwp
    638   1.2        ad 		 *   and before resuming execution of an LWP.
    639  1.93     skrll 		 *
    640   1.2        ad 		 * o _kernel_lock() posts a store fence before setting
    641  1.93     skrll 		 *   curcpu()->ci_biglock_wanted, and after clearing it.
    642   1.2        ad 		 *   This ensures that any overwrite of the mutex waiters
    643   1.2        ad 		 *   flag by mutex_exit() completes before the modification
    644   1.2        ad 		 *   of ci_biglock_wanted becomes visible.
    645   1.2        ad 		 *
    646   1.2        ad 		 * We now post a read memory barrier (after setting the
    647   1.2        ad 		 * waiters field) and check the lock holder's status again.
    648   1.2        ad 		 * Some of the possible outcomes (not an exhaustive list):
    649   1.2        ad 		 *
    650  1.50     rmind 		 * 1. The on-CPU check returns true: the holding LWP is
    651   1.2        ad 		 *    running again.  The lock may be released soon and
    652   1.2        ad 		 *    we should spin.  Importantly, we can't trust the
    653   1.2        ad 		 *    value of the waiters flag.
    654   1.2        ad 		 *
    655  1.50     rmind 		 * 2. The on-CPU check returns false: the holding LWP is
    656  1.39      yamt 		 *    not running.  We now have the opportunity to check
    657   1.2        ad 		 *    if mutex_exit() has blatted the modifications made
    658   1.2        ad 		 *    by MUTEX_SET_WAITERS().
    659   1.2        ad 		 *
    660  1.50     rmind 		 * 3. The on-CPU check returns false: the holding LWP may
    661   1.2        ad 		 *    or may not be running.  It has context switched at
    662   1.2        ad 		 *    some point during our check.  Again, we have the
    663   1.2        ad 		 *    chance to see if the waiters bit is still set or
    664   1.2        ad 		 *    has been overwritten.
    665   1.2        ad 		 *
    666  1.50     rmind 		 * 4. The on-CPU check returns false: the holding LWP is
    667   1.2        ad 		 *    running on a CPU, but wants the big lock.  It's OK
    668   1.2        ad 		 *    to check the waiters field in this case.
    669   1.2        ad 		 *
    670   1.2        ad 		 * 5. The has-waiters check fails: the mutex has been
    671   1.2        ad 		 *    released, the waiters flag cleared and another LWP
    672   1.2        ad 		 *    now owns the mutex.
    673   1.2        ad 		 *
    674   1.2        ad 		 * 6. The has-waiters check fails: the mutex has been
    675   1.2        ad 		 *    released.
    676   1.2        ad 		 *
    677   1.2        ad 		 * If the waiters bit is not set it's unsafe to go asleep,
    678   1.2        ad 		 * as we might never be awoken.
    679   1.2        ad 		 */
    680  1.87        ad 		membar_consumer();
    681  1.87        ad 		if (mutex_oncpu(owner)) {
    682   1.2        ad 			turnstile_exit(mtx);
    683  1.34        ad 			owner = mtx->mtx_owner;
    684   1.2        ad 			continue;
    685   1.2        ad 		}
    686  1.87        ad 		membar_consumer();
    687  1.88        ad 		if (!MUTEX_HAS_WAITERS(mtx)) {
    688  1.87        ad 			turnstile_exit(mtx);
    689  1.88        ad 			owner = mtx->mtx_owner;
    690  1.87        ad 			continue;
    691  1.87        ad 		}
    692   1.2        ad #endif	/* MULTIPROCESSOR */
    693   1.2        ad 
    694   1.2        ad 		LOCKSTAT_START_TIMER(lsflag, slptime);
    695   1.2        ad 
    696   1.5      yamt 		turnstile_block(ts, TS_WRITER_Q, mtx, &mutex_syncobj);
    697   1.2        ad 
    698   1.2        ad 		LOCKSTAT_STOP_TIMER(lsflag, slptime);
    699   1.2        ad 		LOCKSTAT_COUNT(slpcnt, 1);
    700  1.34        ad 
    701  1.34        ad 		owner = mtx->mtx_owner;
    702   1.2        ad 	}
    703  1.50     rmind 	KPREEMPT_ENABLE(curlwp);
    704   1.2        ad 
    705   1.2        ad 	LOCKSTAT_EVENT(lsflag, mtx, LB_ADAPTIVE_MUTEX | LB_SLEEP1,
    706   1.2        ad 	    slpcnt, slptime);
    707   1.2        ad 	LOCKSTAT_EVENT(lsflag, mtx, LB_ADAPTIVE_MUTEX | LB_SPIN,
    708   1.2        ad 	    spincnt, spintime);
    709   1.2        ad 	LOCKSTAT_EXIT(lsflag);
    710   1.2        ad 
    711   1.2        ad 	MUTEX_DASSERT(mtx, MUTEX_OWNER(mtx->mtx_owner) == curthread);
    712   1.2        ad 	MUTEX_LOCKED(mtx);
    713   1.2        ad }
    714   1.2        ad 
    715   1.2        ad /*
    716   1.2        ad  * mutex_vector_exit:
    717   1.2        ad  *
    718   1.2        ad  *	Support routine for mutex_exit() that handles all cases.
    719   1.2        ad  */
    720   1.2        ad void
    721   1.2        ad mutex_vector_exit(kmutex_t *mtx)
    722   1.2        ad {
    723   1.2        ad 	turnstile_t *ts;
    724   1.2        ad 	uintptr_t curthread;
    725   1.2        ad 
    726  1.87        ad 	if (MUTEX_SPIN_P(mtx->mtx_owner)) {
    727   1.2        ad #ifdef FULL
    728  1.60      matt 		if (__predict_false(!MUTEX_SPINBIT_LOCKED_P(mtx))) {
    729   1.2        ad 			MUTEX_ABORT(mtx, "exiting unheld spin mutex");
    730  1.33        ad 		}
    731   1.2        ad 		MUTEX_UNLOCKED(mtx);
    732  1.60      matt 		MUTEX_SPINBIT_LOCK_UNLOCK(mtx);
    733   1.2        ad #endif
    734   1.2        ad 		MUTEX_SPIN_SPLRESTORE(mtx);
    735   1.2        ad 		return;
    736   1.2        ad 	}
    737   1.2        ad 
    738  1.85        ad #ifndef __HAVE_MUTEX_STUBS
    739  1.86        ad 	/*
    740  1.86        ad 	 * On some architectures without mutex stubs, we can enter here to
    741  1.93     skrll 	 * release mutexes before interrupts and whatnot are up and running.
    742  1.86        ad 	 * We need this hack to keep them sweet.
    743  1.86        ad 	 */
    744  1.85        ad 	if (__predict_false(cold)) {
    745  1.85        ad 		MUTEX_UNLOCKED(mtx);
    746  1.85        ad 		MUTEX_RELEASE(mtx);
    747  1.85        ad 		return;
    748  1.85        ad 	}
    749  1.85        ad #endif
    750  1.85        ad 
    751   1.2        ad 	curthread = (uintptr_t)curlwp;
    752   1.2        ad 	MUTEX_DASSERT(mtx, curthread != 0);
    753   1.2        ad 	MUTEX_ASSERT(mtx, MUTEX_OWNER(mtx->mtx_owner) == curthread);
    754   1.2        ad 	MUTEX_UNLOCKED(mtx);
    755  1.58       mrg #if !defined(LOCKDEBUG)
    756  1.58       mrg 	__USE(curthread);
    757  1.58       mrg #endif
    758   1.2        ad 
    759  1.15        ad #ifdef LOCKDEBUG
    760  1.15        ad 	/*
    761  1.15        ad 	 * Avoid having to take the turnstile chain lock every time
    762  1.15        ad 	 * around.  Raise the priority level to splhigh() in order
    763  1.15        ad 	 * to disable preemption and so make the following atomic.
    764  1.15        ad 	 */
    765  1.15        ad 	{
    766  1.15        ad 		int s = splhigh();
    767  1.88        ad 		if (!MUTEX_HAS_WAITERS(mtx)) {
    768  1.15        ad 			MUTEX_RELEASE(mtx);
    769  1.15        ad 			splx(s);
    770  1.15        ad 			return;
    771  1.15        ad 		}
    772  1.15        ad 		splx(s);
    773  1.15        ad 	}
    774  1.15        ad #endif
    775  1.15        ad 
    776   1.2        ad 	/*
    777   1.2        ad 	 * Get this lock's turnstile.  This gets the interlock on
    778   1.2        ad 	 * the sleep queue.  Once we have that, we can clear the
    779   1.2        ad 	 * lock.  If there was no turnstile for the lock, there
    780   1.2        ad 	 * were no waiters remaining.
    781   1.2        ad 	 */
    782   1.2        ad 	ts = turnstile_lookup(mtx);
    783   1.2        ad 
    784   1.2        ad 	if (ts == NULL) {
    785   1.2        ad 		MUTEX_RELEASE(mtx);
    786   1.2        ad 		turnstile_exit(mtx);
    787   1.2        ad 	} else {
    788   1.2        ad 		MUTEX_RELEASE(mtx);
    789   1.2        ad 		turnstile_wakeup(ts, TS_WRITER_Q,
    790   1.2        ad 		    TS_WAITERS(ts, TS_WRITER_Q), NULL);
    791   1.2        ad 	}
    792   1.2        ad }
    793   1.2        ad 
    794   1.4        ad #ifndef __HAVE_SIMPLE_MUTEXES
    795   1.4        ad /*
    796   1.4        ad  * mutex_wakeup:
    797   1.4        ad  *
    798   1.4        ad  *	Support routine for mutex_exit() that wakes up all waiters.
    799   1.4        ad  *	We assume that the mutex has been released, but it need not
    800   1.4        ad  *	be.
    801   1.4        ad  */
    802   1.4        ad void
    803   1.4        ad mutex_wakeup(kmutex_t *mtx)
    804   1.4        ad {
    805   1.4        ad 	turnstile_t *ts;
    806   1.4        ad 
    807   1.4        ad 	ts = turnstile_lookup(mtx);
    808   1.4        ad 	if (ts == NULL) {
    809   1.4        ad 		turnstile_exit(mtx);
    810   1.4        ad 		return;
    811   1.4        ad 	}
    812   1.4        ad 	MUTEX_CLEAR_WAITERS(mtx);
    813   1.4        ad 	turnstile_wakeup(ts, TS_WRITER_Q, TS_WAITERS(ts, TS_WRITER_Q), NULL);
    814   1.4        ad }
    815   1.4        ad #endif	/* !__HAVE_SIMPLE_MUTEXES */
    816   1.4        ad 
    817   1.2        ad /*
    818   1.2        ad  * mutex_owned:
    819   1.2        ad  *
    820   1.3        ad  *	Return true if the current LWP (adaptive) or CPU (spin)
    821   1.3        ad  *	holds the mutex.
    822   1.2        ad  */
    823   1.2        ad int
    824  1.66  christos mutex_owned(const kmutex_t *mtx)
    825   1.2        ad {
    826   1.2        ad 
    827  1.35        ad 	if (mtx == NULL)
    828  1.35        ad 		return 0;
    829  1.87        ad 	if (MUTEX_ADAPTIVE_P(mtx->mtx_owner))
    830   1.2        ad 		return MUTEX_OWNER(mtx->mtx_owner) == (uintptr_t)curlwp;
    831   1.2        ad #ifdef FULL
    832  1.60      matt 	return MUTEX_SPINBIT_LOCKED_P(mtx);
    833   1.2        ad #else
    834   1.2        ad 	return 1;
    835   1.2        ad #endif
    836   1.2        ad }
    837   1.2        ad 
    838   1.2        ad /*
    839   1.2        ad  * mutex_owner:
    840   1.2        ad  *
    841   1.6        ad  *	Return the current owner of an adaptive mutex.  Used for
    842   1.6        ad  *	priority inheritance.
    843   1.2        ad  */
    844  1.27        ad lwp_t *
    845  1.66  christos mutex_owner(const kmutex_t *mtx)
    846   1.2        ad {
    847   1.2        ad 
    848  1.87        ad 	MUTEX_ASSERT(mtx, MUTEX_ADAPTIVE_P(mtx->mtx_owner));
    849   1.2        ad 	return (struct lwp *)MUTEX_OWNER(mtx->mtx_owner);
    850   1.2        ad }
    851   1.2        ad 
    852   1.2        ad /*
    853  1.81        ad  * mutex_owner_running:
    854  1.81        ad  *
    855  1.82        ad  *	Return true if an adaptive mutex is unheld, or held and the owner is
    856  1.89        ad  *	running on a CPU.  For the pagedaemon only - do not document or use
    857  1.89        ad  *	in other code.
    858  1.81        ad  */
    859  1.81        ad bool
    860  1.81        ad mutex_owner_running(const kmutex_t *mtx)
    861  1.81        ad {
    862  1.82        ad #ifdef MULTIPROCESSOR
    863  1.82        ad 	uintptr_t owner;
    864  1.81        ad 	bool rv;
    865  1.81        ad 
    866  1.87        ad 	MUTEX_ASSERT(mtx, MUTEX_ADAPTIVE_P(mtx->mtx_owner));
    867  1.81        ad 	kpreempt_disable();
    868  1.82        ad 	owner = mtx->mtx_owner;
    869  1.84       kre 	rv = !MUTEX_OWNED(owner) || mutex_oncpu(MUTEX_OWNER(owner));
    870  1.81        ad 	kpreempt_enable();
    871  1.81        ad 	return rv;
    872  1.82        ad #else
    873  1.82        ad 	return mutex_owner(mtx) == curlwp;
    874  1.82        ad #endif
    875  1.81        ad }
    876  1.81        ad 
    877  1.81        ad /*
    878  1.65  pgoyette  * mutex_ownable:
    879  1.65  pgoyette  *
    880  1.65  pgoyette  *	When compiled with DEBUG and LOCKDEBUG defined, ensure that
    881  1.65  pgoyette  *	the mutex is available.  We cannot use !mutex_owned() since
    882  1.65  pgoyette  *	that won't work correctly for spin mutexes.
    883  1.65  pgoyette  */
    884  1.65  pgoyette int
    885  1.66  christos mutex_ownable(const kmutex_t *mtx)
    886  1.65  pgoyette {
    887  1.65  pgoyette 
    888  1.65  pgoyette #ifdef LOCKDEBUG
    889  1.65  pgoyette 	MUTEX_TESTLOCK(mtx);
    890  1.65  pgoyette #endif
    891  1.65  pgoyette 	return 1;
    892  1.65  pgoyette }
    893  1.65  pgoyette 
    894  1.65  pgoyette /*
    895   1.2        ad  * mutex_tryenter:
    896   1.2        ad  *
    897   1.2        ad  *	Try to acquire the mutex; return non-zero if we did.
    898   1.2        ad  */
    899   1.2        ad int
    900   1.2        ad mutex_tryenter(kmutex_t *mtx)
    901   1.2        ad {
    902   1.2        ad 	uintptr_t curthread;
    903   1.2        ad 
    904   1.2        ad 	/*
    905   1.2        ad 	 * Handle spin mutexes.
    906   1.2        ad 	 */
    907  1.87        ad 	if (MUTEX_SPIN_P(mtx->mtx_owner)) {
    908   1.2        ad 		MUTEX_SPIN_SPLRAISE(mtx);
    909   1.2        ad #ifdef FULL
    910  1.60      matt 		if (MUTEX_SPINBIT_LOCK_TRY(mtx)) {
    911   1.4        ad 			MUTEX_WANTLOCK(mtx);
    912   1.2        ad 			MUTEX_LOCKED(mtx);
    913   1.2        ad 			return 1;
    914   1.2        ad 		}
    915   1.2        ad 		MUTEX_SPIN_SPLRESTORE(mtx);
    916   1.2        ad #else
    917   1.4        ad 		MUTEX_WANTLOCK(mtx);
    918   1.2        ad 		MUTEX_LOCKED(mtx);
    919   1.2        ad 		return 1;
    920   1.2        ad #endif
    921   1.2        ad 	} else {
    922   1.2        ad 		curthread = (uintptr_t)curlwp;
    923   1.2        ad 		MUTEX_ASSERT(mtx, curthread != 0);
    924   1.2        ad 		if (MUTEX_ACQUIRE(mtx, curthread)) {
    925   1.4        ad 			MUTEX_WANTLOCK(mtx);
    926   1.2        ad 			MUTEX_LOCKED(mtx);
    927   1.2        ad 			MUTEX_DASSERT(mtx,
    928   1.2        ad 			    MUTEX_OWNER(mtx->mtx_owner) == curthread);
    929   1.2        ad 			return 1;
    930   1.2        ad 		}
    931   1.2        ad 	}
    932   1.2        ad 
    933   1.2        ad 	return 0;
    934   1.2        ad }
    935   1.2        ad 
    936   1.2        ad #if defined(__HAVE_SPIN_MUTEX_STUBS) || defined(FULL)
    937   1.2        ad /*
    938   1.2        ad  * mutex_spin_retry:
    939   1.2        ad  *
    940   1.2        ad  *	Support routine for mutex_spin_enter().  Assumes that the caller
    941   1.2        ad  *	has already raised the SPL, and adjusted counters.
    942   1.2        ad  */
    943   1.2        ad void
    944   1.2        ad mutex_spin_retry(kmutex_t *mtx)
    945   1.2        ad {
    946   1.2        ad #ifdef MULTIPROCESSOR
    947   1.2        ad 	u_int count;
    948   1.2        ad 	LOCKSTAT_TIMER(spintime);
    949   1.2        ad 	LOCKSTAT_FLAG(lsflag);
    950   1.2        ad #ifdef LOCKDEBUG
    951   1.2        ad 	u_int spins = 0;
    952   1.2        ad #endif	/* LOCKDEBUG */
    953   1.2        ad 
    954   1.2        ad 	MUTEX_WANTLOCK(mtx);
    955   1.2        ad 
    956   1.2        ad 	LOCKSTAT_ENTER(lsflag);
    957   1.2        ad 	LOCKSTAT_START_TIMER(lsflag, spintime);
    958   1.2        ad 	count = SPINLOCK_BACKOFF_MIN;
    959   1.2        ad 
    960   1.2        ad 	/*
    961   1.2        ad 	 * Spin testing the lock word and do exponential backoff
    962   1.2        ad 	 * to reduce cache line ping-ponging between CPUs.
    963   1.2        ad 	 */
    964   1.2        ad 	do {
    965  1.60      matt 		while (MUTEX_SPINBIT_LOCKED_P(mtx)) {
    966  1.63   msaitoh 			SPINLOCK_BACKOFF(count);
    967   1.2        ad #ifdef LOCKDEBUG
    968   1.2        ad 			if (SPINLOCK_SPINOUT(spins))
    969   1.2        ad 				MUTEX_ABORT(mtx, "spinout");
    970   1.2        ad #endif	/* LOCKDEBUG */
    971   1.2        ad 		}
    972  1.60      matt 	} while (!MUTEX_SPINBIT_LOCK_TRY(mtx));
    973   1.2        ad 
    974   1.2        ad 	LOCKSTAT_STOP_TIMER(lsflag, spintime);
    975   1.2        ad 	LOCKSTAT_EVENT(lsflag, mtx, LB_SPIN_MUTEX | LB_SPIN, 1, spintime);
    976   1.2        ad 	LOCKSTAT_EXIT(lsflag);
    977   1.2        ad 
    978   1.2        ad 	MUTEX_LOCKED(mtx);
    979   1.2        ad #else	/* MULTIPROCESSOR */
    980   1.2        ad 	MUTEX_ABORT(mtx, "locking against myself");
    981   1.2        ad #endif	/* MULTIPROCESSOR */
    982   1.2        ad }
    983   1.2        ad #endif	/* defined(__HAVE_SPIN_MUTEX_STUBS) || defined(FULL) */
    984