1/* $NetBSD: atomic_or_16.S,v 1.5 2021/07/28 07:32:20 skrll Exp $ */ 2/*- 3 * Copyright (c) 2013 The NetBSD Foundation, Inc. 4 * All rights reserved. 5 * 6 * This code is derived from software contributed to The NetBSD Foundation 7 * by Matt Thomas <matt@3am-software.com> 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 19 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 20 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 21 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 22 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 28 * POSSIBILITY OF SUCH DAMAGE. 29 */ 30 31#include "atomic_op_asm.h" 32 33#if defined(_ARM_ARCH_6) 34 35ENTRY_NP(_atomic_or_16) 36 mov ip, r0 371: ldrexh r0, [ip] /* load old value (to be returned) */ 38 orrs r3, r0, r1 /* calculate new value */ 39 strexh r2, r3, [ip] /* try to store */ 40 cmp r2, #0 /* succeed? */ 41 bne 1b /* no, try again */ 42 RET /* return old value */ 43END(_atomic_or_16) 44 45ATOMIC_OP_ALIAS(atomic_or_16,_atomic_or_16) 46ATOMIC_OP_ALIAS(atomic_or_ushort,_atomic_or_16) 47CRT_ALIAS(__atomic_fetch_or_2,_atomic_or_16) 48STRONG_ALIAS(_atomic_or_ushort,_atomic_or_16) 49 50ENTRY_NP(__sync_fetch_and_or_2) 51 push {r4, lr} 52 DMB 53 bl _atomic_or_16 54 DMB 55 pop {r4, pc} 56END(__sync_fetch_and_or_2) 57 58 59ENTRY_NP(_atomic_or_16_nv) 60 mov ip, r0 /* need r0 for return value */ 611: ldrexh r0, [ip] /* load old value */ 62 orrs r0, r0, r1 /* calculate new value (return value) */ 63 strexh r2, r0, [ip] /* try to store */ 64 cmp r2, #0 /* succeed? */ 65 bne 1b /* no, try again? */ 66 RET /* return new value */ 67END(_atomic_or_16_nv) 68 69ATOMIC_OP_ALIAS(atomic_or_16_nv,_atomic_or_16_nv) 70ATOMIC_OP_ALIAS(atomic_or_ushort_nv,_atomic_or_16_nv) 71STRONG_ALIAS(_atomic_or_ushort_nv,_atomic_or_16_nv) 72 73ENTRY_NP(__sync_or_and_fetch_2) 74 push {r4, lr} 75 DMB 76 bl _atomic_or_16_nv 77 DMB 78 pop {r4, pc} 79END(__sync_or_and_fetch_2) 80 81#endif /* _ARM_ARCH_6 */ 82