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
|
/**
* @file
*
* This file contains the basic algorithms for all assembly code used
* in an specific CPU port of RTEMS. These algorithms must be implemented
* in assembly language
*/
/*
* COPYRIGHT (c) 1989-2012.
* On-Line Applications Research Corporation (OAR).
*
* 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
#if 0
/**
* This routine is responsible for saving the FP context
* at *fp_context_ptr. If the point to load the FP context
* from is changed then the pointer is modified by this routine.
*
* Sometimes a macro implementation of this is in cpu.h which dereferences
* the ** and a similarly named routine in this file is passed something
* like a (Context_Control_fp *). The general rule on making this decision
* is to avoid writing assembly language.
*
* v850 Specific Information:
*
* The v850 appears to always have soft float.
*/
void _CPU_Context_save_fp(
Context_Control_fp **fp_context_ptr
)
{
}
/**
* This routine is responsible for restoring the FP context
* at *fp_context_ptr. If the point to load the FP context
* from is changed then the pointer is modified by this routine.
*
* Sometimes a macro implementation of this is in cpu.h which dereferences
* the ** and a similarly named routine in this file is passed something
* like a (Context_Control_fp *). The general rule on making this decision
* is to avoid writing assembly language.
*
* v850 Specific Information:
*
* XXX document implementation including references if appropriate
*/
void _CPU_Context_restore_fp(
Context_Control_fp **fp_context_ptr
)
{
}
#endif
/**
* This routine performs a normal non-FP context switch.
*
* v850 Specific Information:
*
* + r6 - running thread
* + r7 - heir thread
*/
#define V850_CONTEXT_CONTROL_R1_OFFSET 0
#define V850_CONTEXT_CONTROL_R3_OFFSET 4
#define V850_CONTEXT_CONTROL_R20_OFFSET 8
#define V850_CONTEXT_CONTROL_R21_OFFSET 12
#define V850_CONTEXT_CONTROL_R22_OFFSET 16
#define V850_CONTEXT_CONTROL_R23_OFFSET 20
#define V850_CONTEXT_CONTROL_R24_OFFSET 24
#define V850_CONTEXT_CONTROL_R25_OFFSET 28
#define V850_CONTEXT_CONTROL_R26_OFFSET 32
#define V850_CONTEXT_CONTROL_R27_OFFSET 36
#define V850_CONTEXT_CONTROL_R28_OFFSET 40
#define V850_CONTEXT_CONTROL_R29_OFFSET 44
#define V850_CONTEXT_CONTROL_R31_OFFSET 48
#define V850_CONTEXT_CONTROL_PSW_OFFSET 52
.section .text
.global __CPU_Context_switch
.type __CPU_Context_switch, @function
__CPU_Context_switch:
st.w r1,V850_CONTEXT_CONTROL_R1_OFFSET[r6]
st.w r3,V850_CONTEXT_CONTROL_R3_OFFSET[r6]
st.w r20,V850_CONTEXT_CONTROL_R20_OFFSET[r6]
st.w r21,V850_CONTEXT_CONTROL_R21_OFFSET[r6]
st.w r22,V850_CONTEXT_CONTROL_R22_OFFSET[r6]
st.w r23,V850_CONTEXT_CONTROL_R23_OFFSET[r6]
st.w r24,V850_CONTEXT_CONTROL_R24_OFFSET[r6]
st.w r25,V850_CONTEXT_CONTROL_R25_OFFSET[r6]
st.w r26,V850_CONTEXT_CONTROL_R27_OFFSET[r6]
st.w r27,V850_CONTEXT_CONTROL_R27_OFFSET[r6]
st.w r28,V850_CONTEXT_CONTROL_R28_OFFSET[r6]
st.w r29,V850_CONTEXT_CONTROL_R29_OFFSET[r6]
st.w r31,V850_CONTEXT_CONTROL_R31_OFFSET[r6]
stsr psw,r21
st.w r21,V850_CONTEXT_CONTROL_PSW_OFFSET[r6]
restore:
ld.w V850_CONTEXT_CONTROL_R1_OFFSET[r7],r1
ld.w V850_CONTEXT_CONTROL_R3_OFFSET[r7],r3
ld.w V850_CONTEXT_CONTROL_R20_OFFSET[r7],r20
ld.w V850_CONTEXT_CONTROL_R21_OFFSET[r7],r21
ld.w V850_CONTEXT_CONTROL_R22_OFFSET[r7],r22
ld.w V850_CONTEXT_CONTROL_R23_OFFSET[r7],r23
ld.w V850_CONTEXT_CONTROL_R24_OFFSET[r7],r24
ld.w V850_CONTEXT_CONTROL_R25_OFFSET[r7],r25
ld.w V850_CONTEXT_CONTROL_R27_OFFSET[r7],r26
ld.w V850_CONTEXT_CONTROL_R27_OFFSET[r7],r27
ld.w V850_CONTEXT_CONTROL_R28_OFFSET[r7],r28
ld.w V850_CONTEXT_CONTROL_R29_OFFSET[r7],r29
ld.w V850_CONTEXT_CONTROL_R31_OFFSET[r7],r31
ld.w V850_CONTEXT_CONTROL_PSW_OFFSET[r7],r7
ldsr r7,psw
jmp [r31]
/**
* This routine is generally used only to restart self in an
* efficient manner. It may simply be a label in _CPU_Context_switch.
*
* NOTE: May be unnecessary to reload some registers.
*
* v850 Specific Information:
*
* Move second parameter to first and jump to normal restore
*/
.section .text
.global __CPU_Context_restore
.type __CPU_Context_restore, @function
__CPU_Context_restore:
mov r6, r7 /* move to second parameter register */
br restore
|