mirror of
https://github.com/rvtr/twl_wrapsdk.git
synced 2025-10-31 06:11:10 -04:00
git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/twl_wrapsdk/trunk@41 4ee2a332-4b2b-5046-8439-1ba90f034370
371 lines
8.8 KiB
C
371 lines
8.8 KiB
C
/*---------------------------------------------------------------------------*
|
|
Project: TwlSDK - MI - demos - exDma-1
|
|
File: main.c
|
|
|
|
Copyright 2003-2006 Nintendo. All rights reserved.
|
|
|
|
These coded instructions, statements, and computer programs contain
|
|
proprietary information of Nintendo of America Inc. and/or Nintendo
|
|
Company Ltd., and are protected by Federal copyright law. They may
|
|
not be disclosed to third parties or copied or duplicated in any form,
|
|
in whole or in part, without the prior written consent of Nintendo.
|
|
|
|
$Log: $
|
|
$NoKeywords: $
|
|
*---------------------------------------------------------------------------*/
|
|
#include <twl.h>
|
|
|
|
|
|
#define ONE_BUF_SIZE 0x2004
|
|
|
|
typedef struct
|
|
{
|
|
u32 prePad __attribute__ ((aligned (32)));
|
|
u16 src[4][ONE_BUF_SIZE/2] __attribute__ ((aligned (32)));
|
|
u16 dest[4][ONE_BUF_SIZE/2] __attribute__ ((aligned (32)));
|
|
u32 PostPad __attribute__ ((aligned (32)));
|
|
}
|
|
t_TestBuf;
|
|
|
|
typedef struct
|
|
{
|
|
u16 (*src)[ONE_BUF_SIZE/2];
|
|
u16 (*dest)[ONE_BUF_SIZE/2];
|
|
char *copyStr;
|
|
char *fillStr;
|
|
}
|
|
t_CommonArg;
|
|
|
|
|
|
t_TestBuf testBuf __attribute__ ((aligned (32)));
|
|
|
|
t_CommonArg copyfillArg[] =
|
|
{
|
|
{ testBuf.src, testBuf.dest, "DmaCopy success.\n", "DmaFill success on WRAM.\n", },
|
|
};
|
|
|
|
t_CommonArg stopArg[] =
|
|
{
|
|
{ testBuf.src, testBuf.dest, "Stopping DmaCopy success.\n", "Stopping DmaFill success on WRAM.\n", },
|
|
};
|
|
|
|
t_CommonArg copyfillAsyncArg[] =
|
|
{
|
|
{ testBuf.src, testBuf.dest, "DmaCopyAsync success.\n", "DmaFillAsync success on WRAM.\n", },
|
|
};
|
|
|
|
static BOOL CheckDmaCopy( u32 dmaNo, void *src, void *dest, const char *str )
|
|
{
|
|
BOOL ercd = TRUE;
|
|
u8 *s = src;
|
|
u8 *d = dest;
|
|
int i;
|
|
|
|
for (i=0; i<ONE_BUF_SIZE; i++)
|
|
{
|
|
if ( s[i] != d[i] )
|
|
{
|
|
OS_TPrintf( "error: DmaCopy failed address = 0x%x count = 0x%x dmaNo = %d.\n", &d[i], i/2, dmaNo );
|
|
OS_TPrintf( " src = 0x%02x dest = 0x%02x.\n", s[i], d[i] );
|
|
ercd = FALSE;
|
|
break;
|
|
}
|
|
}
|
|
if (str)
|
|
{
|
|
OS_TPrintf( str );
|
|
}
|
|
|
|
return ercd;
|
|
}
|
|
|
|
static BOOL CheckDmaFill( u32 dmaNo, void *dest, u32 data, char *str )
|
|
{
|
|
BOOL ercd = TRUE;
|
|
u32 *d = dest;
|
|
int i;
|
|
|
|
for (i=0; i<ONE_BUF_SIZE/4; i++)
|
|
{
|
|
if ( data != d[i] )
|
|
{
|
|
OS_TPrintf( "error: DmaFill failed address = 0x%x count = 0x%x dmaNo = %d.\n", &d[i], i/2, dmaNo );
|
|
OS_TPrintf( " data = 0x%08x dest = 0x%08x.\n", data, d[i] );
|
|
ercd = FALSE;
|
|
break;
|
|
}
|
|
}
|
|
if (str)
|
|
{
|
|
OS_TPrintf( str );
|
|
}
|
|
|
|
return ercd;
|
|
}
|
|
|
|
|
|
static BOOL CheckDmaCopyAndFill( t_CommonArg *arg, u32 data )
|
|
{
|
|
u16 (*src)[ONE_BUF_SIZE/2] = arg->src;
|
|
u16 (*dest)[ONE_BUF_SIZE/2] = arg->dest;
|
|
char *copyStr = arg->copyStr;
|
|
char *fillStr = arg->fillStr;
|
|
BOOL c_ercd = TRUE, f_ercd = TRUE;
|
|
u32 i, ii;
|
|
|
|
for (i=0; i<4; i++)
|
|
{
|
|
for (ii=0; ii<ONE_BUF_SIZE/2; ii++)
|
|
{
|
|
src[i][ii] = (u16)(ii+i-data);
|
|
}
|
|
}
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *s = src[i];
|
|
u16 *d = dest[i];
|
|
char *str = NULL;
|
|
|
|
DC_FlushAll();
|
|
IC_InvalidateAll();
|
|
MIi_ExDmaCopy( ch, s, d, ONE_BUF_SIZE );
|
|
if ( i == 3 )
|
|
{
|
|
str = copyStr;
|
|
}
|
|
c_ercd |= CheckDmaCopy( ch, s, d, str );
|
|
}
|
|
if ( c_ercd == TRUE )
|
|
{
|
|
OS_TPrintf( copyStr );
|
|
}
|
|
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *d = dest[i];
|
|
char *str = NULL;
|
|
|
|
DC_FlushAll();
|
|
IC_InvalidateAll();
|
|
MIi_ExDmaFill( ch, d, data+i, ONE_BUF_SIZE );
|
|
if ( i == 3 )
|
|
{
|
|
str = fillStr;
|
|
}
|
|
f_ercd |= CheckDmaFill( ch, d, data+i, str );
|
|
}
|
|
if ( f_ercd == TRUE )
|
|
{
|
|
OS_TPrintf( fillStr );
|
|
}
|
|
|
|
return c_ercd | f_ercd;
|
|
}
|
|
|
|
static BOOL CheckDmaCopyAndFillAsync( t_CommonArg *arg, u32 data )
|
|
{
|
|
u16 (*src)[ONE_BUF_SIZE/2] = arg->src;
|
|
u16 (*dest)[ONE_BUF_SIZE/2] = arg->dest;
|
|
char *copyStr = arg->copyStr;
|
|
char *fillStr = arg->fillStr;
|
|
BOOL c_ercd = TRUE, f_ercd = TRUE;
|
|
u32 i, ii;
|
|
|
|
for (i=0; i<4; i++)
|
|
{
|
|
for (ii=0; ii<ONE_BUF_SIZE/2; ii++)
|
|
{
|
|
src[i][ii] = (u16)(ii+i-data);
|
|
}
|
|
}
|
|
DC_FlushAll();
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *s = src[i];
|
|
u16 *d = dest[i];
|
|
|
|
MIi_ExDmaCopyAsync( ch, s, d, ONE_BUF_SIZE );
|
|
}
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
if ( MIi_IsExDmaBusy( ch ) == FALSE )
|
|
{
|
|
OS_TPrintf( "warning: DmaCopyAsync isn't busy dmaNo = %d.\n", ch );
|
|
}
|
|
}
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
MIi_WaitExDma( ch );
|
|
}
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *s = src[i];
|
|
u16 *d = dest[i];
|
|
char *str = NULL;
|
|
|
|
if ( i == 3 )
|
|
{
|
|
str = copyStr;
|
|
}
|
|
c_ercd |= CheckDmaCopy( ch, s, d, str );
|
|
}
|
|
if ( c_ercd == TRUE )
|
|
{
|
|
OS_TPrintf( copyStr );
|
|
}
|
|
|
|
DC_FlushAll();
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *d = dest[i];
|
|
|
|
MIi_ExDmaFillAsync( ch, d, data+i, ONE_BUF_SIZE );
|
|
}
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
if ( MIi_IsExDmaBusy( ch ) == FALSE )
|
|
{
|
|
OS_TPrintf( "warning: DmaFillAsync isn't busy dmaNo = %d.\n", ch );
|
|
}
|
|
}
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
MIi_WaitExDma( ch );
|
|
}
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *d = dest[i];
|
|
char *str = NULL;
|
|
|
|
if ( i == 3 )
|
|
{
|
|
str = fillStr;
|
|
}
|
|
f_ercd |= CheckDmaFill( ch, d, data+i, str );
|
|
}
|
|
if ( f_ercd == TRUE )
|
|
{
|
|
OS_TPrintf( fillStr );
|
|
}
|
|
|
|
return c_ercd | f_ercd;
|
|
}
|
|
|
|
static BOOL CheckDmaStop( t_CommonArg *arg )
|
|
{
|
|
u16 (*src)[ONE_BUF_SIZE/2] = arg->src;
|
|
u16 (*dest)[ONE_BUF_SIZE/2] = arg->dest;
|
|
char *copyStr = arg->copyStr;
|
|
char *fillStr = arg->fillStr;
|
|
BOOL c_ercd = TRUE, f_ercd = TRUE;
|
|
u32 i;
|
|
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *s = src[i];
|
|
u16 *d = dest[i];
|
|
|
|
MIi_ExDmaCopyAsync( ch, s, d, ONE_BUF_SIZE );
|
|
if ( MIi_IsExDmaBusy( ch ) == FALSE )
|
|
{
|
|
OS_TPrintf( "warning: DmaCopyAsync isn't busy dmaNo = %d.\n", ch );
|
|
}
|
|
MIi_StopExDma( ch );
|
|
|
|
if ( MIi_IsExDmaBusy( ch ) == TRUE )
|
|
{
|
|
OS_TPrintf( "error: Stopping DmaCopy failed dmaNo = %d.\n", ch );
|
|
c_ercd = FALSE;
|
|
// break;
|
|
}
|
|
}
|
|
if ( c_ercd == TRUE )
|
|
{
|
|
OS_TPrintf( copyStr );
|
|
}
|
|
|
|
for (i=0; i<4; i++)
|
|
{
|
|
u32 ch = i + MI_EXDMA_CH_MIN;
|
|
u16 *d = dest[i];
|
|
|
|
MIi_ExDmaFillAsync( ch, d, i, ONE_BUF_SIZE );
|
|
if ( MIi_IsExDmaBusy( ch ) == FALSE )
|
|
{
|
|
OS_TPrintf( "warning: DmaFillAsync isn't busy dmaNo = %d.\n", ch );
|
|
}
|
|
MIi_StopExDma( ch );
|
|
|
|
if ( MIi_IsExDmaBusy( ch ) == TRUE )
|
|
{
|
|
OS_TPrintf( "error: Stopping DmaFill failed dmaNo = %d.\n", ch );
|
|
f_ercd = FALSE;
|
|
// break;
|
|
}
|
|
}
|
|
if ( f_ercd == TRUE )
|
|
{
|
|
OS_TPrintf( fillStr );
|
|
}
|
|
|
|
return c_ercd | f_ercd;
|
|
}
|
|
|
|
|
|
|
|
//================================================================================
|
|
/*---------------------------------------------------------------------------*
|
|
Name: TwlMain
|
|
|
|
Description: main
|
|
|
|
Arguments: None
|
|
|
|
Returns: None
|
|
*---------------------------------------------------------------------------*/
|
|
void TwlMain()
|
|
{
|
|
u32 i;
|
|
|
|
OS_Init();
|
|
|
|
// (void)OS_EnableIrq();
|
|
|
|
OS_TPrintf("ARM9 starts.\n");
|
|
|
|
OS_TPrintf( "\nChecking DmaCopy and DmaFill ....\n" );
|
|
for (i=0; i<1; i++)
|
|
{
|
|
(void)CheckDmaCopyAndFill( ©fillArg[i], i );
|
|
}
|
|
|
|
OS_TPrintf( "\nChecking DmaCopyAsync and DmaFillAsync ....\n" );
|
|
for (i=0; i<1; i++)
|
|
{
|
|
(void)CheckDmaCopyAndFillAsync( ©fillAsyncArg[i], i );
|
|
}
|
|
|
|
OS_TPrintf( "\nChecking DmaStop ....\n" );
|
|
for (i=0; i<1; i++)
|
|
{
|
|
(void)CheckDmaStop( &stopArg[i] );
|
|
}
|
|
|
|
OS_TPrintf("ARM9 ends.\n");
|
|
OS_Terminate();
|
|
}
|
|
|
|
|
|
/*====== End of main.c ======*/
|