flashreadarray.c
3.29 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
/*---------------------------------------------------------------------
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.3 2004/02/14 01:11:16 wheeler Exp $
---------------------------------------------------------------------*/
/**************************************************************************
*
* $Revision: 1.3 $
* $Date: 2004/02/14 01:11:16 $
* $Source:
*
**************************************************************************/
#include <ultra64.h>
#include "osint_flash.h"
#ifdef BBPLAYER
#include "bbint.h"
#endif
/* READ ARRAY */
s32 osFlashReadArray(OSIoMesg *mb, s32 priority, u32 page_num,
void *dramAddr, u32 n_pages, OSMesgQueue *mq)
{
#ifdef BBPLAYER
if (__osBbFlashSize && (page_num+n_pages)*128 <= __osBbFlashSize) {
bcopy(__osBbFlashAddress+page_num*128, dramAddr, n_pages*128);
return osSendMesg(mq, (OSMesg)0, OS_MESG_NOBLOCK);
} else {
#ifndef _DEBUG
bzero(dramAddr, n_pages*128);
return osSendMesg(mq, (OSMesg)0, OS_MESG_NOBLOCK);
#else
return -1;
#endif
}
#else
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;
#endif
}