1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
|
/*
* Copyright (c) 2013 embedded brains GmbH. All rights reserved.
*
* embedded brains GmbH
* Dornierstr. 4
* 82178 Puchheim
* Germany
* <rtems@embedded-brains.de>
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.org/license/LICENSE.
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <rtems/asm.h>
#define FRAME_OFFSET_R16 0
#define FRAME_OFFSET_R17 4
#define FRAME_OFFSET_R18 8
#define FRAME_OFFSET_R19 12
#define FRAME_OFFSET_R20 16
#define FRAME_OFFSET_R21 20
#define FRAME_OFFSET_R22 24
#define FRAME_OFFSET_R23 28
#define FRAME_OFFSET_FP 32
#define FRAME_OFFSET_RA 36
#define FRAME_SIZE (FRAME_OFFSET_RA + 4)
.set noat
.section .text
.global _CPU_Context_validate
_CPU_Context_validate:
/* Save */
subi sp, sp, FRAME_SIZE
stw r16, FRAME_OFFSET_R16(sp)
stw r17, FRAME_OFFSET_R17(sp)
stw r18, FRAME_OFFSET_R18(sp)
stw r19, FRAME_OFFSET_R19(sp)
stw r20, FRAME_OFFSET_R20(sp)
stw r21, FRAME_OFFSET_R21(sp)
stw r22, FRAME_OFFSET_R22(sp)
stw r23, FRAME_OFFSET_R23(sp)
stw fp, FRAME_OFFSET_FP(sp)
stw ra, FRAME_OFFSET_RA(sp)
/* Fill */
/* AT contains the stack pointer */
mov at, sp
/* R2 is used for temporary values */
subi r3, r4, 1
addi r5, r4, 1
addi r6, r4, 2
addi r7, r4, 3
addi r8, r4, 4
addi r9, r4, 5
addi r10, r4, 6
addi r11, r4, 7
addi r12, r4, 8
addi r13, r4, 9
addi r14, r4, 10
addi r15, r4, 11
addi r16, r4, 12
addi r17, r4, 13
addi r18, r4, 14
addi r19, r4, 15
addi r20, r4, 16
addi r21, r4, 17
addi r22, r4, 18
addi r23, r4, 19
addi fp, r4, 20
addi ra, r4, 21
/* Check */
check:
bne sp, at, restore
subi r2, r4, 1
bne r2, r3, restore
addi r2, r4, 1
bne r2, r5, restore
addi r2, r4, 2
bne r2, r6, restore
addi r2, r4, 3
bne r2, r7, restore
addi r2, r4, 4
bne r2, r8, restore
addi r2, r4, 5
bne r2, r9, restore
addi r2, r4, 6
bne r2, r10, restore
addi r2, r4, 7
bne r2, r11, restore
addi r2, r4, 8
bne r2, r12, restore
addi r2, r4, 9
bne r2, r13, restore
addi r2, r4, 10
bne r2, r14, restore
addi r2, r4, 11
bne r2, r15, restore
addi r2, r4, 12
bne r2, r16, restore
addi r2, r4, 13
bne r2, r17, restore
addi r2, r4, 14
bne r2, r18, restore
addi r2, r4, 15
bne r2, r19, restore
addi r2, r4, 16
bne r2, r20, restore
addi r2, r4, 17
bne r2, r21, restore
addi r2, r4, 18
bne r2, r22, restore
addi r2, r4, 19
bne r2, r23, restore
addi r2, r4, 20
bne r2, fp, restore
addi r2, r4, 21
bne r2, ra, restore
br check
/* Restore */
restore:
ldw ra, FRAME_OFFSET_RA(sp)
ldw fp, FRAME_OFFSET_FP(sp)
ldw r23, FRAME_OFFSET_R23(sp)
ldw r22, FRAME_OFFSET_R22(sp)
ldw r21, FRAME_OFFSET_R21(sp)
ldw r20, FRAME_OFFSET_R20(sp)
ldw r19, FRAME_OFFSET_R19(sp)
ldw r18, FRAME_OFFSET_R18(sp)
ldw r17, FRAME_OFFSET_R17(sp)
ldw r16, FRAME_OFFSET_R16(sp)
addi sp, sp, FRAME_SIZE
ret
|
