[pcsx_rearmed.git] / libpcsxcore / psxcounters.c

/***************************************************************************
 *   Copyright (C) 2010 by Blade_Arma                                      *
 *                                                                         *
 *   This program is free software; you can redistribute it and/or modify  *
 *   it under the terms of the GNU General Public License as published by  *
 *   the Free Software Foundation; either version 2 of the License, or     *
 *   (at your option) any later version.                                   *
 *                                                                         *
 *   This program is distributed in the hope that it will be useful,       *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
 *   GNU General Public License for more details.                          *
 *                                                                         *
 *   You should have received a copy of the GNU General Public License     *
 *   along with this program; if not, write to the                         *
 *   Free Software Foundation, Inc.,                                       *
 *   51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA.           *
 ***************************************************************************/

/*
 * Internal PSX counters.
 */

#include "psxcounters.h"
#include "gpu.h"
//#include "debug.h"
#define DebugVSync()

/******************************************************************************/

enum
{
    Rc0Gate           = 0x0001, // 0    not implemented
    Rc1Gate           = 0x0001, // 0    not implemented
    Rc2Disable        = 0x0001, // 0    partially implemented
    RcUnknown1        = 0x0002, // 1    ?
    RcUnknown2        = 0x0004, // 2    ?
    RcCountToTarget   = 0x0008, // 3
    RcIrqOnTarget     = 0x0010, // 4
    RcIrqOnOverflow   = 0x0020, // 5
    RcIrqRegenerate   = 0x0040, // 6
    RcUnknown7        = 0x0080, // 7    ?
    Rc0PixelClock     = 0x0100, // 8    fake implementation
    Rc1HSyncClock     = 0x0100, // 8
    Rc2Unknown8       = 0x0100, // 8    ?
    Rc0Unknown9       = 0x0200, // 9    ?
    Rc1Unknown9       = 0x0200, // 9    ?
    Rc2OneEighthClock = 0x0200, // 9
    RcUnknown10       = 0x0400, // 10   ?
    RcCountEqTarget   = 0x0800, // 11
    RcOverflow        = 0x1000, // 12
    RcUnknown13       = 0x2000, // 13   ? (always zero)
    RcUnknown14       = 0x4000, // 14   ? (always zero)
    RcUnknown15       = 0x8000, // 15   ? (always zero)
};

#define CounterQuantity           ( 4 )
//static const u32 CounterQuantity  = 4;

static const u32 CountToOverflow  = 0;
static const u32 CountToTarget    = 1;

static const u32 FrameRate[]      = { 60, 50 };
static const u32 HSyncTotal[]     = { 263, 314 }; // actually one more on odd lines for PAL
#define VBlankStart 240

#define VERBOSE_LEVEL 0

/******************************************************************************/
#ifdef DRC_DISABLE
Rcnt rcnts[ CounterQuantity ];
#endif
u32 hSyncCount = 0;
u32 frame_counter = 0;
static u32 hsync_steps = 0;

u32 psxNextCounter = 0, psxNextsCounter = 0;

/******************************************************************************/

static inline
void setIrq( u32 irq )
{
    psxHu32ref(0x1070) |= SWAPu32(irq);
}

static
void verboseLog( u32 level, const char *str, ... )
{
#if VERBOSE_LEVEL > 0
    if( level <= VERBOSE_LEVEL )
    {
        va_list va;
        char buf[ 4096 ];

        va_start( va, str );
        vsprintf( buf, str, va );
        va_end( va );

        printf( "%s", buf );
        fflush( stdout );
    }
#endif
}

/******************************************************************************/

static inline
void _psxRcntWcount( u32 index, u32 value )
{
    if( value > 0xffff )
    {
        verboseLog( 1, "[RCNT %i] wcount > 0xffff: %x\n", index, value );
        value &= 0xffff;
    }

    rcnts[index].cycleStart  = psxRegs.cycle;
    rcnts[index].cycleStart -= value * rcnts[index].rate;

    // TODO: <=.
    if( value < rcnts[index].target )
    {
        rcnts[index].cycle = rcnts[index].target * rcnts[index].rate;
        rcnts[index].counterState = CountToTarget;
    }
    else
    {
        rcnts[index].cycle = 0x10000 * rcnts[index].rate;
        rcnts[index].counterState = CountToOverflow;
    }
}

static inline
u32 _psxRcntRcount( u32 index )
{
    u32 count;

    count  = psxRegs.cycle;
    count -= rcnts[index].cycleStart;
    if (rcnts[index].rate > 1)
        count /= rcnts[index].rate;

    if( count > 0x10000 )
    {
        verboseLog( 1, "[RCNT %i] rcount > 0x10000: %x\n", index, count );
    }
    count &= 0xffff;

    return count;
}

static
void _psxRcntWmode( u32 index, u32 value )
{
    rcnts[index].mode = value;

    switch( index )
    {
        case 0:
            if( value & Rc0PixelClock )
            {
                rcnts[index].rate = 5;
            }
            else
            {
                rcnts[index].rate = 1;
            }
        break;
        case 1:
            if( value & Rc1HSyncClock )
            {
                rcnts[index].rate = (PSXCLK / (FrameRate[Config.PsxType] * HSyncTotal[Config.PsxType]));
            }
            else
            {
                rcnts[index].rate = 1;
            }
        break;
        case 2:
            if( value & Rc2OneEighthClock )
            {
                rcnts[index].rate = 8;
            }
            else
            {
                rcnts[index].rate = 1;
            }

            // TODO: wcount must work.
            if( value & Rc2Disable )
            {
                rcnts[index].rate = 0xffffffff;
            }
        break;
    }
}

/******************************************************************************/

static
void psxRcntSet()
{
    s32 countToUpdate;
    u32 i;

    psxNextsCounter = psxRegs.cycle;
    psxNextCounter  = 0x7fffffff;

    for( i = 0; i < CounterQuantity; ++i )
    {
        countToUpdate = rcnts[i].cycle - (psxNextsCounter - rcnts[i].cycleStart);

        if( countToUpdate < 0 )
        {
            psxNextCounter = 0;
            break;
        }

        if( countToUpdate < (s32)psxNextCounter )
        {
            psxNextCounter = countToUpdate;
        }
    }

    psxRegs.interrupt |= (1 << PSXINT_RCNT);
    new_dyna_set_event(PSXINT_RCNT, psxNextCounter);
}

/******************************************************************************/

static
void psxRcntReset( u32 index )
{
    u32 rcycles;

    rcnts[index].mode |= RcUnknown10;

    if( rcnts[index].counterState == CountToTarget )
    {
        rcycles = psxRegs.cycle - rcnts[index].cycleStart;
        if( rcnts[index].mode & RcCountToTarget )
        {
            rcycles -= rcnts[index].target * rcnts[index].rate;
            rcnts[index].cycleStart = psxRegs.cycle - rcycles;
        }
        else
        {
            rcnts[index].cycle = 0x10000 * rcnts[index].rate;
            rcnts[index].counterState = CountToOverflow;
        }

        if( rcnts[index].mode & RcIrqOnTarget )
        {
            if( (rcnts[index].mode & RcIrqRegenerate) || (!rcnts[index].irqState) )
            {
                verboseLog( 3, "[RCNT %i] irq\n", index );
                setIrq( rcnts[index].irq );
                rcnts[index].irqState = 1;
            }
        }

        rcnts[index].mode |= RcCountEqTarget;

        if( rcycles < 0x10000 * rcnts[index].rate )
            return;
    }

    if( rcnts[index].counterState == CountToOverflow )
    {
        rcycles = psxRegs.cycle - rcnts[index].cycleStart;
        rcycles -= 0x10000 * rcnts[index].rate;

        rcnts[index].cycleStart = psxRegs.cycle - rcycles;

        if( rcycles < rcnts[index].target * rcnts[index].rate )
        {
            rcnts[index].cycle = rcnts[index].target * rcnts[index].rate;
            rcnts[index].counterState = CountToTarget;
        }

        if( rcnts[index].mode & RcIrqOnOverflow )
        {
            if( (rcnts[index].mode & RcIrqRegenerate) || (!rcnts[index].irqState) )
            {
                verboseLog( 3, "[RCNT %i] irq\n", index );
                setIrq( rcnts[index].irq );
                rcnts[index].irqState = 1;
            }
        }

        rcnts[index].mode |= RcOverflow;
    }
}

static void scheduleRcntBase(void)
{
    // Schedule next call, in hsyncs
    if (hSyncCount < VBlankStart)
        hsync_steps = VBlankStart - hSyncCount;
    else
        hsync_steps = HSyncTotal[Config.PsxType] - hSyncCount;

    if (hSyncCount + hsync_steps == HSyncTotal[Config.PsxType])
    {
        rcnts[3].cycle = Config.PsxType ? PSXCLK / 50 : PSXCLK / 60;
    }
    else
    {
        // clk / 50 / 314 ~= 2157.25
        // clk / 60 / 263 ~= 2146.31
        u32 mult = Config.PsxType ? 8836089 : 8791293;
        rcnts[3].cycle = hsync_steps * mult >> 12;
    }
}

void psxRcntUpdate()
{
    u32 cycle;

    cycle = psxRegs.cycle;

    // rcnt 0.
    while( cycle - rcnts[0].cycleStart >= rcnts[0].cycle )
    {
        psxRcntReset( 0 );
    }

    // rcnt 1.
    while( cycle - rcnts[1].cycleStart >= rcnts[1].cycle )
    {
        psxRcntReset( 1 );
    }

    // rcnt 2.
    while( cycle - rcnts[2].cycleStart >= rcnts[2].cycle )
    {
        psxRcntReset( 2 );
    }

    // rcnt base.
    if( cycle - rcnts[3].cycleStart >= rcnts[3].cycle )
    {
        hSyncCount += hsync_steps;

        // VSync irq.
        if( hSyncCount == VBlankStart )
        {
            HW_GPU_STATUS &= SWAP32(~PSXGPU_LCF);
            GPU_vBlank( 1, 0 );
            setIrq( 0x01 );

            EmuUpdate();
            GPU_updateLace();

            if( SPU_async )
            {
                SPU_async( cycle, 1 );
            }
        }
        
        // Update lace. (with InuYasha fix)
        if( hSyncCount >= (Config.VSyncWA ? HSyncTotal[Config.PsxType] / BIAS : HSyncTotal[Config.PsxType]) )
        {
            rcnts[3].cycleStart += Config.PsxType ? PSXCLK / 50 : PSXCLK / 60;
            hSyncCount = 0;
            frame_counter++;

            gpuSyncPluginSR();
            if ((HW_GPU_STATUS & SWAP32(PSXGPU_ILACE_BITS)) == SWAP32(PSXGPU_ILACE_BITS))
                HW_GPU_STATUS |= SWAP32(frame_counter << 31);
            GPU_vBlank(0, SWAP32(HW_GPU_STATUS) >> 31);
        }

        scheduleRcntBase();
    }

    psxRcntSet();

#ifndef NDEBUG
    DebugVSync();
#endif
}

/******************************************************************************/

void psxRcntWcount( u32 index, u32 value )
{
    verboseLog( 2, "[RCNT %i] wcount: %x\n", index, value );

    _psxRcntWcount( index, value );
    psxRcntSet();
}

void psxRcntWmode( u32 index, u32 value )
{
    verboseLog( 1, "[RCNT %i] wmode: %x\n", index, value );

    _psxRcntWmode( index, value );
    _psxRcntWcount( index, 0 );

    rcnts[index].irqState = 0;
    psxRcntSet();
}

void psxRcntWtarget( u32 index, u32 value )
{
    verboseLog( 1, "[RCNT %i] wtarget: %x\n", index, value );

    rcnts[index].target = value;

    _psxRcntWcount( index, _psxRcntRcount( index ) );
    psxRcntSet();
}

/******************************************************************************/

u32 psxRcntRcount( u32 index )
{
    u32 count;

    count = _psxRcntRcount( index );

    // Parasite Eve 2 fix.
    if( Config.RCntFix )
    {
        if( index == 2 )
        {
            if( rcnts[index].counterState == CountToTarget )
            {
                count /= BIAS;
            }
        }
    }

    verboseLog( 2, "[RCNT %i] rcount: %x\n", index, count );

    return count;
}

u32 psxRcntRmode( u32 index )
{
    u16 mode;

    mode = rcnts[index].mode;
    rcnts[index].mode &= 0xe7ff;

    verboseLog( 2, "[RCNT %i] rmode: %x\n", index, mode );

    return mode;
}

u32 psxRcntRtarget( u32 index )
{
    verboseLog( 2, "[RCNT %i] rtarget: %x\n", index, rcnts[index].target );

    return rcnts[index].target;
}

/******************************************************************************/

void psxRcntInit()
{
    s32 i;

    // rcnt 0.
    rcnts[0].rate   = 1;
    rcnts[0].irq    = 0x10;

    // rcnt 1.
    rcnts[1].rate   = 1;
    rcnts[1].irq    = 0x20;

    // rcnt 2.
    rcnts[2].rate   = 1;
    rcnts[2].irq    = 0x40;

    // rcnt base.
    rcnts[3].rate   = 1;
    rcnts[3].mode   = RcCountToTarget;
    rcnts[3].target = (PSXCLK / (FrameRate[Config.PsxType] * HSyncTotal[Config.PsxType]));

    for( i = 0; i < CounterQuantity; ++i )
    {
        _psxRcntWcount( i, 0 );
    }

    hSyncCount = 0;
    hsync_steps = 1;

    psxRcntSet();
}

/******************************************************************************/

s32 psxRcntFreeze( void *f, s32 Mode )
{
    u32 spuSyncCount = 0;
    u32 count;
    s32 i;

    gzfreeze( &rcnts, sizeof(Rcnt) * CounterQuantity );
    gzfreeze( &hSyncCount, sizeof(hSyncCount) );
    gzfreeze( &spuSyncCount, sizeof(spuSyncCount) );
    gzfreeze( &psxNextCounter, sizeof(psxNextCounter) );
    gzfreeze( &psxNextsCounter, sizeof(psxNextsCounter) );

    if (Mode == 0)
    {
        // don't trust things from a savestate
        rcnts[3].rate = 1;
        for( i = 0; i < CounterQuantity; ++i )
        {
            _psxRcntWmode( i, rcnts[i].mode );
            count = (psxRegs.cycle - rcnts[i].cycleStart) / rcnts[i].rate;
            _psxRcntWcount( i, count );
        }
        scheduleRcntBase();
        psxRcntSet();
    }

    return 0;
}

/******************************************************************************/
// vim:ts=4:shiftwidth=4:expandtab
Commit	Line	Data
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"
7d7672a5	26	//#include "debug.h"
7d7672a5	27	#define DebugVSync()
ef79bbde P	28
	29	/******************************************************************************/
	30
ef79bbde P	31	enum
	32	{
	33	Rc0Gate = 0x0001, // 0 not implemented
	34	Rc1Gate = 0x0001, // 0 not implemented
	35	Rc2Disable = 0x0001, // 0 partially implemented
	36	RcUnknown1 = 0x0002, // 1 ?
	37	RcUnknown2 = 0x0004, // 2 ?
	38	RcCountToTarget = 0x0008, // 3
	39	RcIrqOnTarget = 0x0010, // 4
	40	RcIrqOnOverflow = 0x0020, // 5
	41	RcIrqRegenerate = 0x0040, // 6
	42	RcUnknown7 = 0x0080, // 7 ?
	43	Rc0PixelClock = 0x0100, // 8 fake implementation
	44	Rc1HSyncClock = 0x0100, // 8
	45	Rc2Unknown8 = 0x0100, // 8 ?
	46	Rc0Unknown9 = 0x0200, // 9 ?
	47	Rc1Unknown9 = 0x0200, // 9 ?
	48	Rc2OneEighthClock = 0x0200, // 9
	49	RcUnknown10 = 0x0400, // 10 ?
	50	RcCountEqTarget = 0x0800, // 11
	51	RcOverflow = 0x1000, // 12
	52	RcUnknown13 = 0x2000, // 13 ? (always zero)
	53	RcUnknown14 = 0x4000, // 14 ? (always zero)
	54	RcUnknown15 = 0x8000, // 15 ? (always zero)
	55	};
	56
	57	#define CounterQuantity ( 4 )
	58	//static const u32 CounterQuantity = 4;
	59
	60	static const u32 CountToOverflow = 0;
	61	static const u32 CountToTarget = 1;
	62
	63	static const u32 FrameRate[] = { 60, 50 };
91f412c2	64	static const u32 HSyncTotal[] = { 263, 314 }; // actually one more on odd lines for PAL
0486fdc9	65	#define VBlankStart 240
ef79bbde	66
9f7ee52e	67	#define VERBOSE_LEVEL 0
ef79bbde P	68
ef79bbde P	69	/******************************************************************************/
41e82ad4	70	#ifdef DRC_DISABLE
b1be1eee	71	Rcnt rcnts[ CounterQuantity ];
41e82ad4	72	#endif
24de2dd4	73	u32 hSyncCount = 0;
24de2dd4	74	u32 frame_counter = 0;
61ef5cf4	75	static u32 hsync_steps = 0;
ef79bbde P	76
	77	u32 psxNextCounter = 0, psxNextsCounter = 0;
	78
	79	/******************************************************************************/
	80
	81	static inline
	82	void setIrq( u32 irq )
	83	{
	84	psxHu32ref(0x1070) \|= SWAPu32(irq);
	85	}
	86
	87	static
9f7ee52e	88	void verboseLog( u32 level, const char *str, ... )
ef79bbde	89	{
9f7ee52e	90	#if VERBOSE_LEVEL > 0
3cf51e08	91	if( level <= VERBOSE_LEVEL )
ef79bbde P	92	{
	93	va_list va;
	94	char buf[ 4096 ];
	95
	96	va_start( va, str );
	97	vsprintf( buf, str, va );
	98	va_end( va );
	99
ab948f7e	100	printf( "%s", buf );
ef79bbde P	101	fflush( stdout );
ef79bbde P	102	}
9f7ee52e	103	#endif
ef79bbde P	104	}
	105
	106	/******************************************************************************/
	107
	108	static inline
	109	void _psxRcntWcount( u32 index, u32 value )
	110	{
	111	if( value > 0xffff )
	112	{
	113	verboseLog( 1, "[RCNT %i] wcount > 0xffff: %x\n", index, value );
	114	value &= 0xffff;
	115	}
	116
	117	rcnts[index].cycleStart = psxRegs.cycle;
	118	rcnts[index].cycleStart -= value * rcnts[index].rate;
	119
	120	// TODO: <=.
	121	if( value < rcnts[index].target )
	122	{
	123	rcnts[index].cycle = rcnts[index].target * rcnts[index].rate;
	124	rcnts[index].counterState = CountToTarget;
	125	}
	126	else
	127	{
8ca6b0a6	128	rcnts[index].cycle = 0x10000 * rcnts[index].rate;
ef79bbde P	129	rcnts[index].counterState = CountToOverflow;
	130	}
	131	}
	132
	133	static inline
	134	u32 _psxRcntRcount( u32 index )
	135	{
	136	u32 count;
	137
	138	count = psxRegs.cycle;
	139	count -= rcnts[index].cycleStart;
61ef5cf4	140	if (rcnts[index].rate > 1)
61ef5cf4	141	count /= rcnts[index].rate;
ef79bbde	142
8ca6b0a6	143	if( count > 0x10000 )
ef79bbde	144	{
8ca6b0a6	145	verboseLog( 1, "[RCNT %i] rcount > 0x10000: %x\n", index, count );
ef79bbde	146	}
8ca6b0a6	147	count &= 0xffff;
ef79bbde P	148
	149	return count;
	150	}
	151
a29f182f	152	static
	153	void _psxRcntWmode( u32 index, u32 value )
	154	{
	155	rcnts[index].mode = value;
	156
	157	switch( index )
	158	{
	159	case 0:
	160	if( value & Rc0PixelClock )
	161	{
	162	rcnts[index].rate = 5;
	163	}
	164	else
	165	{
	166	rcnts[index].rate = 1;
	167	}
	168	break;
	169	case 1:
	170	if( value & Rc1HSyncClock )
	171	{
	172	rcnts[index].rate = (PSXCLK / (FrameRate[Config.PsxType] * HSyncTotal[Config.PsxType]));
	173	}
	174	else
	175	{
	176	rcnts[index].rate = 1;
	177	}
	178	break;
	179	case 2:
	180	if( value & Rc2OneEighthClock )
	181	{
	182	rcnts[index].rate = 8;
	183	}
	184	else
	185	{
	186	rcnts[index].rate = 1;
	187	}
	188
	189	// TODO: wcount must work.
	190	if( value & Rc2Disable )
	191	{
	192	rcnts[index].rate = 0xffffffff;
	193	}
	194	break;
	195	}
	196	}
	197
ef79bbde P	198	/******************************************************************************/
	199
	200	static
	201	void psxRcntSet()
	202	{
	203	s32 countToUpdate;
	204	u32 i;
	205
	206	psxNextsCounter = psxRegs.cycle;
	207	psxNextCounter = 0x7fffffff;
	208
	209	for( i = 0; i < CounterQuantity; ++i )
	210	{
	211	countToUpdate = rcnts[i].cycle - (psxNextsCounter - rcnts[i].cycleStart);
	212
	213	if( countToUpdate < 0 )
	214	{
	215	psxNextCounter = 0;
	216	break;
	217	}
	218
	219	if( countToUpdate < (s32)psxNextCounter )
	220	{
	221	psxNextCounter = countToUpdate;
	222	}
	223	}
5b8c000f	224
	225	psxRegs.interrupt \|= (1 << PSXINT_RCNT);
	226	new_dyna_set_event(PSXINT_RCNT, psxNextCounter);
ef79bbde P	227	}
	228
	229	/******************************************************************************/
	230
	231	static
	232	void psxRcntReset( u32 index )
	233	{
8ca6b0a6	234	u32 rcycles;
ef79bbde	235
53c361f0	236	rcnts[index].mode \|= RcUnknown10;
53c361f0	237
ef79bbde P	238	if( rcnts[index].counterState == CountToTarget )
ef79bbde P	239	{
8ca6b0a6	240	rcycles = psxRegs.cycle - rcnts[index].cycleStart;
ef79bbde	241	if( rcnts[index].mode & RcCountToTarget )
8ca6b0a6	242	{
	243	rcycles -= rcnts[index].target * rcnts[index].rate;
	244	rcnts[index].cycleStart = psxRegs.cycle - rcycles;
	245	}
	246	else
	247	{
	248	rcnts[index].cycle = 0x10000 * rcnts[index].rate;
	249	rcnts[index].counterState = CountToOverflow;
	250	}
ef79bbde P	251
	252	if( rcnts[index].mode & RcIrqOnTarget )
	253	{
	254	if( (rcnts[index].mode & RcIrqRegenerate) \|\| (!rcnts[index].irqState) )
	255	{
8ca6b0a6	256	verboseLog( 3, "[RCNT %i] irq\n", index );
ef79bbde P	257	setIrq( rcnts[index].irq );
	258	rcnts[index].irqState = 1;
	259	}
	260	}
	261
	262	rcnts[index].mode \|= RcCountEqTarget;
53c361f0	263
8ca6b0a6	264	if( rcycles < 0x10000 * rcnts[index].rate )
53c361f0	265	return;
ef79bbde	266	}
53c361f0	267
53c361f0	268	if( rcnts[index].counterState == CountToOverflow )
ef79bbde	269	{
8ca6b0a6	270	rcycles = psxRegs.cycle - rcnts[index].cycleStart;
	271	rcycles -= 0x10000 * rcnts[index].rate;
	272
	273	rcnts[index].cycleStart = psxRegs.cycle - rcycles;
ef79bbde	274
8ca6b0a6	275	if( rcycles < rcnts[index].target * rcnts[index].rate )
	276	{
	277	rcnts[index].cycle = rcnts[index].target * rcnts[index].rate;
	278	rcnts[index].counterState = CountToTarget;
	279	}
ef79bbde P	280
	281	if( rcnts[index].mode & RcIrqOnOverflow )
	282	{
	283	if( (rcnts[index].mode & RcIrqRegenerate) \|\| (!rcnts[index].irqState) )
	284	{
8ca6b0a6	285	verboseLog( 3, "[RCNT %i] irq\n", index );
ef79bbde P	286	setIrq( rcnts[index].irq );
	287	rcnts[index].irqState = 1;
	288	}
	289	}
	290
	291	rcnts[index].mode \|= RcOverflow;
	292	}
ef79bbde P	293	}
ef79bbde P	294
ff2c2822	295	static void scheduleRcntBase(void)
	296	{
	297	// Schedule next call, in hsyncs
	298	if (hSyncCount < VBlankStart)
	299	hsync_steps = VBlankStart - hSyncCount;
	300	else
	301	hsync_steps = HSyncTotal[Config.PsxType] - hSyncCount;
	302
	303	if (hSyncCount + hsync_steps == HSyncTotal[Config.PsxType])
	304	{
	305	rcnts[3].cycle = Config.PsxType ? PSXCLK / 50 : PSXCLK / 60;
	306	}
	307	else
	308	{
	309	// clk / 50 / 314 ~= 2157.25
	310	// clk / 60 / 263 ~= 2146.31
	311	u32 mult = Config.PsxType ? 8836089 : 8791293;
	312	rcnts[3].cycle = hsync_steps * mult >> 12;
	313	}
	314	}
	315
ef79bbde P	316	void psxRcntUpdate()
	317	{
	318	u32 cycle;
	319
	320	cycle = psxRegs.cycle;
	321
	322	// rcnt 0.
e7851504	323	while( cycle - rcnts[0].cycleStart >= rcnts[0].cycle )
ef79bbde P	324	{
	325	psxRcntReset( 0 );
	326	}
	327
	328	// rcnt 1.
e7851504	329	while( cycle - rcnts[1].cycleStart >= rcnts[1].cycle )
ef79bbde P	330	{
	331	psxRcntReset( 1 );
	332	}
	333
	334	// rcnt 2.
e7851504	335	while( cycle - rcnts[2].cycleStart >= rcnts[2].cycle )
ef79bbde P	336	{
	337	psxRcntReset( 2 );
	338	}
	339
	340	// rcnt base.
	341	if( cycle - rcnts[3].cycleStart >= rcnts[3].cycle )
	342	{
61ef5cf4	343	hSyncCount += hsync_steps;
ef79bbde	344
ef79bbde	345	// VSync irq.
0486fdc9	346	if( hSyncCount == VBlankStart )
ef79bbde	347	{
086adfff	348	HW_GPU_STATUS &= SWAP32(~PSXGPU_LCF);
72e5023f	349	GPU_vBlank( 1, 0 );
8bbbd091	350	setIrq( 0x01 );
	351
	352	EmuUpdate();
	353	GPU_updateLace();
d618a240	354
	355	if( SPU_async )
	356	{
	357	SPU_async( cycle, 1 );
	358	}
ef79bbde P	359	}
	360
	361	// Update lace. (with InuYasha fix)
	362	if( hSyncCount >= (Config.VSyncWA ? HSyncTotal[Config.PsxType] / BIAS : HSyncTotal[Config.PsxType]) )
	363	{
ff2c2822	364	rcnts[3].cycleStart += Config.PsxType ? PSXCLK / 50 : PSXCLK / 60;
ef79bbde	365	hSyncCount = 0;
ddbaf678	366	frame_counter++;
ef79bbde	367
0486fdc9	368	gpuSyncPluginSR();
086adfff PC	369	if ((HW_GPU_STATUS & SWAP32(PSXGPU_ILACE_BITS)) == SWAP32(PSXGPU_ILACE_BITS))
	370	HW_GPU_STATUS \|= SWAP32(frame_counter << 31);
	371	GPU_vBlank(0, SWAP32(HW_GPU_STATUS) >> 31);
ef79bbde	372	}
61ef5cf4	373
ff2c2822	374	scheduleRcntBase();
ef79bbde P	375	}
ef79bbde P	376
95df1a04	377	psxRcntSet();
95df1a04	378
61ef5cf4	379	#ifndef NDEBUG
ef79bbde	380	DebugVSync();
61ef5cf4	381	#endif
ef79bbde P	382	}
	383
	384	/******************************************************************************/
	385
	386	void psxRcntWcount( u32 index, u32 value )
	387	{
	388	verboseLog( 2, "[RCNT %i] wcount: %x\n", index, value );
	389
ef79bbde P	390	_psxRcntWcount( index, value );
	391	psxRcntSet();
	392	}
	393
	394	void psxRcntWmode( u32 index, u32 value )
	395	{
	396	verboseLog( 1, "[RCNT %i] wmode: %x\n", index, value );
	397
a29f182f	398	_psxRcntWmode( index, value );
ef79bbde	399	_psxRcntWcount( index, 0 );
a29f182f	400
a29f182f	401	rcnts[index].irqState = 0;
ef79bbde P	402	psxRcntSet();
	403	}
	404
	405	void psxRcntWtarget( u32 index, u32 value )
	406	{
	407	verboseLog( 1, "[RCNT %i] wtarget: %x\n", index, value );
	408
ef79bbde P	409	rcnts[index].target = value;
	410
	411	_psxRcntWcount( index, _psxRcntRcount( index ) );
	412	psxRcntSet();
	413	}
	414
	415	/******************************************************************************/
	416
	417	u32 psxRcntRcount( u32 index )
	418	{
	419	u32 count;
	420
ef79bbde P	421	count = _psxRcntRcount( index );
	422
	423	// Parasite Eve 2 fix.
	424	if( Config.RCntFix )
	425	{
	426	if( index == 2 )
	427	{
	428	if( rcnts[index].counterState == CountToTarget )
	429	{
	430	count /= BIAS;
	431	}
	432	}
	433	}
	434
	435	verboseLog( 2, "[RCNT %i] rcount: %x\n", index, count );
	436
	437	return count;
	438	}
	439
	440	u32 psxRcntRmode( u32 index )
	441	{
	442	u16 mode;
	443
ef79bbde P	444	mode = rcnts[index].mode;
	445	rcnts[index].mode &= 0xe7ff;
	446
	447	verboseLog( 2, "[RCNT %i] rmode: %x\n", index, mode );
	448
	449	return mode;
	450	}
	451
	452	u32 psxRcntRtarget( u32 index )
	453	{
	454	verboseLog( 2, "[RCNT %i] rtarget: %x\n", index, rcnts[index].target );
	455
	456	return rcnts[index].target;
	457	}
	458
	459	/******************************************************************************/
	460
	461	void psxRcntInit()
	462	{
	463	s32 i;
	464
	465	// rcnt 0.
	466	rcnts[0].rate = 1;
	467	rcnts[0].irq = 0x10;
	468
	469	// rcnt 1.
	470	rcnts[1].rate = 1;
	471	rcnts[1].irq = 0x20;
	472
	473	// rcnt 2.
	474	rcnts[2].rate = 1;
	475	rcnts[2].irq = 0x40;
	476
	477	// rcnt base.
	478	rcnts[3].rate = 1;
	479	rcnts[3].mode = RcCountToTarget;
	480	rcnts[3].target = (PSXCLK / (FrameRate[Config.PsxType] * HSyncTotal[Config.PsxType]));
	481
	482	for( i = 0; i < CounterQuantity; ++i )
	483	{
	484	_psxRcntWcount( i, 0 );
	485	}
	486
c62b43c9	487	hSyncCount = 0;
61ef5cf4	488	hsync_steps = 1;
c62b43c9	489
ef79bbde P	490	psxRcntSet();
	491	}
	492
	493	/******************************************************************************/
	494
496d88d4	495	s32 psxRcntFreeze( void *f, s32 Mode )
ef79bbde	496	{
d618a240	497	u32 spuSyncCount = 0;
a29f182f	498	u32 count;
	499	s32 i;
	500
41e82ad4	501	gzfreeze( &rcnts, sizeof(Rcnt) * CounterQuantity );
ef79bbde P	502	gzfreeze( &hSyncCount, sizeof(hSyncCount) );
	503	gzfreeze( &spuSyncCount, sizeof(spuSyncCount) );
	504	gzfreeze( &psxNextCounter, sizeof(psxNextCounter) );
	505	gzfreeze( &psxNextsCounter, sizeof(psxNextsCounter) );
	506
61ef5cf4	507	if (Mode == 0)
a29f182f	508	{
a29f182f	509	// don't trust things from a savestate
e43c9382	510	rcnts[3].rate = 1;
a29f182f	511	for( i = 0; i < CounterQuantity; ++i )
	512	{
	513	_psxRcntWmode( i, rcnts[i].mode );
	514	count = (psxRegs.cycle - rcnts[i].cycleStart) / rcnts[i].rate;
	515	_psxRcntWcount( i, count );
	516	}
ff2c2822	517	scheduleRcntBase();
a29f182f	518	psxRcntSet();
a29f182f	519	}
4f55097d	520
ef79bbde P	521	return 0;
	522	}
	523
	524	/******************************************************************************/
ff2c2822	525	// vim:ts=4:shiftwidth=4:expandtab