atomic.h revision 299912
138517Sdfr/*-
238517Sdfr * Copyright (c) 1998 Doug Rabson
338517Sdfr * All rights reserved.
438517Sdfr *
538517Sdfr * Redistribution and use in source and binary forms, with or without
638517Sdfr * modification, are permitted provided that the following conditions
738517Sdfr * are met:
838517Sdfr * 1. Redistributions of source code must retain the above copyright
938517Sdfr *    notice, this list of conditions and the following disclaimer.
1038517Sdfr * 2. Redistributions in binary form must reproduce the above copyright
1138517Sdfr *    notice, this list of conditions and the following disclaimer in the
1238517Sdfr *    documentation and/or other materials provided with the distribution.
1338517Sdfr *
1438517Sdfr * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1538517Sdfr * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1638517Sdfr * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1738517Sdfr * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
1838517Sdfr * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
1938517Sdfr * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2038517Sdfr * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2138517Sdfr * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2238517Sdfr * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2338517Sdfr * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2438517Sdfr * SUCH DAMAGE.
2538517Sdfr *
2650477Speter * $FreeBSD: head/sys/i386/include/atomic.h 299912 2016-05-16 07:19:33Z sephe $
2738517Sdfr */
2838517Sdfr#ifndef _MACHINE_ATOMIC_H_
29147855Sjhb#define	_MACHINE_ATOMIC_H_
3038517Sdfr
31143063Sjoerg#ifndef _SYS_CDEFS_H_
32143063Sjoerg#error this file needs sys/cdefs.h as a prerequisite
33143063Sjoerg#endif
34143063Sjoerg
35254619Sjkim#ifdef _KERNEL
36254619Sjkim#include <machine/md_var.h>
37254619Sjkim#include <machine/specialreg.h>
38254619Sjkim#endif
39254619Sjkim
40286051Skib#ifndef __OFFSETOF_MONITORBUF
41286051Skib/*
42286051Skib * __OFFSETOF_MONITORBUF == __pcpu_offset(pc_monitorbuf).
43286051Skib *
44286051Skib * The open-coded number is used instead of the symbolic expression to
45286051Skib * avoid a dependency on sys/pcpu.h in machine/atomic.h consumers.
46286051Skib * An assertion in i386/vm_machdep.c ensures that the value is correct.
47286051Skib */
48286051Skib#define	__OFFSETOF_MONITORBUF	0x180
49185162Skmacy
50286051Skibstatic __inline void
51286051Skib__mbk(void)
52286051Skib{
53286051Skib
54286051Skib	__asm __volatile("lock; addl $0,%%fs:%0"
55286051Skib	    : "+m" (*(u_int *)__OFFSETOF_MONITORBUF) : : "memory", "cc");
56286051Skib}
57286051Skib
58286051Skibstatic __inline void
59286051Skib__mbu(void)
60286051Skib{
61286051Skib
62286051Skib	__asm __volatile("lock; addl $0,(%%esp)" : : : "memory", "cc");
63286051Skib}
64286051Skib#endif
65286051Skib
6638517Sdfr/*
67165635Sbde * Various simple operations on memory, each of which is atomic in the
68165635Sbde * presence of interrupts and multiple processors.
6938517Sdfr *
70165633Sbde * atomic_set_char(P, V)	(*(u_char *)(P) |= (V))
71165633Sbde * atomic_clear_char(P, V)	(*(u_char *)(P) &= ~(V))
72165633Sbde * atomic_add_char(P, V)	(*(u_char *)(P) += (V))
73165633Sbde * atomic_subtract_char(P, V)	(*(u_char *)(P) -= (V))
7448797Salc *
75165633Sbde * atomic_set_short(P, V)	(*(u_short *)(P) |= (V))
76165633Sbde * atomic_clear_short(P, V)	(*(u_short *)(P) &= ~(V))
77165633Sbde * atomic_add_short(P, V)	(*(u_short *)(P) += (V))
78165633Sbde * atomic_subtract_short(P, V)	(*(u_short *)(P) -= (V))
7948797Salc *
80165633Sbde * atomic_set_int(P, V)		(*(u_int *)(P) |= (V))
81165633Sbde * atomic_clear_int(P, V)	(*(u_int *)(P) &= ~(V))
82165633Sbde * atomic_add_int(P, V)		(*(u_int *)(P) += (V))
83165633Sbde * atomic_subtract_int(P, V)	(*(u_int *)(P) -= (V))
84254617Sjkim * atomic_swap_int(P, V)	(return (*(u_int *)(P)); *(u_int *)(P) = (V);)
85165635Sbde * atomic_readandclear_int(P)	(return (*(u_int *)(P)); *(u_int *)(P) = 0;)
8648797Salc *
87165633Sbde * atomic_set_long(P, V)	(*(u_long *)(P) |= (V))
88165633Sbde * atomic_clear_long(P, V)	(*(u_long *)(P) &= ~(V))
89165633Sbde * atomic_add_long(P, V)	(*(u_long *)(P) += (V))
90165633Sbde * atomic_subtract_long(P, V)	(*(u_long *)(P) -= (V))
91254617Sjkim * atomic_swap_long(P, V)	(return (*(u_long *)(P)); *(u_long *)(P) = (V);)
92165635Sbde * atomic_readandclear_long(P)	(return (*(u_long *)(P)); *(u_long *)(P) = 0;)
9338517Sdfr */
9438517Sdfr
9548797Salc/*
9649999Salc * The above functions are expanded inline in the statically-linked
9749999Salc * kernel.  Lock prefixes are generated if an SMP kernel is being
9849999Salc * built.
9949999Salc *
10049999Salc * Kernel modules call real functions which are built into the kernel.
10149999Salc * This allows kernel modules to be portable between UP and SMP systems.
10248797Salc */
103147855Sjhb#if defined(KLD_MODULE) || !defined(__GNUCLIKE_ASM)
104147855Sjhb#define	ATOMIC_ASM(NAME, TYPE, OP, CONS, V)			\
105197803Sattiliovoid atomic_##NAME##_##TYPE(volatile u_##TYPE *p, u_##TYPE v);	\
106197803Sattiliovoid atomic_##NAME##_barr_##TYPE(volatile u_##TYPE *p, u_##TYPE v)
10749999Salc
108208332Sphkint	atomic_cmpset_int(volatile u_int *dst, u_int expect, u_int src);
109165633Sbdeu_int	atomic_fetchadd_int(volatile u_int *p, u_int v);
110254617Sjkimint	atomic_testandset_int(volatile u_int *p, u_int v);
111299912Ssepheint	atomic_testandclear_int(volatile u_int *p, u_int v);
112285283Skibvoid	atomic_thread_fence_acq(void);
113285283Skibvoid	atomic_thread_fence_acq_rel(void);
114285283Skibvoid	atomic_thread_fence_rel(void);
115285283Skibvoid	atomic_thread_fence_seq_cst(void);
11665514Sphk
117284901Skib#define	ATOMIC_LOAD(TYPE)					\
118236456Skibu_##TYPE	atomic_load_acq_##TYPE(volatile u_##TYPE *p)
119236456Skib#define	ATOMIC_STORE(TYPE)					\
120100251Smarkmvoid		atomic_store_rel_##TYPE(volatile u_##TYPE *p, u_##TYPE v)
12171085Sjhb
122254620Sjkimint		atomic_cmpset_64(volatile uint64_t *, uint64_t, uint64_t);
123254619Sjkimuint64_t	atomic_load_acq_64(volatile uint64_t *);
124254619Sjkimvoid		atomic_store_rel_64(volatile uint64_t *, uint64_t);
125254620Sjkimuint64_t	atomic_swap_64(volatile uint64_t *, uint64_t);
126254619Sjkim
127147855Sjhb#else /* !KLD_MODULE && __GNUCLIKE_ASM */
12872358Smarkm
12984679Sjhb/*
130165635Sbde * For userland, always use lock prefixes so that the binaries will run
131165635Sbde * on both SMP and !SMP systems.
13284679Sjhb */
13384679Sjhb#if defined(SMP) || !defined(_KERNEL)
134165630Sbde#define	MPLOCKED	"lock ; "
13590515Sbde#else
136147855Sjhb#define	MPLOCKED
13790515Sbde#endif
13838517Sdfr
13948797Salc/*
140197803Sattilio * The assembly is volatilized to avoid code chunk removal by the compiler.
141197803Sattilio * GCC aggressively reorders operations and memory clobbering is necessary
142197803Sattilio * in order to avoid that for memory barriers.
14348797Salc */
144147855Sjhb#define	ATOMIC_ASM(NAME, TYPE, OP, CONS, V)		\
14548797Salcstatic __inline void					\
14649043Salcatomic_##NAME##_##TYPE(volatile u_##TYPE *p, u_##TYPE v)\
14748797Salc{							\
148165630Sbde	__asm __volatile(MPLOCKED OP			\
149254612Sjkim	: "+m" (*p)					\
150254612Sjkim	: CONS (V)					\
151216524Skib	: "cc");					\
152122827Sbde}							\
153197803Sattilio							\
154197803Sattiliostatic __inline void					\
155197803Sattilioatomic_##NAME##_barr_##TYPE(volatile u_##TYPE *p, u_##TYPE v)\
156197803Sattilio{							\
157197803Sattilio	__asm __volatile(MPLOCKED OP			\
158254612Sjkim	: "+m" (*p)					\
159254612Sjkim	: CONS (V)					\
160216524Skib	: "memory", "cc");				\
161197803Sattilio}							\
162122827Sbdestruct __hack
163100327Smarkm
16465514Sphk/*
16565514Sphk * Atomic compare and set, used by the mutex functions
16665514Sphk *
167208332Sphk * if (*dst == expect) *dst = src (all 32 bit words)
16865514Sphk *
16965514Sphk * Returns 0 on failure, non-zero on success
17065514Sphk */
17165514Sphk
172165635Sbde#ifdef CPU_DISABLE_CMPXCHG
173100327Smarkm
174197910Sattiliostatic __inline int
175208332Sphkatomic_cmpset_int(volatile u_int *dst, u_int expect, u_int src)
176197910Sattilio{
177197910Sattilio	u_char res;
17865514Sphk
179197910Sattilio	__asm __volatile(
180197910Sattilio	"	pushfl ;		"
181197910Sattilio	"	cli ;			"
182254612Sjkim	"	cmpl	%3,%1 ;		"
183197910Sattilio	"	jne	1f ;		"
184197910Sattilio	"	movl	%2,%1 ;		"
185197910Sattilio	"1:				"
186197910Sattilio	"       sete	%0 ;		"
187197910Sattilio	"	popfl ;			"
188197910Sattilio	"# atomic_cmpset_int"
189197910Sattilio	: "=q" (res),			/* 0 */
190254612Sjkim	  "+m" (*dst)			/* 1 */
191197910Sattilio	: "r" (src),			/* 2 */
192254612Sjkim	  "r" (expect)			/* 3 */
193197910Sattilio	: "memory");
194197910Sattilio	return (res);
195197910Sattilio}
196197910Sattilio
197165635Sbde#else /* !CPU_DISABLE_CMPXCHG */
198100327Smarkm
199197910Sattiliostatic __inline int
200208332Sphkatomic_cmpset_int(volatile u_int *dst, u_int expect, u_int src)
201197910Sattilio{
202197910Sattilio	u_char res;
20365514Sphk
204197910Sattilio	__asm __volatile(
205197910Sattilio	"	" MPLOCKED "		"
206254614Sjkim	"	cmpxchgl %3,%1 ;	"
207197910Sattilio	"       sete	%0 ;		"
208197910Sattilio	"# atomic_cmpset_int"
209254614Sjkim	: "=q" (res),			/* 0 */
210254614Sjkim	  "+m" (*dst),			/* 1 */
211254614Sjkim	  "+a" (expect)			/* 2 */
212254614Sjkim	: "r" (src)			/* 3 */
213216524Skib	: "memory", "cc");
214197910Sattilio	return (res);
215197910Sattilio}
216197910Sattilio
217165635Sbde#endif /* CPU_DISABLE_CMPXCHG */
218100327Smarkm
219150627Sjhb/*
220150627Sjhb * Atomically add the value of v to the integer pointed to by p and return
221150627Sjhb * the previous value of *p.
222150627Sjhb */
223150627Sjhbstatic __inline u_int
224150627Sjhbatomic_fetchadd_int(volatile u_int *p, u_int v)
225150627Sjhb{
226150627Sjhb
227165633Sbde	__asm __volatile(
228165630Sbde	"	" MPLOCKED "		"
229254610Sjkim	"	xaddl	%0,%1 ;		"
230150627Sjhb	"# atomic_fetchadd_int"
231254610Sjkim	: "+r" (v),			/* 0 */
232254612Sjkim	  "+m" (*p)			/* 1 */
233254612Sjkim	: : "cc");
234150627Sjhb	return (v);
235150627Sjhb}
236150627Sjhb
237254617Sjkimstatic __inline int
238254617Sjkimatomic_testandset_int(volatile u_int *p, u_int v)
239254617Sjkim{
240254617Sjkim	u_char res;
241254617Sjkim
242254617Sjkim	__asm __volatile(
243254617Sjkim	"	" MPLOCKED "		"
244254617Sjkim	"	btsl	%2,%1 ;		"
245254617Sjkim	"	setc	%0 ;		"
246254617Sjkim	"# atomic_testandset_int"
247254617Sjkim	: "=q" (res),			/* 0 */
248254617Sjkim	  "+m" (*p)			/* 1 */
249254617Sjkim	: "Ir" (v & 0x1f)		/* 2 */
250254617Sjkim	: "cc");
251254617Sjkim	return (res);
252254617Sjkim}
253254617Sjkim
254299912Ssephestatic __inline int
255299912Ssepheatomic_testandclear_int(volatile u_int *p, u_int v)
256299912Ssephe{
257299912Ssephe	u_char res;
258299912Ssephe
259299912Ssephe	__asm __volatile(
260299912Ssephe	"	" MPLOCKED "		"
261299912Ssephe	"	btrl	%2,%1 ;		"
262299912Ssephe	"	setc	%0 ;		"
263299912Ssephe	"# atomic_testandclear_int"
264299912Ssephe	: "=q" (res),			/* 0 */
265299912Ssephe	  "+m" (*p)			/* 1 */
266299912Ssephe	: "Ir" (v & 0x1f)		/* 2 */
267299912Ssephe	: "cc");
268299912Ssephe	return (res);
269299912Ssephe}
270299912Ssephe
271236456Skib/*
272236456Skib * We assume that a = b will do atomic loads and stores.  Due to the
273236456Skib * IA32 memory model, a simple store guarantees release semantics.
274236456Skib *
275284901Skib * However, a load may pass a store if they are performed on distinct
276286050Skib * addresses, so we need Store/Load barrier for sequentially
277286050Skib * consistent fences in SMP kernels.  We use "lock addl $0,mem" for a
278286050Skib * Store/Load barrier, as recommended by the AMD Software Optimization
279286050Skib * Guide, and not mfence.  In the kernel, we use a private per-cpu
280286078Skib * cache line for "mem", to avoid introducing false data
281286078Skib * dependencies.  In user space, we use the word at the top of the
282286078Skib * stack.
283284901Skib *
284284901Skib * For UP kernels, however, the memory of the single processor is
285284901Skib * always consistent, so we only need to stop the compiler from
286284901Skib * reordering accesses in a way that violates the semantics of acquire
287284901Skib * and release.
288236456Skib */
289286051Skib
290284901Skib#if defined(_KERNEL)
291284901Skib#if defined(SMP)
292286051Skib#define	__storeload_barrier()	__mbk()
293284901Skib#else /* _KERNEL && UP */
294286051Skib#define	__storeload_barrier()	__compiler_membar()
295284901Skib#endif /* SMP */
296284901Skib#else /* !_KERNEL */
297286051Skib#define	__storeload_barrier()	__mbu()
298284901Skib#endif /* _KERNEL*/
299284901Skib
300284901Skib#define	ATOMIC_LOAD(TYPE)					\
301284901Skibstatic __inline u_##TYPE					\
302284901Skibatomic_load_acq_##TYPE(volatile u_##TYPE *p)			\
303284901Skib{								\
304284901Skib	u_##TYPE res;						\
305284901Skib								\
306284901Skib	res = *p;						\
307284901Skib	__compiler_membar();					\
308284901Skib	return (res);						\
309284901Skib}								\
310122827Sbdestruct __hack
311100327Smarkm
312284901Skib#define	ATOMIC_STORE(TYPE)					\
313284901Skibstatic __inline void						\
314284901Skibatomic_store_rel_##TYPE(volatile u_##TYPE *p, u_##TYPE v)	\
315284901Skib{								\
316284901Skib								\
317284901Skib	__compiler_membar();					\
318284901Skib	*p = v;							\
319284901Skib}								\
320284901Skibstruct __hack
321100327Smarkm
322285283Skibstatic __inline void
323285283Skibatomic_thread_fence_acq(void)
324285283Skib{
325285283Skib
326285283Skib	__compiler_membar();
327285283Skib}
328285283Skib
329285283Skibstatic __inline void
330285283Skibatomic_thread_fence_rel(void)
331285283Skib{
332285283Skib
333285283Skib	__compiler_membar();
334285283Skib}
335285283Skib
336285283Skibstatic __inline void
337285283Skibatomic_thread_fence_acq_rel(void)
338285283Skib{
339285283Skib
340285283Skib	__compiler_membar();
341285283Skib}
342285283Skib
343285283Skibstatic __inline void
344285283Skibatomic_thread_fence_seq_cst(void)
345285283Skib{
346285283Skib
347285283Skib	__storeload_barrier();
348285283Skib}
349285283Skib
350254619Sjkim#ifdef _KERNEL
351254619Sjkim
352254619Sjkim#ifdef WANT_FUNCTIONS
353254620Sjkimint		atomic_cmpset_64_i386(volatile uint64_t *, uint64_t, uint64_t);
354254620Sjkimint		atomic_cmpset_64_i586(volatile uint64_t *, uint64_t, uint64_t);
355254619Sjkimuint64_t	atomic_load_acq_64_i386(volatile uint64_t *);
356254619Sjkimuint64_t	atomic_load_acq_64_i586(volatile uint64_t *);
357254619Sjkimvoid		atomic_store_rel_64_i386(volatile uint64_t *, uint64_t);
358254619Sjkimvoid		atomic_store_rel_64_i586(volatile uint64_t *, uint64_t);
359254620Sjkimuint64_t	atomic_swap_64_i386(volatile uint64_t *, uint64_t);
360254620Sjkimuint64_t	atomic_swap_64_i586(volatile uint64_t *, uint64_t);
361254619Sjkim#endif
362254619Sjkim
363254619Sjkim/* I486 does not support SMP or CMPXCHG8B. */
364254620Sjkimstatic __inline int
365254620Sjkimatomic_cmpset_64_i386(volatile uint64_t *dst, uint64_t expect, uint64_t src)
366254620Sjkim{
367254620Sjkim	volatile uint32_t *p;
368254620Sjkim	u_char res;
369254620Sjkim
370254620Sjkim	p = (volatile uint32_t *)dst;
371254620Sjkim	__asm __volatile(
372254620Sjkim	"	pushfl ;		"
373254620Sjkim	"	cli ;			"
374254620Sjkim	"	xorl	%1,%%eax ;	"
375254620Sjkim	"	xorl	%2,%%edx ;	"
376254620Sjkim	"	orl	%%edx,%%eax ;	"
377254620Sjkim	"	jne	1f ;		"
378254620Sjkim	"	movl	%4,%1 ;		"
379254620Sjkim	"	movl	%5,%2 ;		"
380254620Sjkim	"1:				"
381254620Sjkim	"	sete	%3 ;		"
382254620Sjkim	"	popfl"
383254620Sjkim	: "+A" (expect),		/* 0 */
384254620Sjkim	  "+m" (*p),			/* 1 */
385254620Sjkim	  "+m" (*(p + 1)),		/* 2 */
386254620Sjkim	  "=q" (res)			/* 3 */
387254620Sjkim	: "r" ((uint32_t)src),		/* 4 */
388254620Sjkim	  "r" ((uint32_t)(src >> 32))	/* 5 */
389254620Sjkim	: "memory", "cc");
390254620Sjkim	return (res);
391254620Sjkim}
392254620Sjkim
393254619Sjkimstatic __inline uint64_t
394254619Sjkimatomic_load_acq_64_i386(volatile uint64_t *p)
395254619Sjkim{
396254619Sjkim	volatile uint32_t *q;
397254619Sjkim	uint64_t res;
398254619Sjkim
399254619Sjkim	q = (volatile uint32_t *)p;
400254619Sjkim	__asm __volatile(
401254619Sjkim	"	pushfl ;		"
402254619Sjkim	"	cli ;			"
403254619Sjkim	"	movl	%1,%%eax ;	"
404254619Sjkim	"	movl	%2,%%edx ;	"
405254619Sjkim	"	popfl"
406254619Sjkim	: "=&A" (res)			/* 0 */
407254619Sjkim	: "m" (*q),			/* 1 */
408254619Sjkim	  "m" (*(q + 1))		/* 2 */
409254619Sjkim	: "memory");
410254619Sjkim	return (res);
411254619Sjkim}
412254619Sjkim
413254619Sjkimstatic __inline void
414254619Sjkimatomic_store_rel_64_i386(volatile uint64_t *p, uint64_t v)
415254619Sjkim{
416254619Sjkim	volatile uint32_t *q;
417254619Sjkim
418254619Sjkim	q = (volatile uint32_t *)p;
419254619Sjkim	__asm __volatile(
420254619Sjkim	"	pushfl ;		"
421254619Sjkim	"	cli ;			"
422254619Sjkim	"	movl	%%eax,%0 ;	"
423254619Sjkim	"	movl	%%edx,%1 ;	"
424254619Sjkim	"	popfl"
425254619Sjkim	: "=m" (*q),			/* 0 */
426254619Sjkim	  "=m" (*(q + 1))		/* 1 */
427254619Sjkim	: "A" (v)			/* 2 */
428254619Sjkim	: "memory");
429254619Sjkim}
430254619Sjkim
431254619Sjkimstatic __inline uint64_t
432254620Sjkimatomic_swap_64_i386(volatile uint64_t *p, uint64_t v)
433254620Sjkim{
434254620Sjkim	volatile uint32_t *q;
435254620Sjkim	uint64_t res;
436254620Sjkim
437254620Sjkim	q = (volatile uint32_t *)p;
438254620Sjkim	__asm __volatile(
439254620Sjkim	"	pushfl ;		"
440254620Sjkim	"	cli ;			"
441254620Sjkim	"	movl	%1,%%eax ;	"
442254620Sjkim	"	movl	%2,%%edx ;	"
443254620Sjkim	"	movl	%4,%2 ;		"
444254620Sjkim	"	movl	%3,%1 ;		"
445254620Sjkim	"	popfl"
446254620Sjkim	: "=&A" (res),			/* 0 */
447254620Sjkim	  "+m" (*q),			/* 1 */
448254620Sjkim	  "+m" (*(q + 1))		/* 2 */
449254620Sjkim	: "r" ((uint32_t)v),		/* 3 */
450254620Sjkim	  "r" ((uint32_t)(v >> 32)));	/* 4 */
451254620Sjkim	return (res);
452254620Sjkim}
453254620Sjkim
454254620Sjkimstatic __inline int
455254620Sjkimatomic_cmpset_64_i586(volatile uint64_t *dst, uint64_t expect, uint64_t src)
456254620Sjkim{
457254620Sjkim	u_char res;
458254620Sjkim
459254620Sjkim	__asm __volatile(
460254620Sjkim	"	" MPLOCKED "		"
461254620Sjkim	"	cmpxchg8b %1 ;		"
462254620Sjkim	"	sete	%0"
463254620Sjkim	: "=q" (res),			/* 0 */
464254620Sjkim	  "+m" (*dst),			/* 1 */
465254620Sjkim	  "+A" (expect)			/* 2 */
466254620Sjkim	: "b" ((uint32_t)src),		/* 3 */
467254620Sjkim	  "c" ((uint32_t)(src >> 32))	/* 4 */
468254620Sjkim	: "memory", "cc");
469254620Sjkim	return (res);
470254620Sjkim}
471254620Sjkim
472254620Sjkimstatic __inline uint64_t
473254619Sjkimatomic_load_acq_64_i586(volatile uint64_t *p)
474254619Sjkim{
475254619Sjkim	uint64_t res;
476254619Sjkim
477254619Sjkim	__asm __volatile(
478254619Sjkim	"	movl	%%ebx,%%eax ;	"
479254619Sjkim	"	movl	%%ecx,%%edx ;	"
480254619Sjkim	"	" MPLOCKED "		"
481254619Sjkim	"	cmpxchg8b %1"
482254619Sjkim	: "=&A" (res),			/* 0 */
483254619Sjkim	  "+m" (*p)			/* 1 */
484254619Sjkim	: : "memory", "cc");
485254619Sjkim	return (res);
486254619Sjkim}
487254619Sjkim
488254619Sjkimstatic __inline void
489254619Sjkimatomic_store_rel_64_i586(volatile uint64_t *p, uint64_t v)
490254619Sjkim{
491254619Sjkim
492254619Sjkim	__asm __volatile(
493254619Sjkim	"	movl	%%eax,%%ebx ;	"
494254619Sjkim	"	movl	%%edx,%%ecx ;	"
495254619Sjkim	"1:				"
496254619Sjkim	"	" MPLOCKED "		"
497254619Sjkim	"	cmpxchg8b %0 ;		"
498254619Sjkim	"	jne	1b"
499254619Sjkim	: "+m" (*p),			/* 0 */
500254619Sjkim	  "+A" (v)			/* 1 */
501254619Sjkim	: : "ebx", "ecx", "memory", "cc");
502254619Sjkim}
503254619Sjkim
504254619Sjkimstatic __inline uint64_t
505254620Sjkimatomic_swap_64_i586(volatile uint64_t *p, uint64_t v)
506254620Sjkim{
507254620Sjkim
508254620Sjkim	__asm __volatile(
509254620Sjkim	"	movl	%%eax,%%ebx ;	"
510254620Sjkim	"	movl	%%edx,%%ecx ;	"
511254620Sjkim	"1:				"
512254620Sjkim	"	" MPLOCKED "		"
513254620Sjkim	"	cmpxchg8b %0 ;		"
514254620Sjkim	"	jne	1b"
515254620Sjkim	: "+m" (*p),			/* 0 */
516254620Sjkim	  "+A" (v)			/* 1 */
517254620Sjkim	: : "ebx", "ecx", "memory", "cc");
518254620Sjkim	return (v);
519254620Sjkim}
520254620Sjkim
521254620Sjkimstatic __inline int
522254620Sjkimatomic_cmpset_64(volatile uint64_t *dst, uint64_t expect, uint64_t src)
523254620Sjkim{
524254620Sjkim
525254620Sjkim	if ((cpu_feature & CPUID_CX8) == 0)
526254620Sjkim		return (atomic_cmpset_64_i386(dst, expect, src));
527254620Sjkim	else
528254620Sjkim		return (atomic_cmpset_64_i586(dst, expect, src));
529254620Sjkim}
530254620Sjkim
531254620Sjkimstatic __inline uint64_t
532254619Sjkimatomic_load_acq_64(volatile uint64_t *p)
533254619Sjkim{
534254619Sjkim
535254619Sjkim	if ((cpu_feature & CPUID_CX8) == 0)
536254619Sjkim		return (atomic_load_acq_64_i386(p));
537254619Sjkim	else
538254619Sjkim		return (atomic_load_acq_64_i586(p));
539254619Sjkim}
540254619Sjkim
541254619Sjkimstatic __inline void
542254619Sjkimatomic_store_rel_64(volatile uint64_t *p, uint64_t v)
543254619Sjkim{
544254619Sjkim
545254619Sjkim	if ((cpu_feature & CPUID_CX8) == 0)
546254619Sjkim		atomic_store_rel_64_i386(p, v);
547254619Sjkim	else
548254619Sjkim		atomic_store_rel_64_i586(p, v);
549254619Sjkim}
550254619Sjkim
551254620Sjkimstatic __inline uint64_t
552254620Sjkimatomic_swap_64(volatile uint64_t *p, uint64_t v)
553254620Sjkim{
554254620Sjkim
555254620Sjkim	if ((cpu_feature & CPUID_CX8) == 0)
556254620Sjkim		return (atomic_swap_64_i386(p, v));
557254620Sjkim	else
558254620Sjkim		return (atomic_swap_64_i586(p, v));
559254620Sjkim}
560254620Sjkim
561254619Sjkim#endif /* _KERNEL */
562254619Sjkim
563147855Sjhb#endif /* KLD_MODULE || !__GNUCLIKE_ASM */
564100251Smarkm
565100251SmarkmATOMIC_ASM(set,	     char,  "orb %b1,%0",  "iq",  v);
566100251SmarkmATOMIC_ASM(clear,    char,  "andb %b1,%0", "iq", ~v);
567100251SmarkmATOMIC_ASM(add,	     char,  "addb %b1,%0", "iq",  v);
568100251SmarkmATOMIC_ASM(subtract, char,  "subb %b1,%0", "iq",  v);
56971085Sjhb
570100251SmarkmATOMIC_ASM(set,	     short, "orw %w1,%0",  "ir",  v);
571100251SmarkmATOMIC_ASM(clear,    short, "andw %w1,%0", "ir", ~v);
572100251SmarkmATOMIC_ASM(add,	     short, "addw %w1,%0", "ir",  v);
573100251SmarkmATOMIC_ASM(subtract, short, "subw %w1,%0", "ir",  v);
57471085Sjhb
575100251SmarkmATOMIC_ASM(set,	     int,   "orl %1,%0",   "ir",  v);
576100251SmarkmATOMIC_ASM(clear,    int,   "andl %1,%0",  "ir", ~v);
577100251SmarkmATOMIC_ASM(add,	     int,   "addl %1,%0",  "ir",  v);
578100251SmarkmATOMIC_ASM(subtract, int,   "subl %1,%0",  "ir",  v);
57971085Sjhb
580100251SmarkmATOMIC_ASM(set,	     long,  "orl %1,%0",   "ir",  v);
581100251SmarkmATOMIC_ASM(clear,    long,  "andl %1,%0",  "ir", ~v);
582100251SmarkmATOMIC_ASM(add,	     long,  "addl %1,%0",  "ir",  v);
583100251SmarkmATOMIC_ASM(subtract, long,  "subl %1,%0",  "ir",  v);
58471085Sjhb
585284901Skib#define	ATOMIC_LOADSTORE(TYPE)				\
586284901Skib	ATOMIC_LOAD(TYPE);				\
587284901Skib	ATOMIC_STORE(TYPE)
58871023Sjhb
589284901SkibATOMIC_LOADSTORE(char);
590284901SkibATOMIC_LOADSTORE(short);
591284901SkibATOMIC_LOADSTORE(int);
592284901SkibATOMIC_LOADSTORE(long);
593236456Skib
59471085Sjhb#undef ATOMIC_ASM
595236456Skib#undef ATOMIC_LOAD
596236456Skib#undef ATOMIC_STORE
597284901Skib#undef ATOMIC_LOADSTORE
59867351Sjhb
599165635Sbde#ifndef WANT_FUNCTIONS
600147855Sjhb
601147855Sjhbstatic __inline int
602208332Sphkatomic_cmpset_long(volatile u_long *dst, u_long expect, u_long src)
603147855Sjhb{
604147855Sjhb
605208332Sphk	return (atomic_cmpset_int((volatile u_int *)dst, (u_int)expect,
606147855Sjhb	    (u_int)src));
607147855Sjhb}
608147855Sjhb
609177276Spjdstatic __inline u_long
610177276Spjdatomic_fetchadd_long(volatile u_long *p, u_long v)
611177276Spjd{
612177276Spjd
613177276Spjd	return (atomic_fetchadd_int((volatile u_int *)p, (u_int)v));
614177276Spjd}
615177276Spjd
616254617Sjkimstatic __inline int
617254617Sjkimatomic_testandset_long(volatile u_long *p, u_int v)
618254617Sjkim{
619254617Sjkim
620254617Sjkim	return (atomic_testandset_int((volatile u_int *)p, v));
621254617Sjkim}
622254617Sjkim
623299912Ssephestatic __inline int
624299912Ssepheatomic_testandclear_long(volatile u_long *p, u_int v)
625299912Ssephe{
626299912Ssephe
627299912Ssephe	return (atomic_testandclear_int((volatile u_int *)p, v));
628299912Ssephe}
629299912Ssephe
630254617Sjkim/* Read the current value and store a new value in the destination. */
631147855Sjhb#ifdef __GNUCLIKE_ASM
632147855Sjhb
633147855Sjhbstatic __inline u_int
634254617Sjkimatomic_swap_int(volatile u_int *p, u_int v)
635147855Sjhb{
636147855Sjhb
637165633Sbde	__asm __volatile(
638147855Sjhb	"	xchgl	%1,%0 ;		"
639254617Sjkim	"# atomic_swap_int"
640254617Sjkim	: "+r" (v),			/* 0 */
641254612Sjkim	  "+m" (*p));			/* 1 */
642254617Sjkim	return (v);
643147855Sjhb}
644147855Sjhb
645147855Sjhbstatic __inline u_long
646254617Sjkimatomic_swap_long(volatile u_long *p, u_long v)
647147855Sjhb{
648147855Sjhb
649254617Sjkim	return (atomic_swap_int((volatile u_int *)p, (u_int)v));
650147855Sjhb}
651147855Sjhb
652147855Sjhb#else /* !__GNUCLIKE_ASM */
653147855Sjhb
654254617Sjkimu_int	atomic_swap_int(volatile u_int *p, u_int v);
655254617Sjkimu_long	atomic_swap_long(volatile u_long *p, u_long v);
656147855Sjhb
657147855Sjhb#endif /* __GNUCLIKE_ASM */
658147855Sjhb
659197803Sattilio#define	atomic_set_acq_char		atomic_set_barr_char
660197803Sattilio#define	atomic_set_rel_char		atomic_set_barr_char
661197803Sattilio#define	atomic_clear_acq_char		atomic_clear_barr_char
662197803Sattilio#define	atomic_clear_rel_char		atomic_clear_barr_char
663197803Sattilio#define	atomic_add_acq_char		atomic_add_barr_char
664197803Sattilio#define	atomic_add_rel_char		atomic_add_barr_char
665197803Sattilio#define	atomic_subtract_acq_char	atomic_subtract_barr_char
666197803Sattilio#define	atomic_subtract_rel_char	atomic_subtract_barr_char
66771085Sjhb
668197803Sattilio#define	atomic_set_acq_short		atomic_set_barr_short
669197803Sattilio#define	atomic_set_rel_short		atomic_set_barr_short
670197803Sattilio#define	atomic_clear_acq_short		atomic_clear_barr_short
671197803Sattilio#define	atomic_clear_rel_short		atomic_clear_barr_short
672197803Sattilio#define	atomic_add_acq_short		atomic_add_barr_short
673197803Sattilio#define	atomic_add_rel_short		atomic_add_barr_short
674197803Sattilio#define	atomic_subtract_acq_short	atomic_subtract_barr_short
675197803Sattilio#define	atomic_subtract_rel_short	atomic_subtract_barr_short
67671085Sjhb
677197803Sattilio#define	atomic_set_acq_int		atomic_set_barr_int
678197803Sattilio#define	atomic_set_rel_int		atomic_set_barr_int
679197803Sattilio#define	atomic_clear_acq_int		atomic_clear_barr_int
680197803Sattilio#define	atomic_clear_rel_int		atomic_clear_barr_int
681197803Sattilio#define	atomic_add_acq_int		atomic_add_barr_int
682197803Sattilio#define	atomic_add_rel_int		atomic_add_barr_int
683197803Sattilio#define	atomic_subtract_acq_int		atomic_subtract_barr_int
684197803Sattilio#define	atomic_subtract_rel_int		atomic_subtract_barr_int
685197910Sattilio#define	atomic_cmpset_acq_int		atomic_cmpset_int
686197910Sattilio#define	atomic_cmpset_rel_int		atomic_cmpset_int
68771085Sjhb
688197803Sattilio#define	atomic_set_acq_long		atomic_set_barr_long
689197803Sattilio#define	atomic_set_rel_long		atomic_set_barr_long
690197803Sattilio#define	atomic_clear_acq_long		atomic_clear_barr_long
691197803Sattilio#define	atomic_clear_rel_long		atomic_clear_barr_long
692197803Sattilio#define	atomic_add_acq_long		atomic_add_barr_long
693197803Sattilio#define	atomic_add_rel_long		atomic_add_barr_long
694197803Sattilio#define	atomic_subtract_acq_long	atomic_subtract_barr_long
695197803Sattilio#define	atomic_subtract_rel_long	atomic_subtract_barr_long
696197910Sattilio#define	atomic_cmpset_acq_long		atomic_cmpset_long
697197910Sattilio#define	atomic_cmpset_rel_long		atomic_cmpset_long
69871085Sjhb
699254617Sjkim#define	atomic_readandclear_int(p)	atomic_swap_int(p, 0)
700254617Sjkim#define	atomic_readandclear_long(p)	atomic_swap_long(p, 0)
701254617Sjkim
702147855Sjhb/* Operations on 8-bit bytes. */
70371085Sjhb#define	atomic_set_8		atomic_set_char
70471085Sjhb#define	atomic_set_acq_8	atomic_set_acq_char
70571085Sjhb#define	atomic_set_rel_8	atomic_set_rel_char
70671085Sjhb#define	atomic_clear_8		atomic_clear_char
70771085Sjhb#define	atomic_clear_acq_8	atomic_clear_acq_char
70871085Sjhb#define	atomic_clear_rel_8	atomic_clear_rel_char
70971085Sjhb#define	atomic_add_8		atomic_add_char
71071085Sjhb#define	atomic_add_acq_8	atomic_add_acq_char
71171085Sjhb#define	atomic_add_rel_8	atomic_add_rel_char
71271085Sjhb#define	atomic_subtract_8	atomic_subtract_char
71371085Sjhb#define	atomic_subtract_acq_8	atomic_subtract_acq_char
71471085Sjhb#define	atomic_subtract_rel_8	atomic_subtract_rel_char
71571085Sjhb#define	atomic_load_acq_8	atomic_load_acq_char
71671085Sjhb#define	atomic_store_rel_8	atomic_store_rel_char
71771085Sjhb
718147855Sjhb/* Operations on 16-bit words. */
71971085Sjhb#define	atomic_set_16		atomic_set_short
72071085Sjhb#define	atomic_set_acq_16	atomic_set_acq_short
72171085Sjhb#define	atomic_set_rel_16	atomic_set_rel_short
72271085Sjhb#define	atomic_clear_16		atomic_clear_short
72371085Sjhb#define	atomic_clear_acq_16	atomic_clear_acq_short
72471085Sjhb#define	atomic_clear_rel_16	atomic_clear_rel_short
72571085Sjhb#define	atomic_add_16		atomic_add_short
72671085Sjhb#define	atomic_add_acq_16	atomic_add_acq_short
72771085Sjhb#define	atomic_add_rel_16	atomic_add_rel_short
72871085Sjhb#define	atomic_subtract_16	atomic_subtract_short
72971085Sjhb#define	atomic_subtract_acq_16	atomic_subtract_acq_short
73071085Sjhb#define	atomic_subtract_rel_16	atomic_subtract_rel_short
73171085Sjhb#define	atomic_load_acq_16	atomic_load_acq_short
73271085Sjhb#define	atomic_store_rel_16	atomic_store_rel_short
73371085Sjhb
734147855Sjhb/* Operations on 32-bit double words. */
73571085Sjhb#define	atomic_set_32		atomic_set_int
73671085Sjhb#define	atomic_set_acq_32	atomic_set_acq_int
73771085Sjhb#define	atomic_set_rel_32	atomic_set_rel_int
73871085Sjhb#define	atomic_clear_32		atomic_clear_int
73971085Sjhb#define	atomic_clear_acq_32	atomic_clear_acq_int
74071085Sjhb#define	atomic_clear_rel_32	atomic_clear_rel_int
74171085Sjhb#define	atomic_add_32		atomic_add_int
74271085Sjhb#define	atomic_add_acq_32	atomic_add_acq_int
74371085Sjhb#define	atomic_add_rel_32	atomic_add_rel_int
74471085Sjhb#define	atomic_subtract_32	atomic_subtract_int
74571085Sjhb#define	atomic_subtract_acq_32	atomic_subtract_acq_int
74671085Sjhb#define	atomic_subtract_rel_32	atomic_subtract_rel_int
74771085Sjhb#define	atomic_load_acq_32	atomic_load_acq_int
74871085Sjhb#define	atomic_store_rel_32	atomic_store_rel_int
74971085Sjhb#define	atomic_cmpset_32	atomic_cmpset_int
75071085Sjhb#define	atomic_cmpset_acq_32	atomic_cmpset_acq_int
75171085Sjhb#define	atomic_cmpset_rel_32	atomic_cmpset_rel_int
752254617Sjkim#define	atomic_swap_32		atomic_swap_int
75371085Sjhb#define	atomic_readandclear_32	atomic_readandclear_int
754150627Sjhb#define	atomic_fetchadd_32	atomic_fetchadd_int
755254617Sjkim#define	atomic_testandset_32	atomic_testandset_int
756299912Ssephe#define	atomic_testandclear_32	atomic_testandclear_int
75771085Sjhb
758147855Sjhb/* Operations on pointers. */
759157212Sdes#define	atomic_set_ptr(p, v) \
760157212Sdes	atomic_set_int((volatile u_int *)(p), (u_int)(v))
761157212Sdes#define	atomic_set_acq_ptr(p, v) \
762157212Sdes	atomic_set_acq_int((volatile u_int *)(p), (u_int)(v))
763157212Sdes#define	atomic_set_rel_ptr(p, v) \
764157212Sdes	atomic_set_rel_int((volatile u_int *)(p), (u_int)(v))
765157212Sdes#define	atomic_clear_ptr(p, v) \
766157212Sdes	atomic_clear_int((volatile u_int *)(p), (u_int)(v))
767157212Sdes#define	atomic_clear_acq_ptr(p, v) \
768157212Sdes	atomic_clear_acq_int((volatile u_int *)(p), (u_int)(v))
769157212Sdes#define	atomic_clear_rel_ptr(p, v) \
770157212Sdes	atomic_clear_rel_int((volatile u_int *)(p), (u_int)(v))
771157212Sdes#define	atomic_add_ptr(p, v) \
772157212Sdes	atomic_add_int((volatile u_int *)(p), (u_int)(v))
773157212Sdes#define	atomic_add_acq_ptr(p, v) \
774157212Sdes	atomic_add_acq_int((volatile u_int *)(p), (u_int)(v))
775157212Sdes#define	atomic_add_rel_ptr(p, v) \
776157212Sdes	atomic_add_rel_int((volatile u_int *)(p), (u_int)(v))
777157212Sdes#define	atomic_subtract_ptr(p, v) \
778157212Sdes	atomic_subtract_int((volatile u_int *)(p), (u_int)(v))
779157212Sdes#define	atomic_subtract_acq_ptr(p, v) \
780157212Sdes	atomic_subtract_acq_int((volatile u_int *)(p), (u_int)(v))
781157212Sdes#define	atomic_subtract_rel_ptr(p, v) \
782157212Sdes	atomic_subtract_rel_int((volatile u_int *)(p), (u_int)(v))
783157212Sdes#define	atomic_load_acq_ptr(p) \
784157212Sdes	atomic_load_acq_int((volatile u_int *)(p))
785157212Sdes#define	atomic_store_rel_ptr(p, v) \
786157212Sdes	atomic_store_rel_int((volatile u_int *)(p), (v))
787157212Sdes#define	atomic_cmpset_ptr(dst, old, new) \
788157212Sdes	atomic_cmpset_int((volatile u_int *)(dst), (u_int)(old), (u_int)(new))
789157212Sdes#define	atomic_cmpset_acq_ptr(dst, old, new) \
790165633Sbde	atomic_cmpset_acq_int((volatile u_int *)(dst), (u_int)(old), \
791165633Sbde	    (u_int)(new))
792157212Sdes#define	atomic_cmpset_rel_ptr(dst, old, new) \
793165633Sbde	atomic_cmpset_rel_int((volatile u_int *)(dst), (u_int)(old), \
794165633Sbde	    (u_int)(new))
795254617Sjkim#define	atomic_swap_ptr(p, v) \
796254617Sjkim	atomic_swap_int((volatile u_int *)(p), (u_int)(v))
797157212Sdes#define	atomic_readandclear_ptr(p) \
798157212Sdes	atomic_readandclear_int((volatile u_int *)(p))
79965514Sphk
800165635Sbde#endif /* !WANT_FUNCTIONS */
801165633Sbde
802286051Skib#if defined(_KERNEL)
803286051Skib#define	mb()	__mbk()
804286051Skib#define	wmb()	__mbk()
805286051Skib#define	rmb()	__mbk()
806286051Skib#else
807286051Skib#define	mb()	__mbu()
808286051Skib#define	wmb()	__mbu()
809286051Skib#define	rmb()	__mbu()
810286051Skib#endif
811286051Skib
812165633Sbde#endif /* !_MACHINE_ATOMIC_H_ */
813