) :
void gpSetCpuSpeed(u32 frequency)
{ switch(frequency)
{ case 166: { CLKDIV=0x4B011; MCLK=166000000; CLKMODE=3; break;}
case 164: { CLKDIV=0x4a011; MCLK=164000000; CLKMODE=3; break;}
case 160: { CLKDIV=0x48011; MCLK=160000000; CLKMODE=3; break;}
case 156: { CLKDIV=0x2c001; MCLK=156000000; CLKMODE=3; break;}
case 144: { CLKDIV=0x28001; MCLK=144000000; CLKMODE=3; break;}
case 133: { CLKDIV=0x3a011; MCLK=132000000; CLKMODE=2; break;}
case 100: { CLKDIV=0x2b011; MCLK=102000000; CLKMODE=0; break;}
case 66: { CLKDIV=0x25002; MCLK= 67500000; CLKMODE=0; break;}
case 50: { CLKDIV=0x2a012; MCLK= 50000000; CLKMODE=0; break;}
case 40: { CLKDIV=0x48013; MCLK= 40000000; CLKMODE=0; break;}
case 33: { CLKDIV=0x25003; MCLK= 33750000; CLKMODE=0; break;}
case 22: { CLKDIV=0x33023; MCLK= 22125000; CLKMODE=0; break;}
};
switch(CLKMODE)
{ case 0 : HCLK=MCLK; PCLK=MCLK; break;
case 1 : HCLK=MCLK; PCLK=MCLK>>1; break;
case 2 : HCLK=MCLK>>1; PCLK=MCLK>>1; break;
case 3 : HCLK=MCLK>>1; PCLK=MCLK>>2; break;
};
gp_setCpu(MCLK,CLKDIV,CLKMODE);
inikey();
currentFrequency = frequency;
}
u32 gp_initFramebuffer(u32 refreshrate)
{ u32 GPHCLK = gp_getHCLK();
u32 ratio;
// is a blu+ ?
u32 bluplus = ( (*(int*)0x1014) >= 0x01030606 );
// invert screen detection with L key
if(keyPush(kl)) bluplus ^= 1;
if(bluplus) ratio = 109850; else ratio = 83385;
// limit refresrate
if (refreshrate < 50) refreshrate = 50; if (refreshrate > 120) refreshrate = 120;
// Get the correct CLKVAL for refreshrate
u32 CLKVAL = (GPHCLK/(ratio*2*refreshrate))-1; if (!CLKVAL) CLKVAL=1;
// Get real refreshrate
refreshrate = GPHCLK / (ratio*2*(CLKVAL+1));
// set lcd registers
rLCDCON1 = (CLKVAL<<8) | (0<<7) | (3<<5) | (12<<1) | 1;
if(bluplus)
{ rLCDCON2 = 0; rLCDCON2 = (8<<24) | (319<<14) | (2<<6) | 5;
rLCDCON3 = 0; rLCDCON3 = (50<<19) | (239<<8) | 2;
rLCDCON4 = 0; rLCDCON4 = 30;
}
else
{ rLCDCON2 = 0; rLCDCON2 = (1<<24) | (319<<14) | (2<<6) | 1;
rLCDCON3 = 0; rLCDCON3 = (6<<19) | (239<< 8) | 2;
rLCDCON4 = 0; rLCDCON4 = 4;
}
rLCDCON5 = 1793;
Gdl_flip();
return refreshrate;
}
u32 flipVar[4] = {0,0,0,0};
void Gdl_flip(void) // flip the framebuffer
{ #ifdef GP32
if(drawGdlShell) shell.draw();
//gp_waitDMA(0);
//gp_waitDMA(1);
if(!flipVar[nflip])
{ flipVar[0] = ((u32)(screenBuffer[0]))>>22; flipVar[0] <<= 21;
flipVar[0] |= ( (((u32)(screenBuffer[0]))&0x3FFFFF)>>1 );
flipVar[1] = ((u32)(screenBuffer[1]))>>22; flipVar[1] <<= 21;
flipVar[1] |= ( (((u32)(screenBuffer[1]))&0x3FFFFF)>>1 );
flipVar[2] = (((u32)(screenBuffer[0]))&0x3FFFFF)>>1;
flipVar[3] = (((u32)(screenBuffer[1]))&0x3FFFFF)>>1;
flipVar[2] += 320*240;
flipVar[3] += 320*240;
rLCDSADDR3 = (0<<11) | 240 ;
}
while(((rLCDCON5>>17)&3)==2); // wait for active line
while(((rLCDCON5>>17)&3)!=2); // wait for active line to end - start of front porch and hsync
rLCDSADDR1 = flipVar[nflip];
rLCDSADDR2 = flipVar[2+nflip] ;
//u32 miss = (rLCDCON1 >> 18);
//if(currentFrequency<=80) if(miss > currentFrequency) gp_setCpuspeed(133);
while ((rLCDCON1 >> 18) != 1) asm volatile("nop\n""nop\n""nop\n");
while ((rLCDCON1 >> 18) != 319) asm volatile("nop\n""nop\n""nop\n");
//if(currentFrequency<=80) if(miss > currentFrequency) gp_setCpuspeed(currentFrequency);
nflip ^= 1 ;
pixel = screenBuffer[nflip];
//fullBlitLimit();
tick = GetTickCount();
#endif
}