1/* $NetBSD: atomic_add_32.S,v 1.10 2021/07/28 07:32:20 skrll Exp $ */ 2 3/*- 4 * Copyright (c) 2008 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#if defined(_ARM_ARCH_6) 35 36ENTRY_NP(_atomic_sub_32) 37 negs r1, r1 38 /* FALLTHROUGH */ 39ENTRY_NP(_atomic_add_32) 40 mov ip, r0 411: ldrex r0, [ip] /* load old value */ 42 adds r3, r0, r1 /* calculate new value */ 43 strex r2, r3, [ip] /* try to store */ 44 cmp r2, #0 /* succeed? */ 45 bne 1b /* no, try again */ 46 RET /* return old value */ 47END(_atomic_add_32) 48END(_atomic_sub_32) 49 50ENTRY_NP(__sync_fetch_and_add_4) 51 push {r4, lr} 52 DMB 53 bl _atomic_add_32 54 DMB 55 pop {r4, pc} 56END(__sync_fetch_and_add_4) 57 58ENTRY_NP(__sync_fetch_and_sub_4) 59 push {r4, lr} 60 DMB 61 bl _atomic_add_32 62 DMB 63 pop {r4, pc} 64END(__sync_fetch_and_sub_4) 65 66 67ATOMIC_OP_ALIAS(atomic_add_32,_atomic_add_32) 68ATOMIC_OP_ALIAS(atomic_add_int,_atomic_add_32) 69ATOMIC_OP_ALIAS(atomic_add_long,_atomic_add_32) 70ATOMIC_OP_ALIAS(atomic_add_ptr,_atomic_add_32) 71CRT_ALIAS(__atomic_fetch_add_4,_atomic_add_32) 72STRONG_ALIAS(_atomic_add_int,_atomic_add_32) 73STRONG_ALIAS(_atomic_add_long,_atomic_add_32) 74STRONG_ALIAS(_atomic_add_ptr,_atomic_add_32) 75 76ATOMIC_OP_ALIAS(atomic_sub_32,_atomic_sub_32) 77ATOMIC_OP_ALIAS(atomic_sub_int,_atomic_sub_32) 78ATOMIC_OP_ALIAS(atomic_sub_long,_atomic_sub_32) 79ATOMIC_OP_ALIAS(atomic_sub_ptr,_atomic_sub_32) 80CRT_ALIAS(__atomic_fetch_sub_4,_atomic_sub_32) 81STRONG_ALIAS(_atomic_sub_int,_atomic_sub_32) 82STRONG_ALIAS(_atomic_sub_long,_atomic_sub_32) 83STRONG_ALIAS(_atomic_sub_ptr,_atomic_sub_32) 84 85ENTRY_NP(_atomic_sub_32_nv) 86 negs r1, r1 87 /* FALLTHROUGH */ 88ENTRY_NP(_atomic_add_32_nv) 89 mov ip, r0 /* need r0 for return value */ 901: ldrex r0, [ip] /* load old value */ 91 adds r0, r0, r1 /* calculate new value (return value) */ 92 strex r2, r0, [ip] /* try to store */ 93 cmp r2, #0 /* succeed? */ 94 bne 1b /* no, try again? */ 95 RET /* return new value */ 96END(_atomic_add_32_nv) 97END(_atomic_sub_32_nv) 98 99ATOMIC_OP_ALIAS(atomic_add_32_nv,_atomic_add_32_nv) 100ATOMIC_OP_ALIAS(atomic_add_int_nv,_atomic_add_32_nv) 101ATOMIC_OP_ALIAS(atomic_add_long_nv,_atomic_add_32_nv) 102ATOMIC_OP_ALIAS(atomic_add_ptr_nv,_atomic_add_32_nv) 103STRONG_ALIAS(_atomic_add_int_nv,_atomic_add_32_nv) 104STRONG_ALIAS(_atomic_add_long_nv,_atomic_add_32_nv) 105STRONG_ALIAS(_atomic_add_ptr_nv,_atomic_add_32_nv) 106 107ATOMIC_OP_ALIAS(atomic_sub_32_nv,_atomic_sub_32_nv) 108ATOMIC_OP_ALIAS(atomic_sub_int_nv,_atomic_sub_32_nv) 109ATOMIC_OP_ALIAS(atomic_sub_long_nv,_atomic_sub_32_nv) 110ATOMIC_OP_ALIAS(atomic_sub_ptr_nv,_atomic_sub_32_nv) 111STRONG_ALIAS(_atomic_sub_int_nv,_atomic_sub_32_nv) 112STRONG_ALIAS(_atomic_sub_long_nv,_atomic_sub_32_nv) 113STRONG_ALIAS(_atomic_sub_ptr_nv,_atomic_sub_32_nv) 114 115ENTRY_NP(__sync_add_and_fetch_4) 116 push {r4, lr} 117 DMB 118 bl _atomic_add_32_nv 119 DMB 120 pop {r4, pc} 121END(__sync_add_and_fetch_4) 122 123ENTRY_NP(__sync_sub_and_fetch_4) 124 push {r4, lr} 125 DMB 126 bl _atomic_sub_32_nv 127 DMB 128 pop {r4, pc} 129END(__sync_sub_and_fetch_4) 130 131#endif /* _ARM_ARCH_6 */ 132