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
|
//
// Created by red031000 on 2020-05-21.
//
#include "OS_spinLock.h"
#include "OS_system.h"
#include "function_target.h"
#include "consts.h"
#include "MI_exMemory.h"
extern void MIi_CpuClear32(u32 param1, void * addr, u32 length); //not too sure about names
extern s32 OSi_DoTryLockByWord(u16 lockId, OSLockWord *lockp, void (*ctrlFuncp) (void),
BOOL disableFiq);
extern u32 MI_SwapWord(u32 data, volatile u32* destp);
ARM_FUNC void OS_InitLock()
{
static BOOL isInitialized = FALSE;
if (isInitialized)
{
return;
}
isInitialized = TRUE;
OSLockWord* lockp = (OSLockWord *)0x027FFFF0;
lockp->lockFlag = 0;
(void)OS_TryLockByWord(0x7e, lockp, NULL);
while (lockp->extension)
{
OSi_WaitByLoop();
}
((u32 *)HW_LOCK_ID_FLAG_MAIN)[0] = 0xffffffff;
((u32 *)HW_LOCK_ID_FLAG_MAIN)[1] = 0xffff0000;
MIi_CpuClear32(0x0, (void *)HW_SHARED_LOCK_BUF, 0x28);
MIi_SetCardProcessor(MI_PROCESSOR_ARM7);
MIi_SetCartridgeProcessor(MI_PROCESSOR_ARM7);
(void)OS_UnlockByWord(0x7e, lockp, NULL);
(void)OS_TryLockByWord(0x7f, lockp, NULL);
}
ARM_FUNC s32 OSi_DoLockByWord(u16 lockId, OSLockWord *lockp, void (*ctrlFuncp) (void), //should be static
BOOL disableFiq)
{
s32 lastLockFlag;
while ((lastLockFlag = OSi_DoTryLockByWord(lockId, lockp, ctrlFuncp, disableFiq)) > 0) {
OSi_WaitByLoop();
}
return lastLockFlag;
}
ARM_FUNC s32 OS_TryLockByWord(u16 lockId, OSLockWord *lockp, void (*ctrlFuncp) (void))
{
return OSi_DoLockByWord(lockId, lockp, ctrlFuncp, FALSE);
}
ARM_FUNC s32 OSi_DoUnlockByWord(u16 lockID, OSLockWord *lockp, void (*ctrlFuncp) (void),
BOOL disableFIQ)
{
if (lockID != lockp->ownerID)
{
return -2;
}
OSIntrMode lastIntrMode = (disableFIQ) ? OS_DisableInterrupts_IrqAndFiq() : OS_DisableInterrupts();
lockp->ownerID = 0;
if (ctrlFuncp)
{
ctrlFuncp();
}
lockp->lockFlag = 0;
if (disableFIQ)
{
(void)OS_RestoreInterrupts_IrqAndFiq(lastIntrMode);
}
else
{
(void)OS_RestoreInterrupts(lastIntrMode);
}
return 0;
}
ARM_FUNC s32 OS_UnlockByWord(u16 lockID, OSLockWord* lockp, void (*ctrlFuncp) (void))
{
return OSi_DoUnlockByWord(lockID, lockp, ctrlFuncp, FALSE);
}
ARM_FUNC s32 OSi_DoTryLockByWord(u16 lockID, OSLockWord *lockp, void (*ctrlFuncp) (void),
BOOL disableFiq)
{
OSIntrMode lastIntrMode = (disableFiq) ? OS_DisableInterrupts_IrqAndFiq() : OS_DisableInterrupts();
s32 lastLockFlag = (s32)MI_SwapWord(lockID, &lockp->lockFlag);
if (!lastLockFlag)
{
if (ctrlFuncp)
{
ctrlFuncp();
}
lockp->ownerID = lockID;
}
if (disableFiq)
{
(void)OS_RestoreInterrupts_IrqAndFiq(lastIntrMode);
}
else
{
(void)OS_RestoreInterrupts(lastIntrMode);
}
return lastLockFlag;
}
|
