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