/*************************************************************************/
/*                                                                       */
/* FILE NAME                                      VERSION                */
/*                                                                       */
/* source\PALETTE.C                                1.0                   */
/*                                                                       */
/* DESCRIPTION                                                           */
/*                                                                       */
/* S3C2410 LCD PALETTE TEST - MBA2410(S3C2410X)                          */
/*                                                                       */
/* DATA STRUCTURES                                                       */
/*                                                                       */
/* FUNCTIONS : S3C2410 PALETTE RAM TEST ROUTINE                          */
/*                                                                       */
/* DEPENDENCIES                                                          */
/*                                                                       */
/*                                                                       */
/* NAME:    Nicolas Park                                                 */
/* The last Modification date: 2003. 10 30                               */
/* REMARKS:                                                              */
/*                                                                       */
/*                                                                       */
/*                                Copyright (C) 2005 AIJISYSTEM CO.,LTD  */
/*************************************************************************/

#include <string.h>
 #include "..\common\def.h"
#include "..\common\option.h"
#include "..\common\2410addr.h"
#include "..\common\2410lib.h"
//#include "2410slib.h" 
#include "palette.h"

static void MarchCMinusM(int address,int unit,unsigned int pattern,unsigned int mask);
static void _MarchSub1M(unsigned int *pt,int unit,unsigned int pattern,int incdec,unsigned int mask);

int marchError;

void Test_PaletteMemory(void)
{
    Uart_Printf("Palette RAM test by March C-\n");
	
    marchError=0;

    *((U32 *)PALETTE)=0x1234;
    Uart_Printf("data = %x\n",*((U32 *)PALETTE));
    
    //00->01->11<->10

    //Data cache should be turned off.
    
    MarchCMinusM(PALETTE,255,0x33333333,0xffff);
    MarchCMinusM(PALETTE,255,0x55555555,0xffff);    
    MarchCMinusM(PALETTE,255,0x0000ffff,0xffff);
    MarchCMinusM(PALETTE,255,0x00ff00ff,0xffff);
    MarchCMinusM(PALETTE,255,0x0f0f0f0f,0xffff);
    MarchCMinusM(PALETTE,255,0xffffffff,0xffff);    
    Uart_Printf("P-RAM is tested.\n");
}


static void MarchCMinusM(int address,int unit,unsigned int pattern,unsigned int mask)
{
    int i;
    unsigned int *tempPt;
    
    tempPt=(unsigned int *)address;
    
    for(i=0;i<=unit;i++)
    {
//	    Uart_Printf("P= 0x%8x   : ",pattern);
//	    *tempPt++=pattern;
//	    Uart_Printf("A= 0x%8x,   P= 0x%8x\n",tempPt,*tempPt);
	    *tempPt=pattern;
	    tempPt+=1;
    }
    
	Uart_Printf("\nWaitting 1 Sec\n");
	Delay(10000);
	Uart_Printf("Start\n");
    
    _MarchSub1M((unsigned int *)address,unit,~pattern,1,mask);
    _MarchSub1M((unsigned int *)address,unit,pattern,1,mask);
    _MarchSub1M((unsigned int *)address+(unit*1),unit,~pattern,-1,mask);
    _MarchSub1M((unsigned int *)address+(unit*1),unit,pattern,-1,mask); 
    
    tempPt=(unsigned int *)address;
    for(i=0;i<=unit;i++)
    {
    
	    if( (mask & *tempPt)!=(pattern&mask) )
	    {
	        marchError=1;
//	        Uart_Printf("ERROR0 : RA= 0x%8x,    RP= 0x%8x\n",tempPt,*tempPt);
	        Uart_Printf("ERROR0 : Address= 0x%8x,    Write= 0x%8x,    Read= 0x%8x\n",tempPt,pattern,*tempPt);	        
	    }
//	    Uart_Printf("RA= 0x%8x,    RP= 0x%8x\n",tempPt,*tempPt);
	    tempPt+=0x1;	    
    }
    tempPt-=0x1;
//	Uart_Printf("Address= 0x%8x,    Write= 0x%8x,    Read= 0x%8x\n",tempPt,pattern,*tempPt);
}


static void _MarchSub1M(unsigned int *pt,int unit,unsigned int pattern,int incdec,unsigned int mask)
{
    unsigned int i,rp;
    
    for(i=0;i<=unit;i++)
    {
	    rp=*pt;
	    //Uart_Printf("RP=%x",*pt);
	    *pt=pattern;
	    //Uart_Printf("j=%x,p=%x,pt=%x\n",rp,(~pattern),pt);
	
	    if( (mask&rp)!=(mask&(~pattern)) )
	    {
	        marchError=1;
//	        Uart_Printf("ERROR1 : Address= 0x%8x,    Write= 0x%8x,    Read= 0x%8x   pt2= 0x%8x \n",pt,(~pattern),rp,pt2);
	        Uart_Printf("ERROR1 : Address= 0x%8x,    Write= 0x%8x,    Read= 0x%8x\n",pt,(~pattern),rp);	        
	    }
	    pt+=incdec;
//	Uart_Printf(".");
    }
}