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
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
|
/*
* Low-level CDROM library
*/
#include <stdio.h>
#include <stdarg.h>
#include <psx.h>
#define CDREG(x) *((unsigned char*)(0x1f801800+x))
void _internal_cdrom_handler();
void (*cdrom_handler_callback)();
volatile int cdrom_command_direct = 0;
volatile int cdrom_command_done = 0;
volatile int cdrom_direct_cmd;
volatile int cdrom_command_dpos = 0;
volatile unsigned char cdrom_last_command;
volatile unsigned char cdrom_command_stat[2];
unsigned int cdrom_queue_buf[4] = {0x0, /* Will contain next interrupt handler in queue */
0x0, /* func1 */
(unsigned int)_internal_cdrom_handler, /* func2 */
0x0, /* pad */
};
static const unsigned char cdrom_command_type[0x1F] = // 0 = single int, 1 = double int, 2,3,... = others
{
0, // Sync 0
0, // GetStat/Nop 1
0, // Setloc 2
0, // Play 3
0, // Forward 4
0, // Backward 5
0, // ReadN 6
0, // Standby 7
0, // Stop 8
1, // Pause 9
1, // Init A
0, // Mute B
0, // Demute C
0, // Setfilter D
0, // Setmode E
0, // Getmode F
0, // GetlocL 10
0, // GetlocP 11
0xFF, // ??? 12
0, // GetTN 13
0, // GetTD 14
1, // SeekL 15
1, // SeekP 16
0xFF, // ??? 17
0xFF, // ??? 18
0, // Test 19
1, // ID 1A
0, // ReadS 1B
0, // Reset 1C
0xFF, // ??? 1D
1, // ReadToc 1E
};
void CdSendCommand(int cmd, int num, ...)
{
int x;
va_list ap;
va_start(ap, num);
// Wait for command execution to end
// while(CDREG(0) & 128);
// Flush old interrupts
// If this is not done, some events (like the opening of the shell) will hang the CD controller.
CDREG(0) = 1;
CDREG(3) = 7;
// Send parameters
CDREG(0) = 0;
while(num)
{
CDREG(2) = (unsigned char)va_arg(ap, unsigned int);
num--;
}
// Send command
CDREG(0) = 0;
CDREG(1) = cmd;
// Depending on the number of INTs we expect for a command,
// we wait for an INT to occur, we store the response data returned,
// and we flush the INT.
for(x = 0; x < (cdrom_command_type[cmd] + 1); x++)
{
CDREG(0) = 1;
while((CDREG(3) & 7) == 0);
cdrom_command_stat[x] = CDREG(1);
CDREG(0) = 1;
CDREG(3) = 7;
}
// Store ID number of last executed command (this)
cdrom_last_command = cmd;
va_end(ap);
}
int CdReadResults(unsigned char *out, int max)
{
int x;
unsigned char *outo = out;
unsigned char b;
for(x = 0; x < (cdrom_command_type[cdrom_last_command] + 1); x++)
{
if(max > 0)
{
*(out++) = cdrom_command_stat[x];
max--;
}
}
CDREG(0) = 1;
while(CDREG(0) & 0x20)
{
b = CDREG(1);
if(max>0)
{
*(out++) = b;
max--;
}
}
return (out-outo);
}
void _internal_cdromlib_callback()
{
// 0 = ACKNOWLEDGE (0x*2)
// 1 = ACKNOWLEDGE (0x*2), COMPLETE (0x*3)
/* int x;
unsigned char i;
if(cdrom_command_done)
return;
for(x = 0; x < 100; x++); // Waste time
CDREG(0) = 1;
i=CDREG(3);
if((i&0xf)==5) // Error
cdrom_command_done = 1;
//printf("i&0xf = %x\n", i&0xf);
// printf("cdrom_direct_cmd = %x\n", cdrom_direct_cmd);
switch(kind[cdrom_direct_cmd])
{
case 0:
if(((i&0xf)==3) || ((i&0xf) == 2))
cdrom_command_done = 1;
break;
case 1:
if((i&0xf)==2)
cdrom_command_done = 1;
break;
case 0xFF: // Unknown command!
cdrom_command_done = 1;
return;
break;
}
cdrom_command_stat[0] = i;
for(x = 0; x < 100; x++); // Waste time
CDREG(0) = 1;
CDREG(3) = 7;
i = CDREG(1);
cdrom_command_stat[1] = i;
//printf("cdrom_command_done = %d\n", cdrom_command_done);*/
}
void _internal_cdromlib_init()
{
printf("Starting CDROMlib...\n");
EnterCriticalSection(); // Disable IRQs
SysEnqIntRP(0, cdrom_queue_buf);
IMASK|=4;
cdrom_handler_callback = _internal_cdromlib_callback;
ExitCriticalSection(); // Enable IRQs
}
int CdGetStatus()
{
unsigned char out;
CdSendCommand(CdlGetstat, 0);
CdReadResults(&out, 1);
return out;
}
int CdPlayTrack(unsigned int track)
{
while(CdGetStatus() & CDSTATUS_SEEK);
CdSendCommand(CdlSetmode, 1, 0x20);
CdSendCommand(CdlPlay, 1, ((track/10)<<4)|(track%10));
return 1;
}
unsigned char CdRamRead(unsigned short addr)
{
unsigned char b;
addr &= 0x3ff;
CdSendCommand(0x19, 0x60, addr&0xff, addr >> 8);
CdReadResults(&b, 1);
return b;
}
|
