flashreadarray.c 2.9 KB
/*---------------------------------------------------------------------
        Copyright (C) 1998 Nintendo.
        
        File            flash.c
        Coded    by     Atushi Watanabe. Dec  1, 1998.
        Modified by     Atushi Watanabe. Apr 4, 2000.
        Comments        1M Flash ROM access functions(Ver.7.6)
   
 	$Id: flashreadarray.c,v 1.1.1.1 2002/10/29 08:06:43 blythe Exp $
   ---------------------------------------------------------------------*/
/**************************************************************************
 *
 *  $Revision: 1.1.1.1 $
 *  $Date: 2002/10/29 08:06:43 $
 *  $Source: 
 *
 **************************************************************************/

#include	<ultra64.h>
#include        "osint_flash.h"

/* READ ARRAY */
s32	osFlashReadArray(OSIoMesg *mb, s32 priority, u32 page_num,
			 void *dramAddr, u32 n_pages, OSMesgQueue *mq)
{
  s32 ret;
  u32 tmp;
  u32 end_page, one_dma_pages;
  
  /* Set Read Array(Buffer Access Mode) */
  osEPiWriteIo(&__osFlashHandler,(__osFlashHandler.baseAddress|0x10000),0xf0000000);

  /* 低電圧でのコマンドコンビネーションバグ(readID->ReadArray)を回避するためのダミーリード */
  osEPiReadIo(&__osFlashHandler,__osFlashHandler.baseAddress, &tmp);
		
  /* Read Data */
  mb->hdr.pri  =  priority;
  mb->hdr.retQueue  =  mq;
  mb->dramAddr  =  dramAddr;

/*  osSyncPrintf("1st start: %x\n", mb->dramAddr); */

  /* MX旧バージョンフラッシュのアドレスデコーダバグへの対応(DMAの分割・アドレス変換) */
  /* 最終ページと開始ページが異なるDMA単位にある場合 */
  end_page = page_num + n_pages -1;
  if ((end_page & 0xf00) != (page_num & 0xf00)){
    one_dma_pages = (0x100 - (page_num & 0xff));	/* DMAページ数:DMA境界まで */
    n_pages = n_pages - one_dma_pages;			/* 残りページ数 */
    mb->size = one_dma_pages * 128;			/* 実DMAサイズ */

    mb->devAddr = __osFlashGetAddr(page_num);      	/* DMA開始デバイスアドレスの変換 */ 
    osEPiStartDma(&__osFlashHandler, mb, OS_READ);
    osRecvMesg(mq, NULL, OS_MESG_BLOCK);

    page_num = (page_num + 0x100) & 0xf00;			/* 次の開始ページ */ 
    mb->dramAddr = (void*)((u8*)mb->dramAddr + mb->size);	/* 次の開始DRAMアドレス */ 
  }
  /* 残りページが0x100以上なら */
  while(n_pages > 0x100){				/* 残りページ 0x100 以上 */
    one_dma_pages = 0x100;				/* DMAページ数:DMA境界まで(0x100) */
    n_pages -= 0x100;					/* 残りページ数 */
    mb->size = one_dma_pages * 128;			/* 実DMAサイズ */

    mb->devAddr = __osFlashGetAddr(page_num);		/* DMA開始デバイスアドレスの変換 */ 
    osEPiStartDma(&__osFlashHandler, mb, OS_READ);
    osRecvMesg(mq, NULL, OS_MESG_BLOCK);

    page_num = page_num + 0x100;				/* 次の開始ページ */ 
    mb->dramAddr = (void*)((u8*)mb->dramAddr + mb->size);	/* 次の開始DRAMアドレス */ 
  }
  /* 最終DMA */
  mb->size  = n_pages * 128;				/* 実DMAサイズ */
  mb->devAddr = __osFlashGetAddr(page_num);		/* DMA開始デバイスアドレスの変換 */ 

  ret = osEPiStartDma(&__osFlashHandler, mb, OS_READ);

  return ret;
}