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
|
#include "dolphin/exi/EXIUart.h"
#include "dolphin/os/OS.h"
static s32 Chan;
static u32 Dev;
static u32 Enabled;
static u32 BarnacleEnabled;
// prototypes
int InitializeUART(void);
int ReadUARTN(void);
int WriteUARTN(void *buf, u32 len);
int InitializeUART(void) {
if (BarnacleEnabled == 0xA5FF005A) {
return 0;
}
if ((OSGetConsoleType() & 0x10000000) == 0) {
Enabled = 0;
return 2;
}
Chan = 0;
Dev = 1;
Enabled = 0xA5FF005A;
return 0;
}
int ReadUARTN(void) {
return 4;
}
static int QueueLength(void) {
u32 cmd;
if (EXISelect(Chan, Dev, 3) == 0) {
return -1;
}
cmd = 0x20010000;
EXIImm(Chan, &cmd, sizeof(cmd), EXI_WRITE, 0);
EXISync(Chan);
EXIImm(Chan, &cmd, 1, EXI_READ, 0);
EXISync(Chan);
EXIDeselect(Chan);
return 0x10 - (cmd >> 0x18);
}
int WriteUARTN(void *buf, u32 len) {
u32 cmd;
s32 xLen;
int qLen;
char* ptr;
int locked;
int error;
if ((Enabled - 0xA5FF0000) != 0x5A) {
return 2;
}
locked = EXILock(Chan, Dev, 0);
if (locked == 0) {
return 0;
} else {
ptr = (char*)buf;
}
while ((u32)ptr - (u32)buf < len) {
if (*(s8*)ptr == 0xA) {
*ptr = 0xD;
}
ptr++;
}
error = 0;
cmd = 0xA0010000;
while (len != 0) {
qLen = QueueLength();
if (qLen < 0) {
error = 3;
break;
}
if ((qLen >= 0xC) || (qLen >= len)) {
if (EXISelect(Chan, Dev, EXI_FREQ_8M) == 0) {
error = 3;
break;
}
EXIImm(Chan, &cmd, sizeof(cmd), EXI_WRITE, 0);
EXISync(Chan);
while((qLen != 0) && (len != 0)) {
if ((qLen < 4) && (qLen < len)) {
break;
}
xLen = len < 4 ? (long)len : 4;
EXIImm(Chan, buf, xLen, EXI_WRITE, 0);
(char*)buf += xLen;
len -= xLen;
qLen -= xLen;
EXISync(Chan);
}
EXIDeselect(Chan);
}
}
EXIUnlock(Chan);
return error;
}
|
