13b7917d7SPawel Jakub Dawidek /*-
23b7917d7SPawel Jakub Dawidek * Copyright (c) 2007 Pawel Jakub Dawidek <pjd@FreeBSD.org>
33b7917d7SPawel Jakub Dawidek * All rights reserved.
43b7917d7SPawel Jakub Dawidek *
53b7917d7SPawel Jakub Dawidek * Redistribution and use in source and binary forms, with or without
63b7917d7SPawel Jakub Dawidek * modification, are permitted provided that the following conditions
73b7917d7SPawel Jakub Dawidek * are met:
83b7917d7SPawel Jakub Dawidek * 1. Redistributions of source code must retain the above copyright
93b7917d7SPawel Jakub Dawidek * notice, this list of conditions and the following disclaimer.
103b7917d7SPawel Jakub Dawidek * 2. Redistributions in binary form must reproduce the above copyright
113b7917d7SPawel Jakub Dawidek * notice, this list of conditions and the following disclaimer in the
123b7917d7SPawel Jakub Dawidek * documentation and/or other materials provided with the distribution.
133b7917d7SPawel Jakub Dawidek *
143b7917d7SPawel Jakub Dawidek * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
153b7917d7SPawel Jakub Dawidek * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
163b7917d7SPawel Jakub Dawidek * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
173b7917d7SPawel Jakub Dawidek * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
183b7917d7SPawel Jakub Dawidek * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
193b7917d7SPawel Jakub Dawidek * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
203b7917d7SPawel Jakub Dawidek * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
213b7917d7SPawel Jakub Dawidek * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
223b7917d7SPawel Jakub Dawidek * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
233b7917d7SPawel Jakub Dawidek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
243b7917d7SPawel Jakub Dawidek * SUCH DAMAGE.
253b7917d7SPawel Jakub Dawidek */
263b7917d7SPawel Jakub Dawidek
273b7917d7SPawel Jakub Dawidek #include <sys/param.h>
283b7917d7SPawel Jakub Dawidek #include <sys/lock.h>
293b7917d7SPawel Jakub Dawidek #include <sys/mutex.h>
303b7917d7SPawel Jakub Dawidek #include <sys/atomic.h>
313b7917d7SPawel Jakub Dawidek
32f5c4c720SAndriy Gapon #if !defined(__LP64__) && !defined(__mips_n32) && \
33*9aafc7c0SBrandon Bergren !defined(ARM_HAVE_ATOMIC64) && !defined(I386_HAVE_ATOMIC64) && \
34*9aafc7c0SBrandon Bergren !defined(HAS_EMULATED_ATOMIC64)
35f5c4c720SAndriy Gapon
363b7917d7SPawel Jakub Dawidek #ifdef _KERNEL
373b7917d7SPawel Jakub Dawidek #include <sys/kernel.h>
383b7917d7SPawel Jakub Dawidek
393b7917d7SPawel Jakub Dawidek struct mtx atomic_mtx;
403b7917d7SPawel Jakub Dawidek MTX_SYSINIT(atomic, &atomic_mtx, "atomic", MTX_DEF);
413b7917d7SPawel Jakub Dawidek #else
423b7917d7SPawel Jakub Dawidek #include <pthread.h>
433b7917d7SPawel Jakub Dawidek
443b7917d7SPawel Jakub Dawidek #define mtx_lock(lock) pthread_mutex_lock(lock)
453b7917d7SPawel Jakub Dawidek #define mtx_unlock(lock) pthread_mutex_unlock(lock)
463b7917d7SPawel Jakub Dawidek
473b7917d7SPawel Jakub Dawidek static pthread_mutex_t atomic_mtx;
483b7917d7SPawel Jakub Dawidek
493b7917d7SPawel Jakub Dawidek static __attribute__((constructor)) void
atomic_init(void)503b7917d7SPawel Jakub Dawidek atomic_init(void)
513b7917d7SPawel Jakub Dawidek {
523b7917d7SPawel Jakub Dawidek pthread_mutex_init(&atomic_mtx, NULL);
533b7917d7SPawel Jakub Dawidek }
543b7917d7SPawel Jakub Dawidek #endif
553b7917d7SPawel Jakub Dawidek
563b7917d7SPawel Jakub Dawidek void
atomic_add_64(volatile uint64_t * target,int64_t delta)573b7917d7SPawel Jakub Dawidek atomic_add_64(volatile uint64_t *target, int64_t delta)
583b7917d7SPawel Jakub Dawidek {
593b7917d7SPawel Jakub Dawidek
603b7917d7SPawel Jakub Dawidek mtx_lock(&atomic_mtx);
613b7917d7SPawel Jakub Dawidek *target += delta;
623b7917d7SPawel Jakub Dawidek mtx_unlock(&atomic_mtx);
633b7917d7SPawel Jakub Dawidek }
641ba4a712SPawel Jakub Dawidek
651ba4a712SPawel Jakub Dawidek void
atomic_dec_64(volatile uint64_t * target)661ba4a712SPawel Jakub Dawidek atomic_dec_64(volatile uint64_t *target)
671ba4a712SPawel Jakub Dawidek {
681ba4a712SPawel Jakub Dawidek
691ba4a712SPawel Jakub Dawidek mtx_lock(&atomic_mtx);
701ba4a712SPawel Jakub Dawidek *target -= 1;
711ba4a712SPawel Jakub Dawidek mtx_unlock(&atomic_mtx);
721ba4a712SPawel Jakub Dawidek }
73cf78c4beSAndriy Gapon
74cf78c4beSAndriy Gapon uint64_t
atomic_swap_64(volatile uint64_t * a,uint64_t value)75cf78c4beSAndriy Gapon atomic_swap_64(volatile uint64_t *a, uint64_t value)
76cf78c4beSAndriy Gapon {
77cf78c4beSAndriy Gapon uint64_t ret;
78cf78c4beSAndriy Gapon
79cf78c4beSAndriy Gapon mtx_lock(&atomic_mtx);
80cf78c4beSAndriy Gapon ret = *a;
81cf78c4beSAndriy Gapon *a = value;
82cf78c4beSAndriy Gapon mtx_unlock(&atomic_mtx);
83cf78c4beSAndriy Gapon return (ret);
84cf78c4beSAndriy Gapon }
85cf78c4beSAndriy Gapon
86cf78c4beSAndriy Gapon uint64_t
atomic_load_64(volatile uint64_t * a)87cf78c4beSAndriy Gapon atomic_load_64(volatile uint64_t *a)
88cf78c4beSAndriy Gapon {
89cf78c4beSAndriy Gapon uint64_t ret;
90cf78c4beSAndriy Gapon
91cf78c4beSAndriy Gapon mtx_lock(&atomic_mtx);
92cf78c4beSAndriy Gapon ret = *a;
93cf78c4beSAndriy Gapon mtx_unlock(&atomic_mtx);
94cf78c4beSAndriy Gapon return (ret);
95cf78c4beSAndriy Gapon }
963b7917d7SPawel Jakub Dawidek
973b7917d7SPawel Jakub Dawidek uint64_t
atomic_add_64_nv(volatile uint64_t * target,int64_t delta)983b7917d7SPawel Jakub Dawidek atomic_add_64_nv(volatile uint64_t *target, int64_t delta)
993b7917d7SPawel Jakub Dawidek {
1003b7917d7SPawel Jakub Dawidek uint64_t newval;
1013b7917d7SPawel Jakub Dawidek
1023b7917d7SPawel Jakub Dawidek mtx_lock(&atomic_mtx);
1033b7917d7SPawel Jakub Dawidek newval = (*target += delta);
1043b7917d7SPawel Jakub Dawidek mtx_unlock(&atomic_mtx);
1053b7917d7SPawel Jakub Dawidek return (newval);
1063b7917d7SPawel Jakub Dawidek }
1073b7917d7SPawel Jakub Dawidek
1083b7917d7SPawel Jakub Dawidek uint64_t
atomic_cas_64(volatile uint64_t * target,uint64_t cmp,uint64_t newval)1093b7917d7SPawel Jakub Dawidek atomic_cas_64(volatile uint64_t *target, uint64_t cmp, uint64_t newval)
1103b7917d7SPawel Jakub Dawidek {
1113b7917d7SPawel Jakub Dawidek uint64_t oldval;
1123b7917d7SPawel Jakub Dawidek
1133b7917d7SPawel Jakub Dawidek mtx_lock(&atomic_mtx);
1143b7917d7SPawel Jakub Dawidek oldval = *target;
1153b7917d7SPawel Jakub Dawidek if (oldval == cmp)
1163b7917d7SPawel Jakub Dawidek *target = newval;
1173b7917d7SPawel Jakub Dawidek mtx_unlock(&atomic_mtx);
1183b7917d7SPawel Jakub Dawidek return (oldval);
1193b7917d7SPawel Jakub Dawidek }
120f5c4c720SAndriy Gapon #endif
121