xref: /freebsd/sys/contrib/ck/include/spinlock/clh.h (revision 4f9d94bf6491250b649f5bc931b6d93e68373005)
1*1fb62fb0SOlivier Houchard /*
2*1fb62fb0SOlivier Houchard  * Copyright 2010-2015 Samy Al Bahra.
3*1fb62fb0SOlivier Houchard  * All rights reserved.
4*1fb62fb0SOlivier Houchard  *
5*1fb62fb0SOlivier Houchard  * Redistribution and use in source and binary forms, with or without
6*1fb62fb0SOlivier Houchard  * modification, are permitted provided that the following conditions
7*1fb62fb0SOlivier Houchard  * are met:
8*1fb62fb0SOlivier Houchard  * 1. Redistributions of source code must retain the above copyright
9*1fb62fb0SOlivier Houchard  *    notice, this list of conditions and the following disclaimer.
10*1fb62fb0SOlivier Houchard  * 2. Redistributions in binary form must reproduce the above copyright
11*1fb62fb0SOlivier Houchard  *    notice, this list of conditions and the following disclaimer in the
12*1fb62fb0SOlivier Houchard  *    documentation and/or other materials provided with the distribution.
13*1fb62fb0SOlivier Houchard  *
14*1fb62fb0SOlivier Houchard  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15*1fb62fb0SOlivier Houchard  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16*1fb62fb0SOlivier Houchard  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17*1fb62fb0SOlivier Houchard  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18*1fb62fb0SOlivier Houchard  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19*1fb62fb0SOlivier Houchard  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20*1fb62fb0SOlivier Houchard  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21*1fb62fb0SOlivier Houchard  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22*1fb62fb0SOlivier Houchard  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23*1fb62fb0SOlivier Houchard  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24*1fb62fb0SOlivier Houchard  * SUCH DAMAGE.
25*1fb62fb0SOlivier Houchard  */
26*1fb62fb0SOlivier Houchard 
27*1fb62fb0SOlivier Houchard #ifndef CK_SPINLOCK_CLH_H
28*1fb62fb0SOlivier Houchard #define CK_SPINLOCK_CLH_H
29*1fb62fb0SOlivier Houchard 
30*1fb62fb0SOlivier Houchard #include <ck_cc.h>
31*1fb62fb0SOlivier Houchard #include <ck_limits.h>
32*1fb62fb0SOlivier Houchard #include <ck_pr.h>
33*1fb62fb0SOlivier Houchard #include <ck_stdbool.h>
34*1fb62fb0SOlivier Houchard #include <ck_stddef.h>
35*1fb62fb0SOlivier Houchard 
36*1fb62fb0SOlivier Houchard #ifndef CK_F_SPINLOCK_CLH
37*1fb62fb0SOlivier Houchard #define CK_F_SPINLOCK_CLH
38*1fb62fb0SOlivier Houchard 
39*1fb62fb0SOlivier Houchard struct ck_spinlock_clh {
40*1fb62fb0SOlivier Houchard 	unsigned int wait;
41*1fb62fb0SOlivier Houchard 	struct ck_spinlock_clh *previous;
42*1fb62fb0SOlivier Houchard };
43*1fb62fb0SOlivier Houchard typedef struct ck_spinlock_clh ck_spinlock_clh_t;
44*1fb62fb0SOlivier Houchard 
45*1fb62fb0SOlivier Houchard CK_CC_INLINE static void
ck_spinlock_clh_init(struct ck_spinlock_clh ** lock,struct ck_spinlock_clh * unowned)46*1fb62fb0SOlivier Houchard ck_spinlock_clh_init(struct ck_spinlock_clh **lock, struct ck_spinlock_clh *unowned)
47*1fb62fb0SOlivier Houchard {
48*1fb62fb0SOlivier Houchard 
49*1fb62fb0SOlivier Houchard 	unowned->previous = NULL;
50*1fb62fb0SOlivier Houchard 	unowned->wait = false;
51*1fb62fb0SOlivier Houchard 	*lock = unowned;
52*1fb62fb0SOlivier Houchard 	ck_pr_barrier();
53*1fb62fb0SOlivier Houchard 	return;
54*1fb62fb0SOlivier Houchard }
55*1fb62fb0SOlivier Houchard 
56*1fb62fb0SOlivier Houchard CK_CC_INLINE static bool
ck_spinlock_clh_locked(struct ck_spinlock_clh ** queue)57*1fb62fb0SOlivier Houchard ck_spinlock_clh_locked(struct ck_spinlock_clh **queue)
58*1fb62fb0SOlivier Houchard {
59*1fb62fb0SOlivier Houchard 	struct ck_spinlock_clh *head;
60*1fb62fb0SOlivier Houchard 	bool r;
61*1fb62fb0SOlivier Houchard 
62*1fb62fb0SOlivier Houchard 	head = ck_pr_load_ptr(queue);
63*1fb62fb0SOlivier Houchard 	r = ck_pr_load_uint(&head->wait);
64*1fb62fb0SOlivier Houchard 	ck_pr_fence_acquire();
65*1fb62fb0SOlivier Houchard 	return r;
66*1fb62fb0SOlivier Houchard }
67*1fb62fb0SOlivier Houchard 
68*1fb62fb0SOlivier Houchard CK_CC_INLINE static void
ck_spinlock_clh_lock(struct ck_spinlock_clh ** queue,struct ck_spinlock_clh * thread)69*1fb62fb0SOlivier Houchard ck_spinlock_clh_lock(struct ck_spinlock_clh **queue, struct ck_spinlock_clh *thread)
70*1fb62fb0SOlivier Houchard {
71*1fb62fb0SOlivier Houchard 	struct ck_spinlock_clh *previous;
72*1fb62fb0SOlivier Houchard 
73*1fb62fb0SOlivier Houchard 	/* Indicate to the next thread on queue that they will have to block. */
74*1fb62fb0SOlivier Houchard 	thread->wait = true;
75*1fb62fb0SOlivier Houchard 	ck_pr_fence_store_atomic();
76*1fb62fb0SOlivier Houchard 
77*1fb62fb0SOlivier Houchard 	/*
78*1fb62fb0SOlivier Houchard 	 * Mark current request as last request. Save reference to previous
79*1fb62fb0SOlivier Houchard 	 * request.
80*1fb62fb0SOlivier Houchard 	 */
81*1fb62fb0SOlivier Houchard 	previous = ck_pr_fas_ptr(queue, thread);
82*1fb62fb0SOlivier Houchard 	thread->previous = previous;
83*1fb62fb0SOlivier Houchard 
84*1fb62fb0SOlivier Houchard 	/* Wait until previous thread is done with lock. */
85*1fb62fb0SOlivier Houchard 	ck_pr_fence_load();
86*1fb62fb0SOlivier Houchard 	while (ck_pr_load_uint(&previous->wait) == true)
87*1fb62fb0SOlivier Houchard 		ck_pr_stall();
88*1fb62fb0SOlivier Houchard 
89*1fb62fb0SOlivier Houchard 	ck_pr_fence_lock();
90*1fb62fb0SOlivier Houchard 	return;
91*1fb62fb0SOlivier Houchard }
92*1fb62fb0SOlivier Houchard 
93*1fb62fb0SOlivier Houchard CK_CC_INLINE static void
ck_spinlock_clh_unlock(struct ck_spinlock_clh ** thread)94*1fb62fb0SOlivier Houchard ck_spinlock_clh_unlock(struct ck_spinlock_clh **thread)
95*1fb62fb0SOlivier Houchard {
96*1fb62fb0SOlivier Houchard 	struct ck_spinlock_clh *previous;
97*1fb62fb0SOlivier Houchard 
98*1fb62fb0SOlivier Houchard 	/*
99*1fb62fb0SOlivier Houchard 	 * If there are waiters, they are spinning on the current node wait
100*1fb62fb0SOlivier Houchard 	 * flag. The flag is cleared so that the successor may complete an
101*1fb62fb0SOlivier Houchard 	 * acquisition. If the caller is pre-empted then the predecessor field
102*1fb62fb0SOlivier Houchard 	 * may be updated by a successor's lock operation. In order to avoid
103*1fb62fb0SOlivier Houchard 	 * this, save a copy of the predecessor before setting the flag.
104*1fb62fb0SOlivier Houchard 	 */
105*1fb62fb0SOlivier Houchard 	previous = thread[0]->previous;
106*1fb62fb0SOlivier Houchard 
107*1fb62fb0SOlivier Houchard 	/*
108*1fb62fb0SOlivier Houchard 	 * We have to pay this cost anyways, use it as a compiler barrier too.
109*1fb62fb0SOlivier Houchard 	 */
110*1fb62fb0SOlivier Houchard 	ck_pr_fence_unlock();
111*1fb62fb0SOlivier Houchard 	ck_pr_store_uint(&(*thread)->wait, false);
112*1fb62fb0SOlivier Houchard 
113*1fb62fb0SOlivier Houchard 	/*
114*1fb62fb0SOlivier Houchard 	 * Predecessor is guaranteed not to be spinning on previous request,
115*1fb62fb0SOlivier Houchard 	 * so update caller to use previous structure. This allows successor
116*1fb62fb0SOlivier Houchard 	 * all the time in the world to successfully read updated wait flag.
117*1fb62fb0SOlivier Houchard 	 */
118*1fb62fb0SOlivier Houchard 	*thread = previous;
119*1fb62fb0SOlivier Houchard 	return;
120*1fb62fb0SOlivier Houchard }
121*1fb62fb0SOlivier Houchard #endif /* CK_F_SPINLOCK_CLH */
122*1fb62fb0SOlivier Houchard #endif /* CK_SPINLOCK_CLH_H */
123