-
Notifications
You must be signed in to change notification settings - Fork 1
Expand file tree
/
Copy pathme-core-custom.h
More file actions
147 lines (137 loc) · 5.14 KB
/
Copy pathme-core-custom.h
File metadata and controls
147 lines (137 loc) · 5.14 KB
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
#ifndef ME_CORE_CUSTOM_H
#define ME_CORE_CUSTOM_H
#include "me-core-mapper.h"
#include "me-lib.h"
extern char __start__me_section;
extern char __stop__me_section;
extern u32 SC_HW_RESET;
extern void meLibOnProcess(void);
#ifdef __cplusplus
extern "C" {
#endif
extern void meLibSaveContext(void);
extern void meLibRestoreContext(void);
extern void meLibOnExternalInterrupt(void);
extern void meLibOnException(void);
extern void meLibOnSleep(void);
extern void meLibOnWake(void);
void meLibReset();
int meLibDefaultInit();
void meLibExceptionHandlerInit(const u8 ip7);
#ifdef __cplusplus
}
#endif
#define ME_LIB_SETUP_SIMPLE_SUSPEND_HANDLER() \
extern "C" __attribute__((noinline, aligned(4))) \
void meLibOnSleep() { \
\
HW_SYS_RESET_ENABLE = SC_HW_RESET; \
meLibSync(); \
} \
\
extern "C" __attribute__((noinline, aligned(4))) \
void meLibOnWake() { \
\
HW_SYS_RESET_ENABLE = SC_HW_RESET; \
HW_SYS_RESET_ENABLE = 0; \
meLibSync(); \
}
#define ME_LIB_SETUP_DEFAULT_SUSPEND_HANDLER() \
extern "C" __attribute__((noinline, aligned(4))) \
void meLibOnExternalInterrupt(void) { \
asm volatile( \
".set push \n" \
".set volatile \n" \
".set noreorder \n" \
".set noat \n" \
\
/* save regs context */ \
"addi $sp, $sp, -16 \n" \
"sw $k0, 0($sp) \n" \
"sw $k1, 4($sp) \n" \
"sw $ra, 8($sp) \n" \
"sw $at, 12($sp) \n" \
\
/* if SRAM_SHARED_VAR_0 equal 1 */ \
"li $k0, %2 \n" \
"cache 0x8, 0($k0) \n" \
"sync \n" \
"lw $k1, 0($k0) \n" \
"li $k0, 1 \n" \
"bne $k1, $k0, 1f \n" \
"nop \n" \
\
/* call meLibSaveContext */ \
"la $k0, %0 \n" \
"li $k1, 0x80000000 \n" \
"or $k0, $k0, $k1 \n" \
"cache 0x8, 0($k0) \n" \
"sync \n" \
"jal $k0 \n" \
"nop \n" \
"1: \n" \
\
/* if SRAM_SHARED_VAR_0 equal 2 */ \
"li $k0, %2 \n" \
"lw $k1, 0($k0) \n" \
"li $k0, 2 \n" \
"bne $k1, $k0, 2f \n" \
"nop \n" \
\
/* call meLibRestoreContext */ \
"la $k0, %1 \n" \
"li $k1, 0x80000000 \n" \
"or $k0, $k0, $k1 \n" \
"cache 0x8, 0($k0) \n" \
"sync \n" \
"jal $k0 \n" \
"nop \n" \
"2: \n" \
\
/* reset SRAM_SHARED_VAR_0 */ \
"li $k0, %2 \n" \
"sw $0, 0($k0) \n" \
"sync \n" \
/*"1: \n"*/ \
/*"lw $k1, 0($k0) \n"*/ \
/*"bne $k1, $0, 1b \n"*/ \
/*"nop \n"*/ \
\
/* restore regs context */ \
"lw $k0, 0($sp) \n" \
"lw $k1, 4($sp) \n" \
"lw $ra, 8($sp) \n" \
"lw $at, 12($sp) \n" \
"addi $sp, $sp, 16 \n" \
\
".set pop \n" \
: \
: "i" (meLibSaveContext), "i" (meLibRestoreContext), "i" (SRAM_SHARED_VAR_0) \
: "k0", "k1", "memory" \
); \
} \
\
extern "C" __attribute__((noinline, aligned(4))) \
void meLibOnSleep() { \
SET_SRAM_SHARED_VAR(0, 1); \
meLibSendExternalSoftInterrupt(); \
while (GET_SRAM_SHARED_VAR(0)) { \
meLibDelayPipeline(); \
} \
HW_SYS_RESET_ENABLE = SC_HW_RESET; \
meLibSync(); \
} \
\
extern "C" __attribute__((noinline, aligned(4))) \
void meLibOnWake() { \
SET_SRAM_SHARED_VAR(0, 3); \
HW_SYS_RESET_ENABLE = SC_HW_RESET; \
HW_SYS_RESET_ENABLE = 0x00; \
meLibSync(); \
while (GET_SRAM_SHARED_VAR(0)) { \
meLibDelayPipeline(); \
} \
SET_SRAM_SHARED_VAR(0, 2); \
meLibSendExternalSoftInterrupt(); \
}
#endif