|
sl@0
|
1 |
// Copyright (c) 1997-2009 Nokia Corporation and/or its subsidiary(-ies).
|
|
sl@0
|
2 |
// All rights reserved.
|
|
sl@0
|
3 |
// This component and the accompanying materials are made available
|
|
sl@0
|
4 |
// under the terms of "Eclipse Public License v1.0"
|
|
sl@0
|
5 |
// which accompanies this distribution, and is available
|
|
sl@0
|
6 |
// at the URL "http://www.eclipse.org/legal/epl-v10.html".
|
|
sl@0
|
7 |
//
|
|
sl@0
|
8 |
// Initial Contributors:
|
|
sl@0
|
9 |
// Nokia Corporation - initial contribution.
|
|
sl@0
|
10 |
//
|
|
sl@0
|
11 |
// Contributors:
|
|
sl@0
|
12 |
//
|
|
sl@0
|
13 |
// Description:
|
|
sl@0
|
14 |
//
|
|
sl@0
|
15 |
|
|
sl@0
|
16 |
#include <setjmp.h>
|
|
sl@0
|
17 |
|
|
sl@0
|
18 |
extern "C" {
|
|
sl@0
|
19 |
|
|
sl@0
|
20 |
EXPORT_C int setjmp(jmp_buf __jmpb)
|
|
sl@0
|
21 |
{
|
|
sl@0
|
22 |
#ifdef __MARM_THUMB__
|
|
sl@0
|
23 |
//the function destroys the contents of {r0,r1,r2,r3} registers
|
|
sl@0
|
24 |
//r0 is used to hold the retrun value
|
|
sl@0
|
25 |
//r1,r2,r3 - they are used usually to hold functions arguments/temp data and are
|
|
sl@0
|
26 |
//not expected to preserve their values between functions calls.
|
|
sl@0
|
27 |
asm("stmia r0!, {r4-r7}");//bytes {0..15} are occupied by {r4,r5,r6,r7} registers
|
|
sl@0
|
28 |
asm("mov r2, r8");
|
|
sl@0
|
29 |
asm("mov r3, r9");
|
|
sl@0
|
30 |
asm("mov r4, r10");
|
|
sl@0
|
31 |
asm("mov r5, r11");
|
|
sl@0
|
32 |
asm("mov r6, sp");
|
|
sl@0
|
33 |
asm("mov r7, lr");
|
|
sl@0
|
34 |
asm("stmia r0!, {r2-r7}");//bytes {16..39} are occupied by {r8,r9,r10,r11,sp,lr} registers
|
|
sl@0
|
35 |
asm("sub r0, #40");//r0 points now to the beginning of __jmpb
|
|
sl@0
|
36 |
asm("ldmia r0!, {r4-r7}");//restore the contents of {r4,r5,r6,r7} registers
|
|
sl@0
|
37 |
#else
|
|
sl@0
|
38 |
asm("stmia r0, {r4-r11, sp, lr} "); // Save the context
|
|
sl@0
|
39 |
#endif
|
|
sl@0
|
40 |
return(0);
|
|
sl@0
|
41 |
}
|
|
sl@0
|
42 |
|
|
sl@0
|
43 |
EXPORT_C void longjmp(jmp_buf __jmpb, int __retval)
|
|
sl@0
|
44 |
{
|
|
sl@0
|
45 |
#ifdef __MARM_THUMB__
|
|
sl@0
|
46 |
asm("mov r3, r0"); // save the jmp_buf pointer
|
|
sl@0
|
47 |
asm("add r3, #16"); //add on 16 to get to high registers
|
|
sl@0
|
48 |
asm("ldmia r3!, {r4-r7}");
|
|
sl@0
|
49 |
asm("mov r8,r4");
|
|
sl@0
|
50 |
asm("mov r9,r5");
|
|
sl@0
|
51 |
asm("mov r10,r6");
|
|
sl@0
|
52 |
asm("mov r11,r7");
|
|
sl@0
|
53 |
asm("ldmia r3!, {r4-r5}"); //get sp and lr
|
|
sl@0
|
54 |
asm("mov sp, r4");
|
|
sl@0
|
55 |
asm("mov lr, r5");
|
|
sl@0
|
56 |
asm("mov r3, r0"); //get the jmp_buf ptr again
|
|
sl@0
|
57 |
asm("ldmia r3!, {r4-r7}"); //and restore the lo regs
|
|
sl@0
|
58 |
asm("mov r0, r1"); // return(__retval)
|
|
sl@0
|
59 |
asm("cmp r0, #0");
|
|
sl@0
|
60 |
asm("bne 1f");
|
|
sl@0
|
61 |
asm("mov r0, #1");
|
|
sl@0
|
62 |
asm("1:");
|
|
sl@0
|
63 |
#else
|
|
sl@0
|
64 |
asm("ldmia r0, {r4-r11, sp, lr} "); // Restore the context
|
|
sl@0
|
65 |
asm("movs r0, r1"); // return(__retval == 0 ? 1 : retval)
|
|
sl@0
|
66 |
asm("moveq r0, #1");
|
|
sl@0
|
67 |
#endif
|
|
sl@0
|
68 |
return;
|
|
sl@0
|
69 |
}
|
|
sl@0
|
70 |
|
|
sl@0
|
71 |
} // extern "C"
|