change lcf handling
[pcsx_rearmed.git] / libpcsxcore / psxcounters.c
CommitLineData
ef79bbde
P
1/***************************************************************************
2 * Copyright (C) 2010 by Blade_Arma *
3 * *
4 * This program is free software; you can redistribute it and/or modify *
5 * it under the terms of the GNU General Public License as published by *
6 * the Free Software Foundation; either version 2 of the License, or *
7 * (at your option) any later version. *
8 * *
9 * This program is distributed in the hope that it will be useful, *
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
12 * GNU General Public License for more details. *
13 * *
14 * You should have received a copy of the GNU General Public License *
15 * along with this program; if not, write to the *
16 * Free Software Foundation, Inc., *
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA. *
18 ***************************************************************************/
19
20/*
21 * Internal PSX counters.
22 */
23
24#include "psxcounters.h"
ddbaf678 25#include "gpu.h"
fc8145b7 26#include "debug.h"
ef79bbde
P
27
28/******************************************************************************/
29
ef79bbde
P
30enum
31{
32 Rc0Gate = 0x0001, // 0 not implemented
33 Rc1Gate = 0x0001, // 0 not implemented
34 Rc2Disable = 0x0001, // 0 partially implemented
35 RcUnknown1 = 0x0002, // 1 ?
36 RcUnknown2 = 0x0004, // 2 ?
37 RcCountToTarget = 0x0008, // 3
38 RcIrqOnTarget = 0x0010, // 4
39 RcIrqOnOverflow = 0x0020, // 5
40 RcIrqRegenerate = 0x0040, // 6
41 RcUnknown7 = 0x0080, // 7 ?
42 Rc0PixelClock = 0x0100, // 8 fake implementation
43 Rc1HSyncClock = 0x0100, // 8
44 Rc2Unknown8 = 0x0100, // 8 ?
45 Rc0Unknown9 = 0x0200, // 9 ?
46 Rc1Unknown9 = 0x0200, // 9 ?
47 Rc2OneEighthClock = 0x0200, // 9
48 RcUnknown10 = 0x0400, // 10 ?
49 RcCountEqTarget = 0x0800, // 11
50 RcOverflow = 0x1000, // 12
51 RcUnknown13 = 0x2000, // 13 ? (always zero)
52 RcUnknown14 = 0x4000, // 14 ? (always zero)
53 RcUnknown15 = 0x8000, // 15 ? (always zero)
54};
55
56#define CounterQuantity ( 4 )
57//static const u32 CounterQuantity = 4;
58
59static const u32 CountToOverflow = 0;
60static const u32 CountToTarget = 1;
61
62static const u32 FrameRate[] = { 60, 50 };
aecf98c5 63static const u32 HSyncTotal[] = { 263, 313 };
554a2220 64static const u32 SpuUpdInterval[] = { 32, 32 };
0486fdc9 65#define VBlankStart 240
ef79bbde 66
9f7ee52e 67#define VERBOSE_LEVEL 0
68static const s32 VerboseLevel = VERBOSE_LEVEL;
ef79bbde
P
69
70/******************************************************************************/
71
b1be1eee 72Rcnt rcnts[ CounterQuantity ];
ef79bbde 73
24de2dd4 74u32 hSyncCount = 0;
75u32 frame_counter = 0;
ef79bbde 76static u32 spuSyncCount = 0;
61ef5cf4 77static u32 hsync_steps = 0;
4f55097d 78static u32 base_cycle = 0;
ef79bbde
P
79
80u32 psxNextCounter = 0, psxNextsCounter = 0;
81
82/******************************************************************************/
83
84static inline
85void setIrq( u32 irq )
86{
87 psxHu32ref(0x1070) |= SWAPu32(irq);
88}
89
90static
9f7ee52e 91void verboseLog( u32 level, const char *str, ... )
ef79bbde 92{
9f7ee52e 93#if VERBOSE_LEVEL > 0
ef79bbde
P
94 if( level <= VerboseLevel )
95 {
96 va_list va;
97 char buf[ 4096 ];
98
99 va_start( va, str );
100 vsprintf( buf, str, va );
101 va_end( va );
102
ab948f7e 103 printf( "%s", buf );
ef79bbde
P
104 fflush( stdout );
105 }
9f7ee52e 106#endif
ef79bbde
P
107}
108
109/******************************************************************************/
110
111static inline
112void _psxRcntWcount( u32 index, u32 value )
113{
114 if( value > 0xffff )
115 {
116 verboseLog( 1, "[RCNT %i] wcount > 0xffff: %x\n", index, value );
117 value &= 0xffff;
118 }
119
120 rcnts[index].cycleStart = psxRegs.cycle;
121 rcnts[index].cycleStart -= value * rcnts[index].rate;
122
123 // TODO: <=.
124 if( value < rcnts[index].target )
125 {
126 rcnts[index].cycle = rcnts[index].target * rcnts[index].rate;
127 rcnts[index].counterState = CountToTarget;
128 }
129 else
130 {
131 rcnts[index].cycle = 0xffff * rcnts[index].rate;
132 rcnts[index].counterState = CountToOverflow;
133 }
134}
135
136static inline
137u32 _psxRcntRcount( u32 index )
138{
139 u32 count;
140
141 count = psxRegs.cycle;
142 count -= rcnts[index].cycleStart;
61ef5cf4 143 if (rcnts[index].rate > 1)
144 count /= rcnts[index].rate;
ef79bbde
P
145
146 if( count > 0xffff )
147 {
148 verboseLog( 1, "[RCNT %i] rcount > 0xffff: %x\n", index, count );
149 count &= 0xffff;
150 }
151
152 return count;
153}
154
155/******************************************************************************/
156
157static
158void psxRcntSet()
159{
160 s32 countToUpdate;
161 u32 i;
162
163 psxNextsCounter = psxRegs.cycle;
164 psxNextCounter = 0x7fffffff;
165
166 for( i = 0; i < CounterQuantity; ++i )
167 {
168 countToUpdate = rcnts[i].cycle - (psxNextsCounter - rcnts[i].cycleStart);
169
170 if( countToUpdate < 0 )
171 {
172 psxNextCounter = 0;
173 break;
174 }
175
176 if( countToUpdate < (s32)psxNextCounter )
177 {
178 psxNextCounter = countToUpdate;
179 }
180 }
5b8c000f 181
182 psxRegs.interrupt |= (1 << PSXINT_RCNT);
183 new_dyna_set_event(PSXINT_RCNT, psxNextCounter);
ef79bbde
P
184}
185
186/******************************************************************************/
187
188static
189void psxRcntReset( u32 index )
190{
191 u32 count;
192
53c361f0 193 rcnts[index].mode |= RcUnknown10;
194
ef79bbde
P
195 if( rcnts[index].counterState == CountToTarget )
196 {
95df1a04 197 count = psxRegs.cycle;
198 count -= rcnts[index].cycleStart;
199 if( rcnts[index].rate > 1 )
200 count /= rcnts[index].rate;
ef79bbde 201 if( rcnts[index].mode & RcCountToTarget )
ef79bbde 202 count -= rcnts[index].target;
ef79bbde
P
203
204 _psxRcntWcount( index, count );
205
206 if( rcnts[index].mode & RcIrqOnTarget )
207 {
208 if( (rcnts[index].mode & RcIrqRegenerate) || (!rcnts[index].irqState) )
209 {
210 verboseLog( 3, "[RCNT %i] irq: %x\n", index, count );
211 setIrq( rcnts[index].irq );
212 rcnts[index].irqState = 1;
213 }
214 }
215
216 rcnts[index].mode |= RcCountEqTarget;
53c361f0 217
53c361f0 218 if( count < 0xffff ) // special case, overflow too?
219 return;
ef79bbde 220 }
53c361f0 221
222 if( rcnts[index].counterState == CountToOverflow )
ef79bbde
P
223 {
224 count = psxRegs.cycle;
225 count -= rcnts[index].cycleStart;
61ef5cf4 226 if (rcnts[index].rate > 1)
227 count /= rcnts[index].rate;
ef79bbde
P
228 count -= 0xffff;
229
230 _psxRcntWcount( index, count );
231
232 if( rcnts[index].mode & RcIrqOnOverflow )
233 {
234 if( (rcnts[index].mode & RcIrqRegenerate) || (!rcnts[index].irqState) )
235 {
236 verboseLog( 3, "[RCNT %i] irq: %x\n", index, count );
237 setIrq( rcnts[index].irq );
238 rcnts[index].irqState = 1;
239 }
240 }
241
242 rcnts[index].mode |= RcOverflow;
243 }
ef79bbde
P
244}
245
246void psxRcntUpdate()
247{
248 u32 cycle;
249
250 cycle = psxRegs.cycle;
251
252 // rcnt 0.
253 if( cycle - rcnts[0].cycleStart >= rcnts[0].cycle )
254 {
255 psxRcntReset( 0 );
256 }
257
258 // rcnt 1.
259 if( cycle - rcnts[1].cycleStart >= rcnts[1].cycle )
260 {
261 psxRcntReset( 1 );
262 }
263
264 // rcnt 2.
265 if( cycle - rcnts[2].cycleStart >= rcnts[2].cycle )
266 {
267 psxRcntReset( 2 );
268 }
269
270 // rcnt base.
271 if( cycle - rcnts[3].cycleStart >= rcnts[3].cycle )
272 {
61ef5cf4 273 u32 leftover_cycles = cycle - rcnts[3].cycleStart - rcnts[3].cycle;
274 u32 next_vsync, next_lace;
ef79bbde 275
61ef5cf4 276 spuSyncCount += hsync_steps;
277 hSyncCount += hsync_steps;
ef79bbde
P
278
279 // Update spu.
280 if( spuSyncCount >= SpuUpdInterval[Config.PsxType] )
281 {
282 spuSyncCount = 0;
283
284 if( SPU_async )
285 {
286 SPU_async( SpuUpdInterval[Config.PsxType] * rcnts[3].target );
287 }
288 }
289
290 // VSync irq.
0486fdc9 291 if( hSyncCount == VBlankStart )
ef79bbde 292 {
0486fdc9 293 HW_GPU_STATUS &= ~PSXGPU_LCF;
ddbaf678 294
8bbbd091 295 setIrq( 0x01 );
296
297 EmuUpdate();
298 GPU_updateLace();
ef79bbde
P
299 }
300
301 // Update lace. (with InuYasha fix)
302 if( hSyncCount >= (Config.VSyncWA ? HSyncTotal[Config.PsxType] / BIAS : HSyncTotal[Config.PsxType]) )
303 {
304 hSyncCount = 0;
ddbaf678 305 frame_counter++;
ef79bbde 306
0486fdc9 307 gpuSyncPluginSR();
308 if( (HW_GPU_STATUS & PSXGPU_ILACE_BITS) == PSXGPU_ILACE_BITS )
ddbaf678 309 HW_GPU_STATUS |= frame_counter << 31;
ef79bbde 310 }
61ef5cf4 311
312 // Schedule next call, in hsyncs
313 hsync_steps = SpuUpdInterval[Config.PsxType] - spuSyncCount;
0486fdc9 314 next_vsync = VBlankStart - hSyncCount; // ok to overflow
61ef5cf4 315 next_lace = HSyncTotal[Config.PsxType] - hSyncCount;
316 if( next_vsync && next_vsync < hsync_steps )
317 hsync_steps = next_vsync;
318 if( next_lace && next_lace < hsync_steps )
319 hsync_steps = next_lace;
61ef5cf4 320
321 rcnts[3].cycleStart = cycle - leftover_cycles;
4f55097d 322 if (Config.PsxType)
323 // 20.12 precision, clk / 50 / 313 ~= 2164.14
324 base_cycle += hsync_steps * 8864320;
325 else
326 // clk / 60 / 263 ~= 2146.31
327 base_cycle += hsync_steps * 8791293;
328 rcnts[3].cycle = base_cycle >> 12;
329 base_cycle &= 0xfff;
ef79bbde
P
330 }
331
95df1a04 332 psxRcntSet();
333
61ef5cf4 334#ifndef NDEBUG
ef79bbde 335 DebugVSync();
61ef5cf4 336#endif
ef79bbde
P
337}
338
339/******************************************************************************/
340
341void psxRcntWcount( u32 index, u32 value )
342{
343 verboseLog( 2, "[RCNT %i] wcount: %x\n", index, value );
344
ef79bbde
P
345 _psxRcntWcount( index, value );
346 psxRcntSet();
347}
348
349void psxRcntWmode( u32 index, u32 value )
350{
351 verboseLog( 1, "[RCNT %i] wmode: %x\n", index, value );
352
ef79bbde
P
353 rcnts[index].mode = value;
354 rcnts[index].irqState = 0;
355
356 switch( index )
357 {
358 case 0:
359 if( value & Rc0PixelClock )
360 {
361 rcnts[index].rate = 5;
362 }
363 else
364 {
365 rcnts[index].rate = 1;
366 }
367 break;
368 case 1:
369 if( value & Rc1HSyncClock )
370 {
371 rcnts[index].rate = (PSXCLK / (FrameRate[Config.PsxType] * HSyncTotal[Config.PsxType]));
372 }
373 else
374 {
375 rcnts[index].rate = 1;
376 }
377 break;
378 case 2:
379 if( value & Rc2OneEighthClock )
380 {
381 rcnts[index].rate = 8;
382 }
383 else
384 {
385 rcnts[index].rate = 1;
386 }
387
388 // TODO: wcount must work.
389 if( value & Rc2Disable )
390 {
391 rcnts[index].rate = 0xffffffff;
392 }
393 break;
394 }
395
396 _psxRcntWcount( index, 0 );
397 psxRcntSet();
398}
399
400void psxRcntWtarget( u32 index, u32 value )
401{
402 verboseLog( 1, "[RCNT %i] wtarget: %x\n", index, value );
403
ef79bbde
P
404 rcnts[index].target = value;
405
406 _psxRcntWcount( index, _psxRcntRcount( index ) );
407 psxRcntSet();
408}
409
410/******************************************************************************/
411
412u32 psxRcntRcount( u32 index )
413{
414 u32 count;
415
ef79bbde
P
416 count = _psxRcntRcount( index );
417
418 // Parasite Eve 2 fix.
419 if( Config.RCntFix )
420 {
421 if( index == 2 )
422 {
423 if( rcnts[index].counterState == CountToTarget )
424 {
425 count /= BIAS;
426 }
427 }
428 }
429
430 verboseLog( 2, "[RCNT %i] rcount: %x\n", index, count );
431
432 return count;
433}
434
435u32 psxRcntRmode( u32 index )
436{
437 u16 mode;
438
ef79bbde
P
439 mode = rcnts[index].mode;
440 rcnts[index].mode &= 0xe7ff;
441
442 verboseLog( 2, "[RCNT %i] rmode: %x\n", index, mode );
443
444 return mode;
445}
446
447u32 psxRcntRtarget( u32 index )
448{
449 verboseLog( 2, "[RCNT %i] rtarget: %x\n", index, rcnts[index].target );
450
451 return rcnts[index].target;
452}
453
454/******************************************************************************/
455
456void psxRcntInit()
457{
458 s32 i;
459
460 // rcnt 0.
461 rcnts[0].rate = 1;
462 rcnts[0].irq = 0x10;
463
464 // rcnt 1.
465 rcnts[1].rate = 1;
466 rcnts[1].irq = 0x20;
467
468 // rcnt 2.
469 rcnts[2].rate = 1;
470 rcnts[2].irq = 0x40;
471
472 // rcnt base.
473 rcnts[3].rate = 1;
474 rcnts[3].mode = RcCountToTarget;
475 rcnts[3].target = (PSXCLK / (FrameRate[Config.PsxType] * HSyncTotal[Config.PsxType]));
476
477 for( i = 0; i < CounterQuantity; ++i )
478 {
479 _psxRcntWcount( i, 0 );
480 }
481
c62b43c9 482 hSyncCount = 0;
483 spuSyncCount = 0;
61ef5cf4 484 hsync_steps = 1;
c62b43c9 485
ef79bbde
P
486 psxRcntSet();
487}
488
489/******************************************************************************/
490
491s32 psxRcntFreeze( gzFile f, s32 Mode )
492{
493 gzfreeze( &rcnts, sizeof(rcnts) );
494 gzfreeze( &hSyncCount, sizeof(hSyncCount) );
495 gzfreeze( &spuSyncCount, sizeof(spuSyncCount) );
496 gzfreeze( &psxNextCounter, sizeof(psxNextCounter) );
497 gzfreeze( &psxNextsCounter, sizeof(psxNextsCounter) );
498
61ef5cf4 499 if (Mode == 0)
500 hsync_steps = (psxRegs.cycle - rcnts[3].cycleStart) / rcnts[3].target;
501
4f55097d 502 base_cycle = 0;
503
ef79bbde
P
504 return 0;
505}
506
507/******************************************************************************/