1/* $NetBSD: atomic_add_16.S,v 1.3 2014/06/23 21:53:45 joerg Exp $ */ 2 3/*- 4 * Copyright (c) 2013 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Matt Thomas <matt@3am-software.com> 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32#include "atomic_op_asm.h" 33 34#ifdef _ARM_ARCH_6 35 36ENTRY_NP(_atomic_sub_16) 37 negs r1, r1 38 /* FALLTHROUGH */ 39ENTRY_NP(_atomic_add_16) 40 mov ip, r0 411: ldrexh r0, [ip] /* load old value */ 42 adds r3, r0, r1 /* calculate new value */ 43 strexh r2, r3, [ip] /* try to store */ 44 cmp r2, #0 /* succeed? */ 45 bne 1b /* no, try again */ 46#ifdef _ARM_ARCH_7 47 dmb 48#else 49 mcr p15, 0, r2, c7, c10, 5 /* data memory barrier */ 50#endif 51 RET /* return old value */ 52END(_atomic_add_16) 53END(_atomic_sub_16) 54 55ATOMIC_OP_ALIAS(atomic_add_16,_atomic_add_16) 56ATOMIC_OP_ALIAS(atomic_add_short,_atomic_add_16) 57ATOMIC_OP_ALIAS(atomic_add_ushort,_atomic_add_16) 58CRT_ALIAS(__sync_fetch_and_add_2,_atomic_add_16) 59CRT_ALIAS(__atomic_fetch_add_2,_atomic_add_16) 60STRONG_ALIAS(_atomic_add_short,_atomic_add_16) 61STRONG_ALIAS(_atomic_add_ushort,_atomic_add_16) 62 63ATOMIC_OP_ALIAS(atomic_sub_16,_atomic_sub_16) 64ATOMIC_OP_ALIAS(atomic_sub_short,_atomic_sub_16) 65ATOMIC_OP_ALIAS(atomic_sub_ushort,_atomic_sub_16) 66CRT_ALIAS(__sync_fetch_and_sub_2,_atomic_sub_16) 67CRT_ALIAS(__atomic_fetch_sub_2,_atomic_sub_16) 68STRONG_ALIAS(_atomic_sub_short,_atomic_sub_16) 69STRONG_ALIAS(_atomic_sub_ushort,_atomic_sub_16) 70 71ENTRY_NP(_atomic_sub_16_nv) 72 negs r1, r1 73 /* FALLTHROUGH */ 74ENTRY_NP(_atomic_add_16_nv) 75 mov ip, r0 /* need r0 for return value */ 761: ldrexh r0, [ip] /* load old value */ 77 adds r0, r0, r1 /* calculate new value (return value) */ 78 strexh r2, r0, [ip] /* try to store */ 79 cmp r2, #0 /* succeed? */ 80 bne 1b /* no, try again? */ 81#ifdef _ARM_ARCH_7 82 dmb 83#else 84 mcr p15, 0, r2, c7, c10, 5 /* data memory barrier */ 85#endif 86 RET /* return new value */ 87END(_atomic_add_16_nv) 88END(_atomic_sub_16_nv) 89ATOMIC_OP_ALIAS(atomic_add_16_nv,_atomic_add_16_nv) 90ATOMIC_OP_ALIAS(atomic_add_short_nv,_atomic_add_16_nv) 91ATOMIC_OP_ALIAS(atomic_add_ushort_nv,_atomic_add_16_nv) 92CRT_ALIAS(__sync_add_and_fetch_2,_atomic_add_16_nv) 93STRONG_ALIAS(_atomic_add_short_nv,_atomic_add_16_nv) 94STRONG_ALIAS(_atomic_add_ushort_nv,_atomic_add_16_nv) 95 96ATOMIC_OP_ALIAS(atomic_sub_16_nv,_atomic_sub_16_nv) 97ATOMIC_OP_ALIAS(atomic_sub_short_nv,_atomic_sub_16_nv) 98ATOMIC_OP_ALIAS(atomic_sub_ushort_nv,_atomic_sub_16_nv) 99CRT_ALIAS(__sync_sub_and_fetch_2,_atomic_sub_16_nv) 100STRONG_ALIAS(_atomic_sub_short_nv,_atomic_sub_16_nv) 101STRONG_ALIAS(_atomic_sub_ushort_nv,_atomic_sub_16_nv) 102#endif /* _ARM_ARCH_6 */ 103