mirror of
https://github.com/rvtr/TwlIPL.git
synced 2025-10-31 06:01:12 -04:00
292175768e
・ビルドスイッチで、カードデータ転送で使うDMAを、新DMA,旧DMA切替えられるように修正 デフォルトでは旧DMAを使うようになっている ビルドスイッチ：#define USE_NEW_DMA git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/TwlIPL/trunk@1441 b08762b0-b915-fc4b-9d8c-17b2551a87ff
262 lines
8.4 KiB
C
262 lines
8.4 KiB
C
/*---------------------------------------------------------------------------*
|
||
Project: TwlIPL
|
||
File: customNDma.c
|
||
|
||
Copyright 2007-2008 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.
|
||
*---------------------------------------------------------------------------*/
|
||
#include <twl.h>
|
||
#include <sysmenu.h>
|
||
#include <hotswTypes.h>
|
||
#include <customNDma.h>
|
||
|
||
// Extern -------------------------------------------------------------------
|
||
extern CardThreadData HotSwThreadData;
|
||
|
||
// union --------------------------------------------------------------------
|
||
#ifndef USE_NEW_DMA
|
||
typedef union
|
||
{
|
||
u32 b32;
|
||
u16 b16;
|
||
}
|
||
MIiDmaClearSrc;
|
||
#endif
|
||
|
||
// Define data --------------------------------------------------------------
|
||
#ifndef USE_NEW_DMA
|
||
#define NDMA_WORD_COUNT_1 0x1
|
||
#define ASSERT_NDMANO( ndmaNo ) SDK_ASSERTMSG( (ndmaNo) <= MI_NDMA_MAX_NUM, "illegal NDMA No." );
|
||
#define ASSERT_DMANO( dmaNo ) SDK_ASSERTMSG( (dmaNo) <= MI_DMA_MAX_NUM, "illegal DMA No." );
|
||
|
||
#define MIi_DMA_MODE_NOINT 1
|
||
#define MIi_DMA_MODE_WAIT 2
|
||
#define MIi_DMA_MODE_NOCLEAR 4
|
||
#define MIi_DMA_MODE_SRC32 0x10
|
||
#define MIi_DMA_MODE_SRC16 0x20
|
||
|
||
#define MIi_DMA_CLEAR_DATA_BUF HW_PRV_WRAM_DMA_CLEAR_DATA_BUF
|
||
#endif
|
||
|
||
// Function prototype -------------------------------------------------------
|
||
#ifdef USE_NEW_DMA
|
||
static void HOTSWi_NDmaCopy_Card(u32 ndmaNo, const void *src, void *dest, u32 size, u32 dcont);
|
||
static void InterruptCallbackNDma(void);
|
||
#else
|
||
static void HOTSWi_DmaCopy32_Card(u32 dmaNo, const void *src, void *dest, u32 size, u32 dcont);
|
||
static void HOTSWi_DmaSetParameters(u32 dmaNo, u32 src, u32 dest, u32 ctrl, u32 mode);
|
||
#endif
|
||
|
||
|
||
// ===========================================================================
|
||
// Function Describe
|
||
// ===========================================================================
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSW_NDmaCopy_Card
|
||
|
||
Description: <20>J<EFBFBD>[<5B>h<EFBFBD><68><EFBFBD>瑗<EFBFBD><E79197><EFBFBD><EFBFBD><EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD>f<EFBFBD>[<5B>^<5E><><EFBFBD>w<EFBFBD><77><EFBFBD>A<EFBFBD>h<EFBFBD><68><EFBFBD>X<EFBFBD><58>NDMA<4D>]<5D><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
*---------------------------------------------------------------------------*/
|
||
#ifdef USE_NEW_DMA
|
||
void HOTSW_NDmaCopy_Card(u32 ndmaNo, const void *src, void *dest, u32 size)
|
||
{
|
||
HOTSWi_NDmaCopy_Card(ndmaNo, src, dest, size, MI_NDMA_DEST_INC);
|
||
}
|
||
#endif
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSW_NDmaPipe_Card
|
||
|
||
Description: <20>J<EFBFBD>[<5B>h<EFBFBD><68><EFBFBD>瑗<EFBFBD><E79197><EFBFBD><EFBFBD><EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD>f<EFBFBD>[<5B>^<5E><><EFBFBD>w<EFBFBD><77><EFBFBD>A<EFBFBD>h<EFBFBD><68><EFBFBD>X<EFBFBD><58>NDMA<4D>]<5D><><EFBFBD>œǂݎ̂Ă<CC82>
|
||
*---------------------------------------------------------------------------*/
|
||
#ifdef USE_NEW_DMA
|
||
void HOTSW_NDmaPipe_Card(u32 ndmaNo, const void *src, void *dest, u32 size)
|
||
{
|
||
HOTSWi_NDmaCopy_Card(ndmaNo, src, dest, size, MI_NDMA_DEST_FIX);
|
||
}
|
||
#endif
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSWi_NDmaCopy_Card
|
||
|
||
Description: NDMA<4D>]<5D><><EFBFBD>̏<EFBFBD><CC8F><EFBFBD>
|
||
|
||
<20><><EFBFBD>F<EFBFBD><46><EFBFBD>ɂ<EFBFBD><C982>̊<CC8A><D690><EFBFBD>DMA<4D>]<5D><><EFBFBD>̏<EFBFBD><CC8F><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD>A<EFBFBD>J<EFBFBD>[<5B>h<EFBFBD><68><EFBFBD>W<EFBFBD>X<EFBFBD>^<5E><>start<72>t<EFBFBD><74><EFBFBD>O<EFBFBD><4F><EFBFBD>グ<EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
*---------------------------------------------------------------------------*/
|
||
#ifdef USE_NEW_DMA
|
||
static void HOTSWi_NDmaCopy_Card(u32 ndmaNo, const void *src, void *dest, u32 size, u32 dcont)
|
||
{
|
||
u32 contData;
|
||
OSIntrMode enabled = OS_DisableInterrupts();
|
||
|
||
//--- Assert
|
||
ASSERT_NDMANO( ndmaNo );
|
||
|
||
//---- confirm CARD free
|
||
HOTSW_WaitCardCtrl();
|
||
|
||
//---- confirm DMA free
|
||
HOTSW_WaitNDmaCtrl(ndmaNo);
|
||
|
||
//---- Handler Set
|
||
(void)OS_SetIrqFunction(OS_IE_NDMA2, InterruptCallbackNDma);
|
||
|
||
//---- set up registers
|
||
MI_NDMA_REG( ndmaNo, MI_NDMA_REG_SAD_WOFFSET ) = (u32)src;
|
||
MI_NDMA_REG( ndmaNo, MI_NDMA_REG_DAD_WOFFSET ) = (u32)dest;
|
||
MI_NDMA_REG( ndmaNo, MI_NDMA_REG_BCNT_WOFFSET ) = MI_NDMA_INTERVAL_PS_1;
|
||
MI_NDMA_REG( ndmaNo, MI_NDMA_REG_TCNT_WOFFSET ) = (u32)(size/4);
|
||
MI_NDMA_REG( ndmaNo, MI_NDMA_REG_WCNT_WOFFSET ) = NDMA_WORD_COUNT_1;
|
||
|
||
//---- decide control register
|
||
contData = MI_NDMA_BWORD_1 | MI_NDMA_ENABLE/* | MI_NDMA_CONTINUOUS_ON*/;
|
||
contData |= MI_NDMA_SRC_FIX | dcont | MI_NDMA_SRC_RELOAD_DISABLE | MI_NDMA_DEST_RELOAD_DISABLE;
|
||
#ifndef DEBUG_USED_CARD_SLOT_B_
|
||
contData |= MI_NDMA_TIMING_CARD_A;
|
||
#else
|
||
contData |= MI_NDMA_TIMING_CARD_B;
|
||
#endif
|
||
|
||
//---- set interrupt enable
|
||
contData |= MI_NDMA_IF_ENABLE;
|
||
|
||
//---- start
|
||
MI_NDMA_REG( ndmaNo, MI_NDMA_REG_CNT_WOFFSET ) = contData;
|
||
|
||
(void)OS_RestoreInterrupts( enabled );
|
||
}
|
||
#endif
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: InterruptCallbackNDma
|
||
|
||
Description: <20>J<EFBFBD>[<5B>hB <20>f<EFBFBD>[<5B>^<5E>]<5D><><EFBFBD>I<EFBFBD><49><EFBFBD><EFBFBD><EFBFBD>荞<EFBFBD>݃n<DD83><6E><EFBFBD>h<EFBFBD><68>
|
||
*---------------------------------------------------------------------------*/
|
||
#ifdef USE_NEW_DMA
|
||
static void InterruptCallbackNDma(void)
|
||
{
|
||
// <20><><EFBFBD>b<EFBFBD>Z<EFBFBD>[<5B>W<EFBFBD><57><EFBFBD>M
|
||
OS_SendMessage(&HotSwThreadData.hotswDmaQueue, (OSMessage *)&HotSwThreadData.hotswDmaMsg[HotSwThreadData.idx_dma], OS_MESSAGE_NOBLOCK);
|
||
|
||
// <20><><EFBFBD>b<EFBFBD>Z<EFBFBD>[<5B>W<EFBFBD>C<EFBFBD><43><EFBFBD>f<EFBFBD>b<EFBFBD>N<EFBFBD>X<EFBFBD><58><EFBFBD>C<EFBFBD><43><EFBFBD>N<EFBFBD><4E><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>g
|
||
HotSwThreadData.idx_dma = (HotSwThreadData.idx_dma+1) % HOTSW_DMA_MSG_NUM;
|
||
}
|
||
#endif
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSW_DmaCopy32_Card
|
||
|
||
Description: <20>J<EFBFBD>[<5B>h<EFBFBD><68><EFBFBD>瑗<EFBFBD><E79197><EFBFBD><EFBFBD><EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD>f<EFBFBD>[<5B>^<5E><><EFBFBD>w<EFBFBD><77><EFBFBD>A<EFBFBD>h<EFBFBD><68><EFBFBD>X<EFBFBD><58>DMA<4D>]<5D><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
*---------------------------------------------------------------------------*/
|
||
#ifndef USE_NEW_DMA
|
||
void HOTSW_DmaCopy32_Card(u32 dmaNo, const void *src, void *dest, u32 size)
|
||
{
|
||
HOTSWi_DmaCopy32_Card(dmaNo, src, dest, size, MI_DMA_DEST_INC);
|
||
}
|
||
#endif
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSW_DmaPipe32_Card
|
||
|
||
Description: <20>J<EFBFBD>[<5B>h<EFBFBD><68><EFBFBD>瑗<EFBFBD><E79197><EFBFBD><EFBFBD><EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD>f<EFBFBD>[<5B>^<5E><><EFBFBD>w<EFBFBD><77><EFBFBD>A<EFBFBD>h<EFBFBD><68><EFBFBD>X<EFBFBD><58>DMA<4D>]<5D><><EFBFBD>œǂݎ̂Ă<CC82>
|
||
*---------------------------------------------------------------------------*/
|
||
#ifndef USE_NEW_DMA
|
||
void HOTSW_DmaPipe32_Card(u32 dmaNo, const void *src, void *dest, u32 size)
|
||
{
|
||
HOTSWi_DmaCopy32_Card(dmaNo, src, dest, size, MI_DMA_DEST_FIX);
|
||
}
|
||
#endif
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSW_DmaCopy32_Card
|
||
|
||
Description: DMA<4D>]<5D><><EFBFBD>̏<EFBFBD><CC8F><EFBFBD>
|
||
|
||
<20><><EFBFBD>F<EFBFBD><46><EFBFBD>ɂ<EFBFBD><C982>̊<CC8A><D690><EFBFBD>DMA<4D>]<5D><><EFBFBD>̏<EFBFBD><CC8F><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD>A<EFBFBD>J<EFBFBD>[<5B>h<EFBFBD><68><EFBFBD>W<EFBFBD>X<EFBFBD>^<5E><>start<72>t<EFBFBD><74><EFBFBD>O<EFBFBD><4F><EFBFBD>グ<EFBFBD>Ă<EFBFBD><C482><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
*---------------------------------------------------------------------------*/
|
||
#ifndef USE_NEW_DMA
|
||
static void HOTSWi_DmaCopy32_Card(u32 dmaNo, const void *src, void *dest, u32 size, u32 dcont)
|
||
{
|
||
u32 contData;
|
||
|
||
//--- Assert
|
||
ASSERT_DMANO( dmaNo );
|
||
|
||
if (size == 0)
|
||
{
|
||
return;
|
||
}
|
||
|
||
//---- confirm CARD free
|
||
HOTSW_WaitCardCtrl();
|
||
|
||
//---- confirm DMA free
|
||
HOTSW_WaitDmaCtrl(dmaNo);
|
||
|
||
//---- decide control register
|
||
contData = ( MI_DMA_ENABLE | MI_DMA_IF_ENABLE | MI_DMA_TIMING_CARD | MI_DMA_SRC_FIX | dcont | MI_DMA_CONTINUOUS_ON | MI_DMA_32BIT_BUS | 1 );
|
||
|
||
//---- parameter set
|
||
HOTSWi_DmaSetParameters(dmaNo, (u32)src, (u32)dest, contData, 0);
|
||
}
|
||
#endif
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSWi_DmaSetParameters
|
||
|
||
Description: DMA<4D>̃p<CC83><70><EFBFBD><EFBFBD><EFBFBD>[<5B>^<5E>Z<EFBFBD>b<EFBFBD>g
|
||
*---------------------------------------------------------------------------*/
|
||
#ifndef USE_NEW_DMA
|
||
static void HOTSWi_DmaSetParameters(u32 dmaNo, u32 src, u32 dest, u32 ctrl, u32 mode)
|
||
{
|
||
OSIntrMode enabled;
|
||
vu32 *p;
|
||
|
||
if ( ! (mode & MIi_DMA_MODE_NOINT) )
|
||
{
|
||
enabled = OS_DisableInterrupts();
|
||
}
|
||
|
||
//p = (vu32 *)((u32)REG_DMA0SAD_ADDR + dmaNo * 12);
|
||
p = (vu32*)MI_DMA_REGADDR( dmaNo, MI_DMA_REG_SAD_WOFFSET );
|
||
|
||
if ( mode & MIi_DMA_MODE_SRC32 )
|
||
{
|
||
MIiDmaClearSrc *srcp = (MIiDmaClearSrc *) ((u32)MIi_DMA_CLEAR_DATA_BUF + dmaNo * 4);
|
||
srcp->b32 = src;
|
||
src = (u32)srcp;
|
||
}
|
||
else if ( mode & MIi_DMA_MODE_SRC16 )
|
||
{
|
||
MIiDmaClearSrc *srcp = (MIiDmaClearSrc *) ((u32)MIi_DMA_CLEAR_DATA_BUF + dmaNo * 4);
|
||
srcp->b16 = (u16)src;
|
||
src = (u32)srcp;
|
||
}
|
||
|
||
*p = (vu32)src;
|
||
*(p + 1) = (vu32)dest;
|
||
*(p + 2) = (vu32)ctrl;
|
||
|
||
if ( mode & MIi_DMA_MODE_WAIT )
|
||
{
|
||
// ARM7 must wait 2 cycle (load is 3 cycle)
|
||
u32 dummy = reg_MI_DMA0SAD;
|
||
}
|
||
|
||
if ( ! (mode & MIi_DMA_MODE_NOINT) )
|
||
{
|
||
(void)OS_RestoreInterrupts(enabled);
|
||
}
|
||
}
|
||
#endif |