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