blob: 0dc111e3da67ba7c8137d5d4fb4c447b6415110f (
plain)
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
|
#include "PR/os_internal.h"
#include "PR/rdb.h"
#include "PR/R4300.h"
#ifndef _FINALROM
extern rdbPacket* __osRdb_IP6_Data;
extern u32 __osRdb_IP6_Size;
extern u32 __osRdb_IP6_Ct;
extern u32 __osRdb_IP6_CurWrite;
u32 __osRdb_IP6_Empty = 1;
#define MIN(a, b) (((a) < (b)) ? (a) : (b))
u32 __osRdbSend(u8* buf, u32 size, u32 type) {
rdbPacket* pPtr;
rdbPacket pkt;
u32 len;
u32 c;
u32 inCt = 0;
u32 needFirst = 0;
u32 mask;
u32 sent = 0;
mask = __osDisableInt();
if (__osRdb_IP6_Empty != 0) {
__osRdb_IP6_Empty = 0;
pkt.type = type;
len = MIN(size, sizeof(pkt.buf));
pkt.length = len;
c = 0;
while (c < len) {
pkt.buf[c++] = buf[inCt++];
}
size -= len;
sent = len;
needFirst = 1;
}
while (size != 0 && __osRdb_IP6_Ct < __osRdb_IP6_Size) {
len = MIN(size, sizeof(pPtr->buf));
pPtr = &__osRdb_IP6_Data[__osRdb_IP6_CurWrite];
pPtr->type = type;
pPtr->length = len;
c = 0;
while (c < len) {
pPtr->buf[c++] = buf[inCt++];
}
__osRdb_IP6_CurWrite++;
if (__osRdb_IP6_CurWrite >= __osRdb_IP6_Size) {
__osRdb_IP6_CurWrite = 0;
}
__osRdb_IP6_Ct++;
size -= len;
sent += len;
}
if (needFirst) {
*(u32*)RDB_BASE_REG = *(u32*)&pkt;
}
__osRestoreInt(mask);
return sent;
}
#endif
|
