swapcontext.S revision 1.11
11.11Smatt/*	$NetBSD: swapcontext.S,v 1.11 2013/09/04 21:17:15 matt Exp $	*/
21.2Sthorpej
31.2Sthorpej/*-
41.2Sthorpej * Copyright (c) 2001 The NetBSD Foundation, Inc.
51.2Sthorpej * All rights reserved.
61.2Sthorpej *
71.2Sthorpej * This code is derived from software contributed to The NetBSD Foundation
81.2Sthorpej * by Klaus Klein.
91.2Sthorpej *
101.2Sthorpej * Redistribution and use in source and binary forms, with or without
111.2Sthorpej * modification, are permitted provided that the following conditions
121.2Sthorpej * are met:
131.2Sthorpej * 1. Redistributions of source code must retain the above copyright
141.2Sthorpej *    notice, this list of conditions and the following disclaimer.
151.2Sthorpej * 2. Redistributions in binary form must reproduce the above copyright
161.2Sthorpej *    notice, this list of conditions and the following disclaimer in the
171.2Sthorpej *    documentation and/or other materials provided with the distribution.
181.2Sthorpej *
191.2Sthorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
201.2Sthorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
211.2Sthorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
221.2Sthorpej * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
231.2Sthorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
241.2Sthorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
251.2Sthorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
261.2Sthorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
271.2Sthorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
281.2Sthorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
291.2Sthorpej * POSSIBILITY OF SUCH DAMAGE.
301.2Sthorpej */
311.2Sthorpej
321.2Sthorpej#include "SYS.h"
331.8Sskrll#include "assym.h"
341.2Sthorpej
351.2Sthorpej#if defined(LIBC_SCCS) && !defined(lint)
361.11Smatt        RCSID("$NetBSD: swapcontext.S,v 1.11 2013/09/04 21:17:15 matt Exp $")
371.2Sthorpej#endif /* LIBC_SCCS && !lint */
381.2Sthorpej
391.2SthorpejENTRY(swapcontext)
401.11Smatt#if defined(__ARM_EABI__) && defined(__UNWIND_TABLES__)
411.10Smatt	.fnstart
421.10Smatt	.cfi_startproc
431.11Smatt#endif
441.10Smatt	push	{r0-r2, lr}	/* Must save oucp, ucp, lr. */
451.11Smatt#if defined(__ARM_EABI__) && defined(__UNWIND_TABLES__)
461.10Smatt	.save	{r0-r2, lr}
471.10Smatt	.cfi_def_cfa_offset 16
481.10Smatt	.cfi_offset 14, -4
491.10Smatt	.cfi_offset 2, -8
501.10Smatt	.cfi_offset 1, -12
511.10Smatt	.cfi_offset 0, -16
521.11Smatt#endif
531.2Sthorpej	bl	PIC_SYM(_C_LABEL(_getcontext), PLT)  /* getcontext(oucp) */
541.2Sthorpej	cmp	r0, #0
551.10Smatt#if !defined(__thumb__)
561.10Smatt	pop	{r0-r2, lr}
571.10Smatt	.cfi_def_cfa_offset 0
581.4Srearnsha	RETc(ne)
591.10Smatt#else
601.10Smatt	pop	{r0-r3}
611.10Smatt	beq	1f
621.11Smatt#if defined(__ARM_EABI__) && defined(__UNWIND_TABLES__)
631.10Smatt	.cfi_def_cfa_offset 0
641.10Smatt	.cfi_register 14, 3
651.11Smatt#endif
661.10Smatt	RETr(r3)
671.10Smatt1:
681.10Smatt#endif
691.10Smatt#if !defined(__thumb__)
701.8Sskrll	str	sp, [r0, #_UC_REGS_SP]	/* Adjust saved SP. */
711.10Smatt	str	lr, [r0, #_UC_REGS_PC]	/* Adjust saved SP. */
721.10Smatt#else
731.10Smatt	mov	r2, sp
741.10Smatt	str	r2, [r0, #_UC_REGS_SP]	/* Adjust saved SP. */
751.10Smatt	str	r3, [r0, #_UC_REGS_PC]	/* Adjust saved PC. */
761.10Smatt	mov	lr, r3
771.10Smatt#endif
781.2Sthorpej#ifdef SOFTFLOAT
791.2Sthorpej	/* Ahem. */
801.2Sthorpej#endif
811.2Sthorpej	mov	r0, r1
821.10Smatt#if !defined(__thumb__) || defined(_ARM_ARCH_T2)
831.10Smatt	b	PIC_SYM(_C_LABEL(setcontext), PLT)
841.10Smatt#else
851.10Smatt	push	{lr}
861.2Sthorpej	bl	PIC_SYM(_C_LABEL(setcontext), PLT)
871.10Smatt	pop	{pc}
881.10Smatt#endif
891.11Smatt#if defined(__ARM_EABI__) && defined(__UNWIND_TABLES__)
901.10Smatt	.cfi_endproc
911.10Smatt	.fnend
921.11Smatt#endif
931.10SmattEND(swapcontext)
94