?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge branch 'for-linus' of git://oss.sgi.com/xfs/xfs
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / staging / spectra / flash.c
blobfb39c8ecf596ffec31bc2eabea2e15d43a62dfaa
1 /*
2 * NAND Flash Controller Device Driver
3 * Copyright (c) 2009, Intel Corporation and its suppliers.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
17 *
18 */
19
20 #include <linux/fs.h>
21 #include <linux/slab.h>
22
23 #include "flash.h"
24 #include "ffsdefs.h"
25 #include "lld.h"
26 #include "lld_nand.h"
27 #if CMD_DMA
28 #include "lld_cdma.h"
29 #endif
30
31 #define BLK_FROM_ADDR(addr) ((u32)(addr >> DeviceInfo.nBitsInBlockDataSize))
32 #define PAGE_FROM_ADDR(addr, Block) ((u16)((addr - (u64)Block * \
33 DeviceInfo.wBlockDataSize) >> DeviceInfo.nBitsInPageDataSize))
34
35 #define IS_SPARE_BLOCK(blk) (BAD_BLOCK != (pbt[blk] &\
36 BAD_BLOCK) && SPARE_BLOCK == (pbt[blk] & SPARE_BLOCK))
37
38 #define IS_DATA_BLOCK(blk) (0 == (pbt[blk] & BAD_BLOCK))
39
40 #define IS_DISCARDED_BLOCK(blk) (BAD_BLOCK != (pbt[blk] &\
41 BAD_BLOCK) && DISCARD_BLOCK == (pbt[blk] & DISCARD_BLOCK))
42
43 #define IS_BAD_BLOCK(blk) (BAD_BLOCK == (pbt[blk] & BAD_BLOCK))
44
45 #if DEBUG_BNDRY
46 void debug_boundary_lineno_error(int chnl, int limit, int no,
47 int lineno, char *filename)
48 {
49 if (chnl >= limit)
50 printk(KERN_ERR "Boundary Check Fail value %d >= limit %d, "
51 "at %s:%d. Other info:%d. Aborting...\n",
52 chnl, limit, filename, lineno, no);
53 }
54 /* static int globalmemsize; */
55 #endif
56
57 static u16 FTL_Cache_If_Hit(u64 dwPageAddr);
58 static int FTL_Cache_Read(u64 dwPageAddr);
59 static void FTL_Cache_Read_Page(u8 *pData, u64 dwPageAddr,
60 u16 cache_blk);
61 static void FTL_Cache_Write_Page(u8 *pData, u64 dwPageAddr,
62 u8 cache_blk, u16 flag);
63 static int FTL_Cache_Write(void);
64 static void FTL_Calculate_LRU(void);
65 static u32 FTL_Get_Block_Index(u32 wBlockNum);
66
67 static int FTL_Search_Block_Table_IN_Block(u32 BT_Block,
68 u8 BT_Tag, u16 *Page);
69 static int FTL_Read_Block_Table(void);
70 static int FTL_Write_Block_Table(int wForce);
71 static int FTL_Write_Block_Table_Data(void);
72 static int FTL_Check_Block_Table(int wOldTable);
73 static int FTL_Static_Wear_Leveling(void);
74 static u32 FTL_Replace_Block_Table(void);
75 static int FTL_Write_IN_Progress_Block_Table_Page(void);
76
77 static u32 FTL_Get_Page_Num(u64 length);
78 static u64 FTL_Get_Physical_Block_Addr(u64 blk_addr);
79
80 static u32 FTL_Replace_OneBlock(u32 wBlockNum,
81 u32 wReplaceNum);
82 static u32 FTL_Replace_LWBlock(u32 wBlockNum,
83 int *pGarbageCollect);
84 static u32 FTL_Replace_MWBlock(void);
85 static int FTL_Replace_Block(u64 blk_addr);
86 static int FTL_Adjust_Relative_Erase_Count(u32 Index_of_MAX);
87
88 struct device_info_tag DeviceInfo;
89 struct flash_cache_tag Cache;
90 static struct spectra_l2_cache_info cache_l2;
91
92 static u8 *cache_l2_page_buf;
93 static u8 *cache_l2_blk_buf;
94
95 u8 *g_pBlockTable;
96 u8 *g_pWearCounter;
97 u16 *g_pReadCounter;
98 u32 *g_pBTBlocks;
99 static u16 g_wBlockTableOffset;
100 static u32 g_wBlockTableIndex;
101 static u8 g_cBlockTableStatus;
102
103 static u8 *g_pTempBuf;
104 static u8 *flag_check_blk_table;
105 static u8 *tmp_buf_search_bt_in_block;
106 static u8 *spare_buf_search_bt_in_block;
107 static u8 *spare_buf_bt_search_bt_in_block;
108 static u8 *tmp_buf1_read_blk_table;
109 static u8 *tmp_buf2_read_blk_table;
110 static u8 *flags_static_wear_leveling;
111 static u8 *tmp_buf_write_blk_table_data;
112 static u8 *tmp_buf_read_disturbance;
113
114 u8 *buf_read_page_main_spare;
115 u8 *buf_write_page_main_spare;
116 u8 *buf_read_page_spare;
117 u8 *buf_get_bad_block;
118
119 #if (RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE && CMD_DMA)
120 struct flash_cache_delta_list_tag int_cache[MAX_CHANS + MAX_DESCS];
121 struct flash_cache_tag cache_start_copy;
122 #endif
123
124 int g_wNumFreeBlocks;
125 u8 g_SBDCmdIndex;
126
127 static u8 *g_pIPF;
128 static u8 bt_flag = FIRST_BT_ID;
129 static u8 bt_block_changed;
130
131 static u16 cache_block_to_write;
132 static u8 last_erased = FIRST_BT_ID;
133
134 static u8 GC_Called;
135 static u8 BT_GC_Called;
136
137 #if CMD_DMA
138 #define COPY_BACK_BUF_NUM 10
139
140 static u8 ftl_cmd_cnt; /* Init value is 0 */
141 u8 *g_pBTDelta;
142 u8 *g_pBTDelta_Free;
143 u8 *g_pBTStartingCopy;
144 u8 *g_pWearCounterCopy;
145 u16 *g_pReadCounterCopy;
146 u8 *g_pBlockTableCopies;
147 u8 *g_pNextBlockTable;
148 static u8 *cp_back_buf_copies[COPY_BACK_BUF_NUM];
149 static int cp_back_buf_idx;
150
151 static u8 *g_temp_buf;
152
153 #pragma pack(push, 1)
154 #pragma pack(1)
155 struct BTableChangesDelta {
156 u8 ftl_cmd_cnt;
157 u8 ValidFields;
158 u16 g_wBlockTableOffset;
159 u32 g_wBlockTableIndex;
160 u32 BT_Index;
161 u32 BT_Entry_Value;
162 u32 WC_Index;
163 u8 WC_Entry_Value;
164 u32 RC_Index;
165 u16 RC_Entry_Value;
166 };
167
168 #pragma pack(pop)
169
170 struct BTableChangesDelta *p_BTableChangesDelta;
171 #endif
172
173
174 #define MARK_BLOCK_AS_BAD(blocknode) (blocknode |= BAD_BLOCK)
175 #define MARK_BLK_AS_DISCARD(blk) (blk = (blk & ~SPARE_BLOCK) | DISCARD_BLOCK)
176
177 #define FTL_Get_LBAPBA_Table_Mem_Size_Bytes() (DeviceInfo.wDataBlockNum *\
178 sizeof(u32))
179 #define FTL_Get_WearCounter_Table_Mem_Size_Bytes() (DeviceInfo.wDataBlockNum *\
180 sizeof(u8))
181 #define FTL_Get_ReadCounter_Table_Mem_Size_Bytes() (DeviceInfo.wDataBlockNum *\
182 sizeof(u16))
183 #if SUPPORT_LARGE_BLOCKNUM
184 #define FTL_Get_LBAPBA_Table_Flash_Size_Bytes() (DeviceInfo.wDataBlockNum *\
185 sizeof(u8) * 3)
186 #else
187 #define FTL_Get_LBAPBA_Table_Flash_Size_Bytes() (DeviceInfo.wDataBlockNum *\
188 sizeof(u16))
189 #endif
190 #define FTL_Get_WearCounter_Table_Flash_Size_Bytes \
191 FTL_Get_WearCounter_Table_Mem_Size_Bytes
192 #define FTL_Get_ReadCounter_Table_Flash_Size_Bytes \
193 FTL_Get_ReadCounter_Table_Mem_Size_Bytes
194
195 static u32 FTL_Get_Block_Table_Flash_Size_Bytes(void)
196 {
197 u32 byte_num;
198
199 if (DeviceInfo.MLCDevice) {
200 byte_num = FTL_Get_LBAPBA_Table_Flash_Size_Bytes() +
201 DeviceInfo.wDataBlockNum * sizeof(u8) +
202 DeviceInfo.wDataBlockNum * sizeof(u16);
203 } else {
204 byte_num = FTL_Get_LBAPBA_Table_Flash_Size_Bytes() +
205 DeviceInfo.wDataBlockNum * sizeof(u8);
206 }
207
208 byte_num += 4 * sizeof(u8);
209
210 return byte_num;
211 }
212
213 static u16 FTL_Get_Block_Table_Flash_Size_Pages(void)
214 {
215 return (u16)FTL_Get_Page_Num(FTL_Get_Block_Table_Flash_Size_Bytes());
216 }
217
218 static int FTL_Copy_Block_Table_To_Flash(u8 *flashBuf, u32 sizeToTx,
219 u32 sizeTxed)
220 {
221 u32 wBytesCopied, blk_tbl_size, wBytes;
222 u32 *pbt = (u32 *)g_pBlockTable;
223
224 blk_tbl_size = FTL_Get_LBAPBA_Table_Flash_Size_Bytes();
225 for (wBytes = 0;
226 (wBytes < sizeToTx) && ((wBytes + sizeTxed) < blk_tbl_size);
227 wBytes++) {
228 #if SUPPORT_LARGE_BLOCKNUM
229 flashBuf[wBytes] = (u8)(pbt[(wBytes + sizeTxed) / 3]
230 >> (((wBytes + sizeTxed) % 3) ?
231 ((((wBytes + sizeTxed) % 3) == 2) ? 0 : 8) : 16)) & 0xFF;
232 #else
233 flashBuf[wBytes] = (u8)(pbt[(wBytes + sizeTxed) / 2]
234 >> (((wBytes + sizeTxed) % 2) ? 0 : 8)) & 0xFF;
235 #endif
236 }
237
238 sizeTxed = (sizeTxed > blk_tbl_size) ? (sizeTxed - blk_tbl_size) : 0;
239 blk_tbl_size = FTL_Get_WearCounter_Table_Flash_Size_Bytes();
240 wBytesCopied = wBytes;
241 wBytes = ((blk_tbl_size - sizeTxed) > (sizeToTx - wBytesCopied)) ?
242 (sizeToTx - wBytesCopied) : (blk_tbl_size - sizeTxed);
243 memcpy(flashBuf + wBytesCopied, g_pWearCounter + sizeTxed, wBytes);
244
245 sizeTxed = (sizeTxed > blk_tbl_size) ? (sizeTxed - blk_tbl_size) : 0;
246
247 if (DeviceInfo.MLCDevice) {
248 blk_tbl_size = FTL_Get_ReadCounter_Table_Flash_Size_Bytes();
249 wBytesCopied += wBytes;
250 for (wBytes = 0; ((wBytes + wBytesCopied) < sizeToTx) &&
251 ((wBytes + sizeTxed) < blk_tbl_size); wBytes++)
252 flashBuf[wBytes + wBytesCopied] =
253 (g_pReadCounter[(wBytes + sizeTxed) / 2] >>
254 (((wBytes + sizeTxed) % 2) ? 0 : 8)) & 0xFF;
255 }
256
257 return wBytesCopied + wBytes;
258 }
259
260 static int FTL_Copy_Block_Table_From_Flash(u8 *flashBuf,
261 u32 sizeToTx, u32 sizeTxed)
262 {
263 u32 wBytesCopied, blk_tbl_size, wBytes;
264 u32 *pbt = (u32 *)g_pBlockTable;
265
266 blk_tbl_size = FTL_Get_LBAPBA_Table_Flash_Size_Bytes();
267 for (wBytes = 0; (wBytes < sizeToTx) &&
268 ((wBytes + sizeTxed) < blk_tbl_size); wBytes++) {
269 #if SUPPORT_LARGE_BLOCKNUM
270 if (!((wBytes + sizeTxed) % 3))
271 pbt[(wBytes + sizeTxed) / 3] = 0;
272 pbt[(wBytes + sizeTxed) / 3] |=
273 (flashBuf[wBytes] << (((wBytes + sizeTxed) % 3) ?
274 ((((wBytes + sizeTxed) % 3) == 2) ? 0 : 8) : 16));
275 #else
276 if (!((wBytes + sizeTxed) % 2))
277 pbt[(wBytes + sizeTxed) / 2] = 0;
278 pbt[(wBytes + sizeTxed) / 2] |=
279 (flashBuf[wBytes] << (((wBytes + sizeTxed) % 2) ?
280 0 : 8));
281 #endif
282 }
283
284 sizeTxed = (sizeTxed > blk_tbl_size) ? (sizeTxed - blk_tbl_size) : 0;
285 blk_tbl_size = FTL_Get_WearCounter_Table_Flash_Size_Bytes();
286 wBytesCopied = wBytes;
287 wBytes = ((blk_tbl_size - sizeTxed) > (sizeToTx - wBytesCopied)) ?
288 (sizeToTx - wBytesCopied) : (blk_tbl_size - sizeTxed);
289 memcpy(g_pWearCounter + sizeTxed, flashBuf + wBytesCopied, wBytes);
290 sizeTxed = (sizeTxed > blk_tbl_size) ? (sizeTxed - blk_tbl_size) : 0;
291
292 if (DeviceInfo.MLCDevice) {
293 wBytesCopied += wBytes;
294 blk_tbl_size = FTL_Get_ReadCounter_Table_Flash_Size_Bytes();
295 for (wBytes = 0; ((wBytes + wBytesCopied) < sizeToTx) &&
296 ((wBytes + sizeTxed) < blk_tbl_size); wBytes++) {
297 if (((wBytes + sizeTxed) % 2))
298 g_pReadCounter[(wBytes + sizeTxed) / 2] = 0;
299 g_pReadCounter[(wBytes + sizeTxed) / 2] |=
300 (flashBuf[wBytes] <<
301 (((wBytes + sizeTxed) % 2) ? 0 : 8));
302 }
303 }
304
305 return wBytesCopied+wBytes;
306 }
307
308 static int FTL_Insert_Block_Table_Signature(u8 *buf, u8 tag)
309 {
310 int i;
311
312 for (i = 0; i < BTSIG_BYTES; i++)
313 buf[BTSIG_OFFSET + i] =
314 ((tag + (i * BTSIG_DELTA) - FIRST_BT_ID) %
315 (1 + LAST_BT_ID-FIRST_BT_ID)) + FIRST_BT_ID;
316
317 return PASS;
318 }
319
320 static int FTL_Extract_Block_Table_Tag(u8 *buf, u8 **tagarray)
321 {
322 static u8 tag[BTSIG_BYTES >> 1];
323 int i, j, k, tagi, tagtemp, status;
324
325 *tagarray = (u8 *)tag;
326 tagi = 0;
327
328 for (i = 0; i < (BTSIG_BYTES - 1); i++) {
329 for (j = i + 1; (j < BTSIG_BYTES) &&
330 (tagi < (BTSIG_BYTES >> 1)); j++) {
331 tagtemp = buf[BTSIG_OFFSET + j] -
332 buf[BTSIG_OFFSET + i];
333 if (tagtemp && !(tagtemp % BTSIG_DELTA)) {
334 tagtemp = (buf[BTSIG_OFFSET + i] +
335 (1 + LAST_BT_ID - FIRST_BT_ID) -
336 (i * BTSIG_DELTA)) %
337 (1 + LAST_BT_ID - FIRST_BT_ID);
338 status = FAIL;
339 for (k = 0; k < tagi; k++) {
340 if (tagtemp == tag[k])
341 status = PASS;
342 }
343
344 if (status == FAIL) {
345 tag[tagi++] = tagtemp;
346 i = (j == (i + 1)) ? i + 1 : i;
347 j = (j == (i + 1)) ? i + 1 : i;
348 }
349 }
350 }
351 }
352
353 return tagi;
354 }
355
356
357 static int FTL_Execute_SPL_Recovery(void)
358 {
359 u32 j, block, blks;
360 u32 *pbt = (u32 *)g_pBlockTable;
361 int ret;
362
363 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
364 __FILE__, __LINE__, __func__);
365
366 blks = DeviceInfo.wSpectraEndBlock - DeviceInfo.wSpectraStartBlock;
367 for (j = 0; j <= blks; j++) {
368 block = (pbt[j]);
369 if (((block & BAD_BLOCK) != BAD_BLOCK) &&
370 ((block & SPARE_BLOCK) == SPARE_BLOCK)) {
371 ret = GLOB_LLD_Erase_Block(block & ~BAD_BLOCK);
372 if (FAIL == ret) {
373 nand_dbg_print(NAND_DBG_WARN,
374 "NAND Program fail in %s, Line %d, "
375 "Function: %s, new Bad Block %d "
376 "generated!\n",
377 __FILE__, __LINE__, __func__,
378 (int)(block & ~BAD_BLOCK));
379 MARK_BLOCK_AS_BAD(pbt[j]);
380 }
381 }
382 }
383
384 return PASS;
385 }
386
387 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
388 * Function: GLOB_FTL_IdentifyDevice
389 * Inputs: pointer to identify data structure
390 * Outputs: PASS / FAIL
391 * Description: the identify data structure is filled in with
392 * information for the block driver.
393 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
394 int GLOB_FTL_IdentifyDevice(struct spectra_indentfy_dev_tag *dev_data)
395 {
396 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
397 __FILE__, __LINE__, __func__);
398
399 dev_data->NumBlocks = DeviceInfo.wTotalBlocks;
400 dev_data->PagesPerBlock = DeviceInfo.wPagesPerBlock;
401 dev_data->PageDataSize = DeviceInfo.wPageDataSize;
402 dev_data->wECCBytesPerSector = DeviceInfo.wECCBytesPerSector;
403 dev_data->wDataBlockNum = DeviceInfo.wDataBlockNum;
404
405 return PASS;
406 }
407
408 /* ..... */
409 static int allocate_memory(void)
410 {
411 u32 block_table_size, page_size, block_size, mem_size;
412 u32 total_bytes = 0;
413 int i;
414 #if CMD_DMA
415 int j;
416 #endif
417
418 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
419 __FILE__, __LINE__, __func__);
420
421 page_size = DeviceInfo.wPageSize;
422 block_size = DeviceInfo.wPagesPerBlock * DeviceInfo.wPageDataSize;
423
424 block_table_size = DeviceInfo.wDataBlockNum *
425 (sizeof(u32) + sizeof(u8) + sizeof(u16));
426 block_table_size += (DeviceInfo.wPageDataSize -
427 (block_table_size % DeviceInfo.wPageDataSize)) %
428 DeviceInfo.wPageDataSize;
429
430 /* Malloc memory for block tables */
431 g_pBlockTable = kmalloc(block_table_size, GFP_ATOMIC);
432 if (!g_pBlockTable)
433 goto block_table_fail;
434 memset(g_pBlockTable, 0, block_table_size);
435 total_bytes += block_table_size;
436
437 g_pWearCounter = (u8 *)(g_pBlockTable +
438 DeviceInfo.wDataBlockNum * sizeof(u32));
439
440 if (DeviceInfo.MLCDevice)
441 g_pReadCounter = (u16 *)(g_pBlockTable +
442 DeviceInfo.wDataBlockNum *
443 (sizeof(u32) + sizeof(u8)));
444
445 /* Malloc memory and init for cache items */
446 for (i = 0; i < CACHE_ITEM_NUM; i++) {
447 Cache.array[i].address = NAND_CACHE_INIT_ADDR;
448 Cache.array[i].use_cnt = 0;
449 Cache.array[i].changed = CLEAR;
450 Cache.array[i].buf = kmalloc(Cache.cache_item_size,
451 GFP_ATOMIC);
452 if (!Cache.array[i].buf)
453 goto cache_item_fail;
454 memset(Cache.array[i].buf, 0, Cache.cache_item_size);
455 total_bytes += Cache.cache_item_size;
456 }
457
458 /* Malloc memory for IPF */
459 g_pIPF = kmalloc(page_size, GFP_ATOMIC);
460 if (!g_pIPF)
461 goto ipf_fail;
462 memset(g_pIPF, 0, page_size);
463 total_bytes += page_size;
464
465 /* Malloc memory for data merging during Level2 Cache flush */
466 cache_l2_page_buf = kmalloc(page_size, GFP_ATOMIC);
467 if (!cache_l2_page_buf)
468 goto cache_l2_page_buf_fail;
469 memset(cache_l2_page_buf, 0xff, page_size);
470 total_bytes += page_size;
471
472 cache_l2_blk_buf = kmalloc(block_size, GFP_ATOMIC);
473 if (!cache_l2_blk_buf)
474 goto cache_l2_blk_buf_fail;
475 memset(cache_l2_blk_buf, 0xff, block_size);
476 total_bytes += block_size;
477
478 /* Malloc memory for temp buffer */
479 g_pTempBuf = kmalloc(Cache.cache_item_size, GFP_ATOMIC);
480 if (!g_pTempBuf)
481 goto Temp_buf_fail;
482 memset(g_pTempBuf, 0, Cache.cache_item_size);
483 total_bytes += Cache.cache_item_size;
484
485 /* Malloc memory for block table blocks */
486 mem_size = (1 + LAST_BT_ID - FIRST_BT_ID) * sizeof(u32);
487 g_pBTBlocks = kmalloc(mem_size, GFP_ATOMIC);
488 if (!g_pBTBlocks)
489 goto bt_blocks_fail;
490 memset(g_pBTBlocks, 0xff, mem_size);
491 total_bytes += mem_size;
492
493 /* Malloc memory for function FTL_Check_Block_Table */
494 flag_check_blk_table = kmalloc(DeviceInfo.wDataBlockNum, GFP_ATOMIC);
495 if (!flag_check_blk_table)
496 goto flag_check_blk_table_fail;
497 total_bytes += DeviceInfo.wDataBlockNum;
498
499 /* Malloc memory for function FTL_Search_Block_Table_IN_Block */
500 tmp_buf_search_bt_in_block = kmalloc(page_size, GFP_ATOMIC);
501 if (!tmp_buf_search_bt_in_block)
502 goto tmp_buf_search_bt_in_block_fail;
503 memset(tmp_buf_search_bt_in_block, 0xff, page_size);
504 total_bytes += page_size;
505
506 mem_size = DeviceInfo.wPageSize - DeviceInfo.wPageDataSize;
507 spare_buf_search_bt_in_block = kmalloc(mem_size, GFP_ATOMIC);
508 if (!spare_buf_search_bt_in_block)
509 goto spare_buf_search_bt_in_block_fail;
510 memset(spare_buf_search_bt_in_block, 0xff, mem_size);
511 total_bytes += mem_size;
512
513 spare_buf_bt_search_bt_in_block = kmalloc(mem_size, GFP_ATOMIC);
514 if (!spare_buf_bt_search_bt_in_block)
515 goto spare_buf_bt_search_bt_in_block_fail;
516 memset(spare_buf_bt_search_bt_in_block, 0xff, mem_size);
517 total_bytes += mem_size;
518
519 /* Malloc memory for function FTL_Read_Block_Table */
520 tmp_buf1_read_blk_table = kmalloc(page_size, GFP_ATOMIC);
521 if (!tmp_buf1_read_blk_table)
522 goto tmp_buf1_read_blk_table_fail;
523 memset(tmp_buf1_read_blk_table, 0xff, page_size);
524 total_bytes += page_size;
525
526 tmp_buf2_read_blk_table = kmalloc(page_size, GFP_ATOMIC);
527 if (!tmp_buf2_read_blk_table)
528 goto tmp_buf2_read_blk_table_fail;
529 memset(tmp_buf2_read_blk_table, 0xff, page_size);
530 total_bytes += page_size;
531
532 /* Malloc memory for function FTL_Static_Wear_Leveling */
533 flags_static_wear_leveling = kmalloc(DeviceInfo.wDataBlockNum,
534 GFP_ATOMIC);
535 if (!flags_static_wear_leveling)
536 goto flags_static_wear_leveling_fail;
537 total_bytes += DeviceInfo.wDataBlockNum;
538
539 /* Malloc memory for function FTL_Write_Block_Table_Data */
540 if (FTL_Get_Block_Table_Flash_Size_Pages() > 3)
541 mem_size = FTL_Get_Block_Table_Flash_Size_Bytes() -
542 2 * DeviceInfo.wPageSize;
543 else
544 mem_size = DeviceInfo.wPageSize;
545 tmp_buf_write_blk_table_data = kmalloc(mem_size, GFP_ATOMIC);
546 if (!tmp_buf_write_blk_table_data)
547 goto tmp_buf_write_blk_table_data_fail;
548 memset(tmp_buf_write_blk_table_data, 0xff, mem_size);
549 total_bytes += mem_size;
550
551 /* Malloc memory for function FTL_Read_Disturbance */
552 tmp_buf_read_disturbance = kmalloc(block_size, GFP_ATOMIC);
553 if (!tmp_buf_read_disturbance)
554 goto tmp_buf_read_disturbance_fail;
555 memset(tmp_buf_read_disturbance, 0xff, block_size);
556 total_bytes += block_size;
557
558 /* Alloc mem for function NAND_Read_Page_Main_Spare of lld_nand.c */
559 buf_read_page_main_spare = kmalloc(DeviceInfo.wPageSize, GFP_ATOMIC);
560 if (!buf_read_page_main_spare)
561 goto buf_read_page_main_spare_fail;
562 total_bytes += DeviceInfo.wPageSize;
563
564 /* Alloc mem for function NAND_Write_Page_Main_Spare of lld_nand.c */
565 buf_write_page_main_spare = kmalloc(DeviceInfo.wPageSize, GFP_ATOMIC);
566 if (!buf_write_page_main_spare)
567 goto buf_write_page_main_spare_fail;
568 total_bytes += DeviceInfo.wPageSize;
569
570 /* Alloc mem for function NAND_Read_Page_Spare of lld_nand.c */
571 buf_read_page_spare = kmalloc(DeviceInfo.wPageSpareSize, GFP_ATOMIC);
572 if (!buf_read_page_spare)
573 goto buf_read_page_spare_fail;
574 memset(buf_read_page_spare, 0xff, DeviceInfo.wPageSpareSize);
575 total_bytes += DeviceInfo.wPageSpareSize;
576
577 /* Alloc mem for function NAND_Get_Bad_Block of lld_nand.c */
578 buf_get_bad_block = kmalloc(DeviceInfo.wPageSpareSize, GFP_ATOMIC);
579 if (!buf_get_bad_block)
580 goto buf_get_bad_block_fail;
581 memset(buf_get_bad_block, 0xff, DeviceInfo.wPageSpareSize);
582 total_bytes += DeviceInfo.wPageSpareSize;
583
584 #if CMD_DMA
585 g_temp_buf = kmalloc(block_size, GFP_ATOMIC);
586 if (!g_temp_buf)
587 goto temp_buf_fail;
588 memset(g_temp_buf, 0xff, block_size);
589 total_bytes += block_size;
590
591 /* Malloc memory for copy of block table used in CDMA mode */
592 g_pBTStartingCopy = kmalloc(block_table_size, GFP_ATOMIC);
593 if (!g_pBTStartingCopy)
594 goto bt_starting_copy;
595 memset(g_pBTStartingCopy, 0, block_table_size);
596 total_bytes += block_table_size;
597
598 g_pWearCounterCopy = (u8 *)(g_pBTStartingCopy +
599 DeviceInfo.wDataBlockNum * sizeof(u32));
600
601 if (DeviceInfo.MLCDevice)
602 g_pReadCounterCopy = (u16 *)(g_pBTStartingCopy +
603 DeviceInfo.wDataBlockNum *
604 (sizeof(u32) + sizeof(u8)));
605
606 /* Malloc memory for block table copies */
607 mem_size = 5 * DeviceInfo.wDataBlockNum * sizeof(u32) +
608 5 * DeviceInfo.wDataBlockNum * sizeof(u8);
609 if (DeviceInfo.MLCDevice)
610 mem_size += 5 * DeviceInfo.wDataBlockNum * sizeof(u16);
611 g_pBlockTableCopies = kmalloc(mem_size, GFP_ATOMIC);
612 if (!g_pBlockTableCopies)
613 goto blk_table_copies_fail;
614 memset(g_pBlockTableCopies, 0, mem_size);
615 total_bytes += mem_size;
616 g_pNextBlockTable = g_pBlockTableCopies;
617
618 /* Malloc memory for Block Table Delta */
619 mem_size = MAX_DESCS * sizeof(struct BTableChangesDelta);
620 g_pBTDelta = kmalloc(mem_size, GFP_ATOMIC);
621 if (!g_pBTDelta)
622 goto bt_delta_fail;
623 memset(g_pBTDelta, 0, mem_size);
624 total_bytes += mem_size;
625 g_pBTDelta_Free = g_pBTDelta;
626
627 /* Malloc memory for Copy Back Buffers */
628 for (j = 0; j < COPY_BACK_BUF_NUM; j++) {
629 cp_back_buf_copies[j] = kmalloc(block_size, GFP_ATOMIC);
630 if (!cp_back_buf_copies[j])
631 goto cp_back_buf_copies_fail;
632 memset(cp_back_buf_copies[j], 0, block_size);
633 total_bytes += block_size;
634 }
635 cp_back_buf_idx = 0;
636
637 /* Malloc memory for pending commands list */
638 mem_size = sizeof(struct pending_cmd) * MAX_DESCS;
639 info.pcmds = kzalloc(mem_size, GFP_KERNEL);
640 if (!info.pcmds)
641 goto pending_cmds_buf_fail;
642 total_bytes += mem_size;
643
644 /* Malloc memory for CDMA descripter table */
645 mem_size = sizeof(struct cdma_descriptor) * MAX_DESCS;
646 info.cdma_desc_buf = kzalloc(mem_size, GFP_KERNEL);
647 if (!info.cdma_desc_buf)
648 goto cdma_desc_buf_fail;
649 total_bytes += mem_size;
650
651 /* Malloc memory for Memcpy descripter table */
652 mem_size = sizeof(struct memcpy_descriptor) * MAX_DESCS;
653 info.memcp_desc_buf = kzalloc(mem_size, GFP_KERNEL);
654 if (!info.memcp_desc_buf)
655 goto memcp_desc_buf_fail;
656 total_bytes += mem_size;
657 #endif
658
659 nand_dbg_print(NAND_DBG_WARN,
660 "Total memory allocated in FTL layer: %d\n", total_bytes);
661
662 return PASS;
663
664 #if CMD_DMA
665 memcp_desc_buf_fail:
666 kfree(info.cdma_desc_buf);
667 cdma_desc_buf_fail:
668 kfree(info.pcmds);
669 pending_cmds_buf_fail:
670 cp_back_buf_copies_fail:
671 j--;
672 for (; j >= 0; j--)
673 kfree(cp_back_buf_copies[j]);
674 kfree(g_pBTDelta);
675 bt_delta_fail:
676 kfree(g_pBlockTableCopies);
677 blk_table_copies_fail:
678 kfree(g_pBTStartingCopy);
679 bt_starting_copy:
680 kfree(g_temp_buf);
681 temp_buf_fail:
682 kfree(buf_get_bad_block);
683 #endif
684
685 buf_get_bad_block_fail:
686 kfree(buf_read_page_spare);
687 buf_read_page_spare_fail:
688 kfree(buf_write_page_main_spare);
689 buf_write_page_main_spare_fail:
690 kfree(buf_read_page_main_spare);
691 buf_read_page_main_spare_fail:
692 kfree(tmp_buf_read_disturbance);
693 tmp_buf_read_disturbance_fail:
694 kfree(tmp_buf_write_blk_table_data);
695 tmp_buf_write_blk_table_data_fail:
696 kfree(flags_static_wear_leveling);
697 flags_static_wear_leveling_fail:
698 kfree(tmp_buf2_read_blk_table);
699 tmp_buf2_read_blk_table_fail:
700 kfree(tmp_buf1_read_blk_table);
701 tmp_buf1_read_blk_table_fail:
702 kfree(spare_buf_bt_search_bt_in_block);
703 spare_buf_bt_search_bt_in_block_fail:
704 kfree(spare_buf_search_bt_in_block);
705 spare_buf_search_bt_in_block_fail:
706 kfree(tmp_buf_search_bt_in_block);
707 tmp_buf_search_bt_in_block_fail:
708 kfree(flag_check_blk_table);
709 flag_check_blk_table_fail:
710 kfree(g_pBTBlocks);
711 bt_blocks_fail:
712 kfree(g_pTempBuf);
713 Temp_buf_fail:
714 kfree(cache_l2_blk_buf);
715 cache_l2_blk_buf_fail:
716 kfree(cache_l2_page_buf);
717 cache_l2_page_buf_fail:
718 kfree(g_pIPF);
719 ipf_fail:
720 cache_item_fail:
721 i--;
722 for (; i >= 0; i--)
723 kfree(Cache.array[i].buf);
724 kfree(g_pBlockTable);
725 block_table_fail:
726 printk(KERN_ERR "Failed to kmalloc memory in %s Line %d.\n",
727 __FILE__, __LINE__);
728
729 return -ENOMEM;
730 }
731
732 /* .... */
733 static int free_memory(void)
734 {
735 int i;
736
737 #if CMD_DMA
738 kfree(info.memcp_desc_buf);
739 kfree(info.cdma_desc_buf);
740 kfree(info.pcmds);
741 for (i = COPY_BACK_BUF_NUM - 1; i >= 0; i--)
742 kfree(cp_back_buf_copies[i]);
743 kfree(g_pBTDelta);
744 kfree(g_pBlockTableCopies);
745 kfree(g_pBTStartingCopy);
746 kfree(g_temp_buf);
747 kfree(buf_get_bad_block);
748 #endif
749 kfree(buf_read_page_spare);
750 kfree(buf_write_page_main_spare);
751 kfree(buf_read_page_main_spare);
752 kfree(tmp_buf_read_disturbance);
753 kfree(tmp_buf_write_blk_table_data);
754 kfree(flags_static_wear_leveling);
755 kfree(tmp_buf2_read_blk_table);
756 kfree(tmp_buf1_read_blk_table);
757 kfree(spare_buf_bt_search_bt_in_block);
758 kfree(spare_buf_search_bt_in_block);
759 kfree(tmp_buf_search_bt_in_block);
760 kfree(flag_check_blk_table);
761 kfree(g_pBTBlocks);
762 kfree(g_pTempBuf);
763 kfree(g_pIPF);
764 for (i = CACHE_ITEM_NUM - 1; i >= 0; i--)
765 kfree(Cache.array[i].buf);
766 kfree(g_pBlockTable);
767
768 return 0;
769 }
770
771 static void dump_cache_l2_table(void)
772 {
773 struct list_head *p;
774 struct spectra_l2_cache_list *pnd;
775 int n;
776
777 n = 0;
778 list_for_each(p, &cache_l2.table.list) {
779 pnd = list_entry(p, struct spectra_l2_cache_list, list);
780 nand_dbg_print(NAND_DBG_WARN, "dump_cache_l2_table node: %d, logical_blk_num: %d\n", n, pnd->logical_blk_num);
781 /*
782 for (i = 0; i < DeviceInfo.wPagesPerBlock; i++) {
783 if (pnd->pages_array[i] != MAX_U32_VALUE)
784 nand_dbg_print(NAND_DBG_WARN, " pages_array[%d]: 0x%x\n", i, pnd->pages_array[i]);
785 }
786 */
787 n++;
788 }
789 }
790
791 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
792 * Function: GLOB_FTL_Init
793 * Inputs: none
794 * Outputs: PASS=0 / FAIL=1
795 * Description: allocates the memory for cache array,
796 * important data structures
797 * clears the cache array
798 * reads the block table from flash into array
799 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
800 int GLOB_FTL_Init(void)
801 {
802 int i;
803
804 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
805 __FILE__, __LINE__, __func__);
806
807 Cache.pages_per_item = 1;
808 Cache.cache_item_size = 1 * DeviceInfo.wPageDataSize;
809
810 if (allocate_memory() != PASS)
811 return FAIL;
812
813 #if CMD_DMA
814 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
815 memcpy((void *)&cache_start_copy, (void *)&Cache,
816 sizeof(struct flash_cache_tag));
817 memset((void *)&int_cache, -1,
818 sizeof(struct flash_cache_delta_list_tag) *
819 (MAX_CHANS + MAX_DESCS));
820 #endif
821 ftl_cmd_cnt = 0;
822 #endif
823
824 if (FTL_Read_Block_Table() != PASS)
825 return FAIL;
826
827 /* Init the Level2 Cache data structure */
828 for (i = 0; i < BLK_NUM_FOR_L2_CACHE; i++)
829 cache_l2.blk_array[i] = MAX_U32_VALUE;
830 cache_l2.cur_blk_idx = 0;
831 cache_l2.cur_page_num = 0;
832 INIT_LIST_HEAD(&cache_l2.table.list);
833 cache_l2.table.logical_blk_num = MAX_U32_VALUE;
834
835 dump_cache_l2_table();
836
837 return 0;
838 }
839
840
841 #if CMD_DMA
842 #if 0
843 static void save_blk_table_changes(u16 idx)
844 {
845 u8 ftl_cmd;
846 u32 *pbt = (u32 *)g_pBTStartingCopy;
847
848 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
849 u16 id;
850 u8 cache_blks;
851
852 id = idx - MAX_CHANS;
853 if (int_cache[id].item != -1) {
854 cache_blks = int_cache[id].item;
855 cache_start_copy.array[cache_blks].address =
856 int_cache[id].cache.address;
857 cache_start_copy.array[cache_blks].changed =
858 int_cache[id].cache.changed;
859 }
860 #endif
861
862 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
863
864 while (ftl_cmd <= PendingCMD[idx].Tag) {
865 if (p_BTableChangesDelta->ValidFields == 0x01) {
866 g_wBlockTableOffset =
867 p_BTableChangesDelta->g_wBlockTableOffset;
868 } else if (p_BTableChangesDelta->ValidFields == 0x0C) {
869 pbt[p_BTableChangesDelta->BT_Index] =
870 p_BTableChangesDelta->BT_Entry_Value;
871 debug_boundary_error(((
872 p_BTableChangesDelta->BT_Index)),
873 DeviceInfo.wDataBlockNum, 0);
874 } else if (p_BTableChangesDelta->ValidFields == 0x03) {
875 g_wBlockTableOffset =
876 p_BTableChangesDelta->g_wBlockTableOffset;
877 g_wBlockTableIndex =
878 p_BTableChangesDelta->g_wBlockTableIndex;
879 } else if (p_BTableChangesDelta->ValidFields == 0x30) {
880 g_pWearCounterCopy[p_BTableChangesDelta->WC_Index] =
881 p_BTableChangesDelta->WC_Entry_Value;
882 } else if ((DeviceInfo.MLCDevice) &&
883 (p_BTableChangesDelta->ValidFields == 0xC0)) {
884 g_pReadCounterCopy[p_BTableChangesDelta->RC_Index] =
885 p_BTableChangesDelta->RC_Entry_Value;
886 nand_dbg_print(NAND_DBG_DEBUG,
887 "In event status setting read counter "
888 "GLOB_ftl_cmd_cnt %u Count %u Index %u\n",
889 ftl_cmd,
890 p_BTableChangesDelta->RC_Entry_Value,
891 (unsigned int)p_BTableChangesDelta->RC_Index);
892 } else {
893 nand_dbg_print(NAND_DBG_DEBUG,
894 "This should never occur \n");
895 }
896 p_BTableChangesDelta += 1;
897 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
898 }
899 }
900
901 static void discard_cmds(u16 n)
902 {
903 u32 *pbt = (u32 *)g_pBTStartingCopy;
904 u8 ftl_cmd;
905 unsigned long k;
906 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
907 u8 cache_blks;
908 u16 id;
909 #endif
910
911 if ((PendingCMD[n].CMD == WRITE_MAIN_CMD) ||
912 (PendingCMD[n].CMD == WRITE_MAIN_SPARE_CMD)) {
913 for (k = 0; k < DeviceInfo.wDataBlockNum; k++) {
914 if (PendingCMD[n].Block == (pbt[k] & (~BAD_BLOCK)))
915 MARK_BLK_AS_DISCARD(pbt[k]);
916 }
917 }
918
919 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
920 while (ftl_cmd <= PendingCMD[n].Tag) {
921 p_BTableChangesDelta += 1;
922 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
923 }
924
925 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
926 id = n - MAX_CHANS;
927
928 if (int_cache[id].item != -1) {
929 cache_blks = int_cache[id].item;
930 if (PendingCMD[n].CMD == MEMCOPY_CMD) {
931 if ((cache_start_copy.array[cache_blks].buf <=
932 PendingCMD[n].DataDestAddr) &&
933 ((cache_start_copy.array[cache_blks].buf +
934 Cache.cache_item_size) >
935 PendingCMD[n].DataDestAddr)) {
936 cache_start_copy.array[cache_blks].address =
937 NAND_CACHE_INIT_ADDR;
938 cache_start_copy.array[cache_blks].use_cnt =
939 0;
940 cache_start_copy.array[cache_blks].changed =
941 CLEAR;
942 }
943 } else {
944 cache_start_copy.array[cache_blks].address =
945 int_cache[id].cache.address;
946 cache_start_copy.array[cache_blks].changed =
947 int_cache[id].cache.changed;
948 }
949 }
950 #endif
951 }
952
953 static void process_cmd_pass(int *first_failed_cmd, u16 idx)
954 {
955 if (0 == *first_failed_cmd)
956 save_blk_table_changes(idx);
957 else
958 discard_cmds(idx);
959 }
960
961 static void process_cmd_fail_abort(int *first_failed_cmd,
962 u16 idx, int event)
963 {
964 u32 *pbt = (u32 *)g_pBTStartingCopy;
965 u8 ftl_cmd;
966 unsigned long i;
967 int erase_fail, program_fail;
968 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
969 u8 cache_blks;
970 u16 id;
971 #endif
972
973 if (0 == *first_failed_cmd)
974 *first_failed_cmd = PendingCMD[idx].SBDCmdIndex;
975
976 nand_dbg_print(NAND_DBG_DEBUG, "Uncorrectable error has occured "
977 "while executing %u Command %u accesing Block %u\n",
978 (unsigned int)p_BTableChangesDelta->ftl_cmd_cnt,
979 PendingCMD[idx].CMD,
980 (unsigned int)PendingCMD[idx].Block);
981
982 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
983 while (ftl_cmd <= PendingCMD[idx].Tag) {
984 p_BTableChangesDelta += 1;
985 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
986 }
987
988 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
989 id = idx - MAX_CHANS;
990
991 if (int_cache[id].item != -1) {
992 cache_blks = int_cache[id].item;
993 if ((PendingCMD[idx].CMD == WRITE_MAIN_CMD)) {
994 cache_start_copy.array[cache_blks].address =
995 int_cache[id].cache.address;
996 cache_start_copy.array[cache_blks].changed = SET;
997 } else if ((PendingCMD[idx].CMD == READ_MAIN_CMD)) {
998 cache_start_copy.array[cache_blks].address =
999 NAND_CACHE_INIT_ADDR;
1000 cache_start_copy.array[cache_blks].use_cnt = 0;
1001 cache_start_copy.array[cache_blks].changed =
1002 CLEAR;
1003 } else if (PendingCMD[idx].CMD == ERASE_CMD) {
1004 /* ? */
1005 } else if (PendingCMD[idx].CMD == MEMCOPY_CMD) {
1006 /* ? */
1007 }
1008 }
1009 #endif
1010
1011 erase_fail = (event == EVENT_ERASE_FAILURE) &&
1012 (PendingCMD[idx].CMD == ERASE_CMD);
1013
1014 program_fail = (event == EVENT_PROGRAM_FAILURE) &&
1015 ((PendingCMD[idx].CMD == WRITE_MAIN_CMD) ||
1016 (PendingCMD[idx].CMD == WRITE_MAIN_SPARE_CMD));
1017
1018 if (erase_fail || program_fail) {
1019 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
1020 if (PendingCMD[idx].Block ==
1021 (pbt[i] & (~BAD_BLOCK)))
1022 MARK_BLOCK_AS_BAD(pbt[i]);
1023 }
1024 }
1025 }
1026
1027 static void process_cmd(int *first_failed_cmd, u16 idx, int event)
1028 {
1029 u8 ftl_cmd;
1030 int cmd_match = 0;
1031
1032 if (p_BTableChangesDelta->ftl_cmd_cnt == PendingCMD[idx].Tag)
1033 cmd_match = 1;
1034
1035 if (PendingCMD[idx].Status == CMD_PASS) {
1036 process_cmd_pass(first_failed_cmd, idx);
1037 } else if ((PendingCMD[idx].Status == CMD_FAIL) ||
1038 (PendingCMD[idx].Status == CMD_ABORT)) {
1039 process_cmd_fail_abort(first_failed_cmd, idx, event);
1040 } else if ((PendingCMD[idx].Status == CMD_NOT_DONE) &&
1041 PendingCMD[idx].Tag) {
1042 nand_dbg_print(NAND_DBG_DEBUG,
1043 " Command no. %hu is not executed\n",
1044 (unsigned int)PendingCMD[idx].Tag);
1045 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
1046 while (ftl_cmd <= PendingCMD[idx].Tag) {
1047 p_BTableChangesDelta += 1;
1048 ftl_cmd = p_BTableChangesDelta->ftl_cmd_cnt;
1049 }
1050 }
1051 }
1052 #endif
1053
1054 static void process_cmd(int *first_failed_cmd, u16 idx, int event)
1055 {
1056 printk(KERN_ERR "temporary workaround function. "
1057 "Should not be called! \n");
1058 }
1059
1060 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1061 * Function: GLOB_FTL_Event_Status
1062 * Inputs: none
1063 * Outputs: Event Code
1064 * Description: It is called by SBD after hardware interrupt signalling
1065 * completion of commands chain
1066 * It does following things
1067 * get event status from LLD
1068 * analyze command chain status
1069 * determine last command executed
1070 * analyze results
1071 * rebuild the block table in case of uncorrectable error
1072 * return event code
1073 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1074 int GLOB_FTL_Event_Status(int *first_failed_cmd)
1075 {
1076 int event_code = PASS;
1077 u16 i_P;
1078
1079 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1080 __FILE__, __LINE__, __func__);
1081
1082 *first_failed_cmd = 0;
1083
1084 event_code = GLOB_LLD_Event_Status();
1085
1086 switch (event_code) {
1087 case EVENT_PASS:
1088 nand_dbg_print(NAND_DBG_DEBUG, "Handling EVENT_PASS\n");
1089 break;
1090 case EVENT_UNCORRECTABLE_DATA_ERROR:
1091 nand_dbg_print(NAND_DBG_DEBUG, "Handling Uncorrectable ECC!\n");
1092 break;
1093 case EVENT_PROGRAM_FAILURE:
1094 case EVENT_ERASE_FAILURE:
1095 nand_dbg_print(NAND_DBG_WARN, "Handling Ugly case. "
1096 "Event code: 0x%x\n", event_code);
1097 p_BTableChangesDelta =
1098 (struct BTableChangesDelta *)g_pBTDelta;
1099 for (i_P = MAX_CHANS; i_P < (ftl_cmd_cnt + MAX_CHANS);
1100 i_P++)
1101 process_cmd(first_failed_cmd, i_P, event_code);
1102 memcpy(g_pBlockTable, g_pBTStartingCopy,
1103 DeviceInfo.wDataBlockNum * sizeof(u32));
1104 memcpy(g_pWearCounter, g_pWearCounterCopy,
1105 DeviceInfo.wDataBlockNum * sizeof(u8));
1106 if (DeviceInfo.MLCDevice)
1107 memcpy(g_pReadCounter, g_pReadCounterCopy,
1108 DeviceInfo.wDataBlockNum * sizeof(u16));
1109
1110 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
1111 memcpy((void *)&Cache, (void *)&cache_start_copy,
1112 sizeof(struct flash_cache_tag));
1113 memset((void *)&int_cache, -1,
1114 sizeof(struct flash_cache_delta_list_tag) *
1115 (MAX_DESCS + MAX_CHANS));
1116 #endif
1117 break;
1118 default:
1119 nand_dbg_print(NAND_DBG_WARN,
1120 "Handling unexpected event code - 0x%x\n",
1121 event_code);
1122 event_code = ERR;
1123 break;
1124 }
1125
1126 memcpy(g_pBTStartingCopy, g_pBlockTable,
1127 DeviceInfo.wDataBlockNum * sizeof(u32));
1128 memcpy(g_pWearCounterCopy, g_pWearCounter,
1129 DeviceInfo.wDataBlockNum * sizeof(u8));
1130 if (DeviceInfo.MLCDevice)
1131 memcpy(g_pReadCounterCopy, g_pReadCounter,
1132 DeviceInfo.wDataBlockNum * sizeof(u16));
1133
1134 g_pBTDelta_Free = g_pBTDelta;
1135 ftl_cmd_cnt = 0;
1136 g_pNextBlockTable = g_pBlockTableCopies;
1137 cp_back_buf_idx = 0;
1138
1139 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
1140 memcpy((void *)&cache_start_copy, (void *)&Cache,
1141 sizeof(struct flash_cache_tag));
1142 memset((void *)&int_cache, -1,
1143 sizeof(struct flash_cache_delta_list_tag) *
1144 (MAX_DESCS + MAX_CHANS));
1145 #endif
1146
1147 return event_code;
1148 }
1149
1150 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1151 * Function: glob_ftl_execute_cmds
1152 * Inputs: none
1153 * Outputs: none
1154 * Description: pass thru to LLD
1155 ***************************************************************/
1156 u16 glob_ftl_execute_cmds(void)
1157 {
1158 nand_dbg_print(NAND_DBG_TRACE,
1159 "glob_ftl_execute_cmds: ftl_cmd_cnt %u\n",
1160 (unsigned int)ftl_cmd_cnt);
1161 g_SBDCmdIndex = 0;
1162 return glob_lld_execute_cmds();
1163 }
1164
1165 #endif
1166
1167 #if !CMD_DMA
1168 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1169 * Function: GLOB_FTL_Read Immediate
1170 * Inputs: pointer to data
1171 * address of data
1172 * Outputs: PASS / FAIL
1173 * Description: Reads one page of data into RAM directly from flash without
1174 * using or disturbing cache.It is assumed this function is called
1175 * with CMD-DMA disabled.
1176 *****************************************************************/
1177 int GLOB_FTL_Read_Immediate(u8 *read_data, u64 addr)
1178 {
1179 int wResult = FAIL;
1180 u32 Block;
1181 u16 Page;
1182 u32 phy_blk;
1183 u32 *pbt = (u32 *)g_pBlockTable;
1184
1185 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1186 __FILE__, __LINE__, __func__);
1187
1188 Block = BLK_FROM_ADDR(addr);
1189 Page = PAGE_FROM_ADDR(addr, Block);
1190
1191 if (!IS_SPARE_BLOCK(Block))
1192 return FAIL;
1193
1194 phy_blk = pbt[Block];
1195 wResult = GLOB_LLD_Read_Page_Main(read_data, phy_blk, Page, 1);
1196
1197 if (DeviceInfo.MLCDevice) {
1198 g_pReadCounter[phy_blk - DeviceInfo.wSpectraStartBlock]++;
1199 if (g_pReadCounter[phy_blk - DeviceInfo.wSpectraStartBlock]
1200 >= MAX_READ_COUNTER)
1201 FTL_Read_Disturbance(phy_blk);
1202 if (g_cBlockTableStatus != IN_PROGRESS_BLOCK_TABLE) {
1203 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
1204 FTL_Write_IN_Progress_Block_Table_Page();
1205 }
1206 }
1207
1208 return wResult;
1209 }
1210 #endif
1211
1212 #ifdef SUPPORT_BIG_ENDIAN
1213 /*********************************************************************
1214 * Function: FTL_Invert_Block_Table
1215 * Inputs: none
1216 * Outputs: none
1217 * Description: Re-format the block table in ram based on BIG_ENDIAN and
1218 * LARGE_BLOCKNUM if necessary
1219 **********************************************************************/
1220 static void FTL_Invert_Block_Table(void)
1221 {
1222 u32 i;
1223 u32 *pbt = (u32 *)g_pBlockTable;
1224
1225 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1226 __FILE__, __LINE__, __func__);
1227
1228 #ifdef SUPPORT_LARGE_BLOCKNUM
1229 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
1230 pbt[i] = INVERTUINT32(pbt[i]);
1231 g_pWearCounter[i] = INVERTUINT32(g_pWearCounter[i]);
1232 }
1233 #else
1234 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
1235 pbt[i] = INVERTUINT16(pbt[i]);
1236 g_pWearCounter[i] = INVERTUINT16(g_pWearCounter[i]);
1237 }
1238 #endif
1239 }
1240 #endif
1241
1242 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1243 * Function: GLOB_FTL_Flash_Init
1244 * Inputs: none
1245 * Outputs: PASS=0 / FAIL=0x01 (based on read ID)
1246 * Description: The flash controller is initialized
1247 * The flash device is reset
1248 * Perform a flash READ ID command to confirm that a
1249 * valid device is attached and active.
1250 * The DeviceInfo structure gets filled in
1251 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1252 int GLOB_FTL_Flash_Init(void)
1253 {
1254 int status = FAIL;
1255
1256 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1257 __FILE__, __LINE__, __func__);
1258
1259 g_SBDCmdIndex = 0;
1260
1261 status = GLOB_LLD_Flash_Init();
1262
1263 return status;
1264 }
1265
1266 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1267 * Inputs: none
1268 * Outputs: PASS=0 / FAIL=0x01 (based on read ID)
1269 * Description: The flash controller is released
1270 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1271 int GLOB_FTL_Flash_Release(void)
1272 {
1273 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1274 __FILE__, __LINE__, __func__);
1275
1276 return GLOB_LLD_Flash_Release();
1277 }
1278
1279
1280 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1281 * Function: GLOB_FTL_Cache_Release
1282 * Inputs: none
1283 * Outputs: none
1284 * Description: release all allocated memory in GLOB_FTL_Init
1285 * (allocated in GLOB_FTL_Init)
1286 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1287 void GLOB_FTL_Cache_Release(void)
1288 {
1289 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1290 __FILE__, __LINE__, __func__);
1291
1292 free_memory();
1293 }
1294
1295 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1296 * Function: FTL_Cache_If_Hit
1297 * Inputs: Page Address
1298 * Outputs: Block number/UNHIT BLOCK
1299 * Description: Determines if the addressed page is in cache
1300 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1301 static u16 FTL_Cache_If_Hit(u64 page_addr)
1302 {
1303 u16 item;
1304 u64 addr;
1305 int i;
1306
1307 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1308 __FILE__, __LINE__, __func__);
1309
1310 item = UNHIT_CACHE_ITEM;
1311 for (i = 0; i < CACHE_ITEM_NUM; i++) {
1312 addr = Cache.array[i].address;
1313 if ((page_addr >= addr) &&
1314 (page_addr < (addr + Cache.cache_item_size))) {
1315 item = i;
1316 break;
1317 }
1318 }
1319
1320 return item;
1321 }
1322
1323 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1324 * Function: FTL_Calculate_LRU
1325 * Inputs: None
1326 * Outputs: None
1327 * Description: Calculate the least recently block in a cache and record its
1328 * index in LRU field.
1329 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1330 static void FTL_Calculate_LRU(void)
1331 {
1332 u16 i, bCurrentLRU, bTempCount;
1333
1334 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1335 __FILE__, __LINE__, __func__);
1336
1337 bCurrentLRU = 0;
1338 bTempCount = MAX_WORD_VALUE;
1339
1340 for (i = 0; i < CACHE_ITEM_NUM; i++) {
1341 if (Cache.array[i].use_cnt < bTempCount) {
1342 bCurrentLRU = i;
1343 bTempCount = Cache.array[i].use_cnt;
1344 }
1345 }
1346
1347 Cache.LRU = bCurrentLRU;
1348 }
1349
1350 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1351 * Function: FTL_Cache_Read_Page
1352 * Inputs: pointer to read buffer, logical address and cache item number
1353 * Outputs: None
1354 * Description: Read the page from the cached block addressed by blocknumber
1355 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1356 static void FTL_Cache_Read_Page(u8 *data_buf, u64 logic_addr, u16 cache_item)
1357 {
1358 u8 *start_addr;
1359
1360 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1361 __FILE__, __LINE__, __func__);
1362
1363 start_addr = Cache.array[cache_item].buf;
1364 start_addr += (u32)(((logic_addr - Cache.array[cache_item].address) >>
1365 DeviceInfo.nBitsInPageDataSize) * DeviceInfo.wPageDataSize);
1366
1367 #if CMD_DMA
1368 GLOB_LLD_MemCopy_CMD(data_buf, start_addr,
1369 DeviceInfo.wPageDataSize, 0);
1370 ftl_cmd_cnt++;
1371 #else
1372 memcpy(data_buf, start_addr, DeviceInfo.wPageDataSize);
1373 #endif
1374
1375 if (Cache.array[cache_item].use_cnt < MAX_WORD_VALUE)
1376 Cache.array[cache_item].use_cnt++;
1377 }
1378
1379 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1380 * Function: FTL_Cache_Read_All
1381 * Inputs: pointer to read buffer,block address
1382 * Outputs: PASS=0 / FAIL =1
1383 * Description: It reads pages in cache
1384 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1385 static int FTL_Cache_Read_All(u8 *pData, u64 phy_addr)
1386 {
1387 int wResult = PASS;
1388 u32 Block;
1389 u32 lba;
1390 u16 Page;
1391 u16 PageCount;
1392 u32 *pbt = (u32 *)g_pBlockTable;
1393 u32 i;
1394
1395 Block = BLK_FROM_ADDR(phy_addr);
1396 Page = PAGE_FROM_ADDR(phy_addr, Block);
1397 PageCount = Cache.pages_per_item;
1398
1399 nand_dbg_print(NAND_DBG_DEBUG,
1400 "%s, Line %d, Function: %s, Block: 0x%x\n",
1401 __FILE__, __LINE__, __func__, Block);
1402
1403 lba = 0xffffffff;
1404 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
1405 if ((pbt[i] & (~BAD_BLOCK)) == Block) {
1406 lba = i;
1407 if (IS_SPARE_BLOCK(i) || IS_BAD_BLOCK(i) ||
1408 IS_DISCARDED_BLOCK(i)) {
1409 /* Add by yunpeng -2008.12.3 */
1410 #if CMD_DMA
1411 GLOB_LLD_MemCopy_CMD(pData, g_temp_buf,
1412 PageCount * DeviceInfo.wPageDataSize, 0);
1413 ftl_cmd_cnt++;
1414 #else
1415 memset(pData, 0xFF,
1416 PageCount * DeviceInfo.wPageDataSize);
1417 #endif
1418 return wResult;
1419 } else {
1420 continue; /* break ?? */
1421 }
1422 }
1423 }
1424
1425 if (0xffffffff == lba)
1426 printk(KERN_ERR "FTL_Cache_Read_All: Block is not found in BT\n");
1427
1428 #if CMD_DMA
1429 wResult = GLOB_LLD_Read_Page_Main_cdma(pData, Block, Page,
1430 PageCount, LLD_CMD_FLAG_MODE_CDMA);
1431 if (DeviceInfo.MLCDevice) {
1432 g_pReadCounter[Block - DeviceInfo.wSpectraStartBlock]++;
1433 nand_dbg_print(NAND_DBG_DEBUG,
1434 "Read Counter modified in ftl_cmd_cnt %u"
1435 " Block %u Counter%u\n",
1436 ftl_cmd_cnt, (unsigned int)Block,
1437 g_pReadCounter[Block -
1438 DeviceInfo.wSpectraStartBlock]);
1439
1440 p_BTableChangesDelta =
1441 (struct BTableChangesDelta *)g_pBTDelta_Free;
1442 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
1443 p_BTableChangesDelta->ftl_cmd_cnt = ftl_cmd_cnt;
1444 p_BTableChangesDelta->RC_Index =
1445 Block - DeviceInfo.wSpectraStartBlock;
1446 p_BTableChangesDelta->RC_Entry_Value =
1447 g_pReadCounter[Block - DeviceInfo.wSpectraStartBlock];
1448 p_BTableChangesDelta->ValidFields = 0xC0;
1449
1450 ftl_cmd_cnt++;
1451
1452 if (g_pReadCounter[Block - DeviceInfo.wSpectraStartBlock] >=
1453 MAX_READ_COUNTER)
1454 FTL_Read_Disturbance(Block);
1455 if (g_cBlockTableStatus != IN_PROGRESS_BLOCK_TABLE) {
1456 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
1457 FTL_Write_IN_Progress_Block_Table_Page();
1458 }
1459 } else {
1460 ftl_cmd_cnt++;
1461 }
1462 #else
1463 wResult = GLOB_LLD_Read_Page_Main(pData, Block, Page, PageCount);
1464 if (wResult == FAIL)
1465 return wResult;
1466
1467 if (DeviceInfo.MLCDevice) {
1468 g_pReadCounter[Block - DeviceInfo.wSpectraStartBlock]++;
1469 if (g_pReadCounter[Block - DeviceInfo.wSpectraStartBlock] >=
1470 MAX_READ_COUNTER)
1471 FTL_Read_Disturbance(Block);
1472 if (g_cBlockTableStatus != IN_PROGRESS_BLOCK_TABLE) {
1473 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
1474 FTL_Write_IN_Progress_Block_Table_Page();
1475 }
1476 }
1477 #endif
1478 return wResult;
1479 }
1480
1481 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1482 * Function: FTL_Cache_Write_All
1483 * Inputs: pointer to cache in sys memory
1484 * address of free block in flash
1485 * Outputs: PASS=0 / FAIL=1
1486 * Description: writes all the pages of the block in cache to flash
1487 *
1488 * NOTE:need to make sure this works ok when cache is limited
1489 * to a partial block. This is where copy-back would be
1490 * activated. This would require knowing which pages in the
1491 * cached block are clean/dirty.Right now we only know if
1492 * the whole block is clean/dirty.
1493 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1494 static int FTL_Cache_Write_All(u8 *pData, u64 blk_addr)
1495 {
1496 u16 wResult = PASS;
1497 u32 Block;
1498 u16 Page;
1499 u16 PageCount;
1500
1501 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1502 __FILE__, __LINE__, __func__);
1503
1504 nand_dbg_print(NAND_DBG_DEBUG, "This block %d going to be written "
1505 "on %d\n", cache_block_to_write,
1506 (u32)(blk_addr >> DeviceInfo.nBitsInBlockDataSize));
1507
1508 Block = BLK_FROM_ADDR(blk_addr);
1509 Page = PAGE_FROM_ADDR(blk_addr, Block);
1510 PageCount = Cache.pages_per_item;
1511
1512 #if CMD_DMA
1513 if (FAIL == GLOB_LLD_Write_Page_Main_cdma(pData,
1514 Block, Page, PageCount)) {
1515 nand_dbg_print(NAND_DBG_WARN,
1516 "NAND Program fail in %s, Line %d, "
1517 "Function: %s, new Bad Block %d generated! "
1518 "Need Bad Block replacing.\n",
1519 __FILE__, __LINE__, __func__, Block);
1520 wResult = FAIL;
1521 }
1522 ftl_cmd_cnt++;
1523 #else
1524 if (FAIL == GLOB_LLD_Write_Page_Main(pData, Block, Page, PageCount)) {
1525 nand_dbg_print(NAND_DBG_WARN, "NAND Program fail in %s,"
1526 " Line %d, Function %s, new Bad Block %d generated!"
1527 "Need Bad Block replacing.\n",
1528 __FILE__, __LINE__, __func__, Block);
1529 wResult = FAIL;
1530 }
1531 #endif
1532 return wResult;
1533 }
1534
1535 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1536 * Function: FTL_Copy_Block
1537 * Inputs: source block address
1538 * Destination block address
1539 * Outputs: PASS=0 / FAIL=1
1540 * Description: used only for static wear leveling to move the block
1541 * containing static data to new blocks(more worn)
1542 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1543 int FTL_Copy_Block(u64 old_blk_addr, u64 blk_addr)
1544 {
1545 int i, r1, r2, wResult = PASS;
1546
1547 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1548 __FILE__, __LINE__, __func__);
1549
1550 for (i = 0; i < DeviceInfo.wPagesPerBlock; i += Cache.pages_per_item) {
1551 r1 = FTL_Cache_Read_All(g_pTempBuf, old_blk_addr +
1552 i * DeviceInfo.wPageDataSize);
1553 r2 = FTL_Cache_Write_All(g_pTempBuf, blk_addr +
1554 i * DeviceInfo.wPageDataSize);
1555 if ((ERR == r1) || (FAIL == r2)) {
1556 wResult = FAIL;
1557 break;
1558 }
1559 }
1560
1561 return wResult;
1562 }
1563
1564 /* Search the block table to find out the least wear block and then return it */
1565 static u32 find_least_worn_blk_for_l2_cache(void)
1566 {
1567 int i;
1568 u32 *pbt = (u32 *)g_pBlockTable;
1569 u8 least_wear_cnt = MAX_BYTE_VALUE;
1570 u32 least_wear_blk_idx = MAX_U32_VALUE;
1571 u32 phy_idx;
1572
1573 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
1574 if (IS_SPARE_BLOCK(i)) {
1575 phy_idx = (u32)((~BAD_BLOCK) & pbt[i]);
1576 if (phy_idx > DeviceInfo.wSpectraEndBlock)
1577 printk(KERN_ERR "find_least_worn_blk_for_l2_cache: "
1578 "Too big phy block num (%d)\n", phy_idx);
1579 if (g_pWearCounter[phy_idx -DeviceInfo.wSpectraStartBlock] < least_wear_cnt) {
1580 least_wear_cnt = g_pWearCounter[phy_idx - DeviceInfo.wSpectraStartBlock];
1581 least_wear_blk_idx = i;
1582 }
1583 }
1584 }
1585
1586 nand_dbg_print(NAND_DBG_WARN,
1587 "find_least_worn_blk_for_l2_cache: "
1588 "find block %d with least worn counter (%d)\n",
1589 least_wear_blk_idx, least_wear_cnt);
1590
1591 return least_wear_blk_idx;
1592 }
1593
1594
1595
1596 /* Get blocks for Level2 Cache */
1597 static int get_l2_cache_blks(void)
1598 {
1599 int n;
1600 u32 blk;
1601 u32 *pbt = (u32 *)g_pBlockTable;
1602
1603 for (n = 0; n < BLK_NUM_FOR_L2_CACHE; n++) {
1604 blk = find_least_worn_blk_for_l2_cache();
1605 if (blk >= DeviceInfo.wDataBlockNum) {
1606 nand_dbg_print(NAND_DBG_WARN,
1607 "find_least_worn_blk_for_l2_cache: "
1608 "No enough free NAND blocks (n: %d) for L2 Cache!\n", n);
1609 return FAIL;
1610 }
1611 /* Tag the free block as discard in block table */
1612 pbt[blk] = (pbt[blk] & (~BAD_BLOCK)) | DISCARD_BLOCK;
1613 /* Add the free block to the L2 Cache block array */
1614 cache_l2.blk_array[n] = pbt[blk] & (~BAD_BLOCK);
1615 }
1616
1617 return PASS;
1618 }
1619
1620 static int erase_l2_cache_blocks(void)
1621 {
1622 int i, ret = PASS;
1623 u32 pblk, lblk = BAD_BLOCK;
1624 u64 addr;
1625 u32 *pbt = (u32 *)g_pBlockTable;
1626
1627 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d, Function: %s\n",
1628 __FILE__, __LINE__, __func__);
1629
1630 for (i = 0; i < BLK_NUM_FOR_L2_CACHE; i++) {
1631 pblk = cache_l2.blk_array[i];
1632
1633 /* If the L2 cache block is invalid, then just skip it */
1634 if (MAX_U32_VALUE == pblk)
1635 continue;
1636
1637 BUG_ON(pblk > DeviceInfo.wSpectraEndBlock);
1638
1639 addr = (u64)pblk << DeviceInfo.nBitsInBlockDataSize;
1640 if (PASS == GLOB_FTL_Block_Erase(addr)) {
1641 /* Get logical block number of the erased block */
1642 lblk = FTL_Get_Block_Index(pblk);
1643 BUG_ON(BAD_BLOCK == lblk);
1644 /* Tag it as free in the block table */
1645 pbt[lblk] &= (u32)(~DISCARD_BLOCK);
1646 pbt[lblk] |= (u32)(SPARE_BLOCK);
1647 } else {
1648 MARK_BLOCK_AS_BAD(pbt[lblk]);
1649 ret = ERR;
1650 }
1651 }
1652
1653 return ret;
1654 }
1655
1656 /*
1657 * Merge the valid data page in the L2 cache blocks into NAND.
1658 */
1659 static int flush_l2_cache(void)
1660 {
1661 struct list_head *p;
1662 struct spectra_l2_cache_list *pnd, *tmp_pnd;
1663 u32 *pbt = (u32 *)g_pBlockTable;
1664 u32 phy_blk, l2_blk;
1665 u64 addr;
1666 u16 l2_page;
1667 int i, ret = PASS;
1668
1669 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d, Function: %s\n",
1670 __FILE__, __LINE__, __func__);
1671
1672 if (list_empty(&cache_l2.table.list)) /* No data to flush */
1673 return ret;
1674
1675 //dump_cache_l2_table();
1676
1677 if (IN_PROGRESS_BLOCK_TABLE != g_cBlockTableStatus) {
1678 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
1679 FTL_Write_IN_Progress_Block_Table_Page();
1680 }
1681
1682 list_for_each(p, &cache_l2.table.list) {
1683 pnd = list_entry(p, struct spectra_l2_cache_list, list);
1684 if (IS_SPARE_BLOCK(pnd->logical_blk_num) ||
1685 IS_BAD_BLOCK(pnd->logical_blk_num) ||
1686 IS_DISCARDED_BLOCK(pnd->logical_blk_num)) {
1687 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d\n", __FILE__, __LINE__);
1688 memset(cache_l2_blk_buf, 0xff, DeviceInfo.wPagesPerBlock * DeviceInfo.wPageDataSize);
1689 } else {
1690 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d\n", __FILE__, __LINE__);
1691 phy_blk = pbt[pnd->logical_blk_num] & (~BAD_BLOCK);
1692 ret = GLOB_LLD_Read_Page_Main(cache_l2_blk_buf,
1693 phy_blk, 0, DeviceInfo.wPagesPerBlock);
1694 if (ret == FAIL) {
1695 printk(KERN_ERR "Read NAND page fail in %s, Line %d\n", __FILE__, __LINE__);
1696 }
1697 }
1698
1699 for (i = 0; i < DeviceInfo.wPagesPerBlock; i++) {
1700 if (pnd->pages_array[i] != MAX_U32_VALUE) {
1701 l2_blk = cache_l2.blk_array[(pnd->pages_array[i] >> 16) & 0xffff];
1702 l2_page = pnd->pages_array[i] & 0xffff;
1703 ret = GLOB_LLD_Read_Page_Main(cache_l2_page_buf, l2_blk, l2_page, 1);
1704 if (ret == FAIL) {
1705 printk(KERN_ERR "Read NAND page fail in %s, Line %d\n", __FILE__, __LINE__);
1706 }
1707 memcpy(cache_l2_blk_buf + i * DeviceInfo.wPageDataSize, cache_l2_page_buf, DeviceInfo.wPageDataSize);
1708 }
1709 }
1710
1711 /* Find a free block and tag the original block as discarded */
1712 addr = (u64)pnd->logical_blk_num << DeviceInfo.nBitsInBlockDataSize;
1713 ret = FTL_Replace_Block(addr);
1714 if (ret == FAIL) {
1715 printk(KERN_ERR "FTL_Replace_Block fail in %s, Line %d\n", __FILE__, __LINE__);
1716 }
1717
1718 /* Write back the updated data into NAND */
1719 phy_blk = pbt[pnd->logical_blk_num] & (~BAD_BLOCK);
1720 if (FAIL == GLOB_LLD_Write_Page_Main(cache_l2_blk_buf, phy_blk, 0, DeviceInfo.wPagesPerBlock)) {
1721 nand_dbg_print(NAND_DBG_WARN,
1722 "Program NAND block %d fail in %s, Line %d\n",
1723 phy_blk, __FILE__, __LINE__);
1724 /* This may not be really a bad block. So just tag it as discarded. */
1725 /* Then it has a chance to be erased when garbage collection. */
1726 /* If it is really bad, then the erase will fail and it will be marked */
1727 /* as bad then. Otherwise it will be marked as free and can be used again */
1728 MARK_BLK_AS_DISCARD(pbt[pnd->logical_blk_num]);
1729 /* Find another free block and write it again */
1730 FTL_Replace_Block(addr);
1731 phy_blk = pbt[pnd->logical_blk_num] & (~BAD_BLOCK);
1732 if (FAIL == GLOB_LLD_Write_Page_Main(cache_l2_blk_buf, phy_blk, 0, DeviceInfo.wPagesPerBlock)) {
1733 printk(KERN_ERR "Failed to write back block %d when flush L2 cache."
1734 "Some data will be lost!\n", phy_blk);
1735 MARK_BLOCK_AS_BAD(pbt[pnd->logical_blk_num]);
1736 }
1737 } else {
1738 /* tag the new free block as used block */
1739 pbt[pnd->logical_blk_num] &= (~SPARE_BLOCK);
1740 }
1741 }
1742
1743 /* Destroy the L2 Cache table and free the memory of all nodes */
1744 list_for_each_entry_safe(pnd, tmp_pnd, &cache_l2.table.list, list) {
1745 list_del(&pnd->list);
1746 kfree(pnd);
1747 }
1748
1749 /* Erase discard L2 cache blocks */
1750 if (erase_l2_cache_blocks() != PASS)
1751 nand_dbg_print(NAND_DBG_WARN,
1752 " Erase L2 cache blocks error in %s, Line %d\n",
1753 __FILE__, __LINE__);
1754
1755 /* Init the Level2 Cache data structure */
1756 for (i = 0; i < BLK_NUM_FOR_L2_CACHE; i++)
1757 cache_l2.blk_array[i] = MAX_U32_VALUE;
1758 cache_l2.cur_blk_idx = 0;
1759 cache_l2.cur_page_num = 0;
1760 INIT_LIST_HEAD(&cache_l2.table.list);
1761 cache_l2.table.logical_blk_num = MAX_U32_VALUE;
1762
1763 return ret;
1764 }
1765
1766 /*
1767 * Write back a changed victim cache item to the Level2 Cache
1768 * and update the L2 Cache table to map the change.
1769 * If the L2 Cache is full, then start to do the L2 Cache flush.
1770 */
1771 static int write_back_to_l2_cache(u8 *buf, u64 logical_addr)
1772 {
1773 u32 logical_blk_num;
1774 u16 logical_page_num;
1775 struct list_head *p;
1776 struct spectra_l2_cache_list *pnd, *pnd_new;
1777 u32 node_size;
1778 int i, found;
1779
1780 nand_dbg_print(NAND_DBG_DEBUG, "%s, Line %d, Function: %s\n",
1781 __FILE__, __LINE__, __func__);
1782
1783 /*
1784 * If Level2 Cache table is empty, then it means either:
1785 * 1. This is the first time that the function called after FTL_init
1786 * or
1787 * 2. The Level2 Cache has just been flushed
1788 *
1789 * So, 'steal' some free blocks from NAND for L2 Cache using
1790 * by just mask them as discard in the block table
1791 */
1792 if (list_empty(&cache_l2.table.list)) {
1793 BUG_ON(cache_l2.cur_blk_idx != 0);
1794 BUG_ON(cache_l2.cur_page_num!= 0);
1795 BUG_ON(cache_l2.table.logical_blk_num != MAX_U32_VALUE);
1796 if (FAIL == get_l2_cache_blks()) {
1797 GLOB_FTL_Garbage_Collection();
1798 if (FAIL == get_l2_cache_blks()) {
1799 printk(KERN_ALERT "Fail to get L2 cache blks!\n");
1800 return FAIL;
1801 }
1802 }
1803 }
1804
1805 logical_blk_num = BLK_FROM_ADDR(logical_addr);
1806 logical_page_num = PAGE_FROM_ADDR(logical_addr, logical_blk_num);
1807 BUG_ON(logical_blk_num == MAX_U32_VALUE);
1808
1809 /* Write the cache item data into the current position of L2 Cache */
1810 #if CMD_DMA
1811 /*
1812 * TODO
1813 */
1814 #else
1815 if (FAIL == GLOB_LLD_Write_Page_Main(buf,
1816 cache_l2.blk_array[cache_l2.cur_blk_idx],
1817 cache_l2.cur_page_num, 1)) {
1818 nand_dbg_print(NAND_DBG_WARN, "NAND Program fail in "
1819 "%s, Line %d, new Bad Block %d generated!\n",
1820 __FILE__, __LINE__,
1821 cache_l2.blk_array[cache_l2.cur_blk_idx]);
1822
1823 /* TODO: tag the current block as bad and try again */
1824
1825 return FAIL;
1826 }
1827 #endif
1828
1829 /*
1830 * Update the L2 Cache table.
1831 *
1832 * First seaching in the table to see whether the logical block
1833 * has been mapped. If not, then kmalloc a new node for the
1834 * logical block, fill data, and then insert it to the list.
1835 * Otherwise, just update the mapped node directly.
1836 */
1837 found = 0;
1838 list_for_each(p, &cache_l2.table.list) {
1839 pnd = list_entry(p, struct spectra_l2_cache_list, list);
1840 if (pnd->logical_blk_num == logical_blk_num) {
1841 pnd->pages_array[logical_page_num] =
1842 (cache_l2.cur_blk_idx << 16) |
1843 cache_l2.cur_page_num;
1844 found = 1;
1845 break;
1846 }
1847 }
1848 if (!found) { /* Create new node for the logical block here */
1849
1850 /* The logical pages to physical pages map array is
1851 * located at the end of struct spectra_l2_cache_list.
1852 */
1853 node_size = sizeof(struct spectra_l2_cache_list) +
1854 sizeof(u32) * DeviceInfo.wPagesPerBlock;
1855 pnd_new = kmalloc(node_size, GFP_ATOMIC);
1856 if (!pnd_new) {
1857 printk(KERN_ERR "Failed to kmalloc in %s Line %d\n",
1858 __FILE__, __LINE__);
1859 /*
1860 * TODO: Need to flush all the L2 cache into NAND ASAP
1861 * since no memory available here
1862 */
1863 }
1864 pnd_new->logical_blk_num = logical_blk_num;
1865 for (i = 0; i < DeviceInfo.wPagesPerBlock; i++)
1866 pnd_new->pages_array[i] = MAX_U32_VALUE;
1867 pnd_new->pages_array[logical_page_num] =
1868 (cache_l2.cur_blk_idx << 16) | cache_l2.cur_page_num;
1869 list_add(&pnd_new->list, &cache_l2.table.list);
1870 }
1871
1872 /* Increasing the current position pointer of the L2 Cache */
1873 cache_l2.cur_page_num++;
1874 if (cache_l2.cur_page_num >= DeviceInfo.wPagesPerBlock) {
1875 cache_l2.cur_blk_idx++;
1876 if (cache_l2.cur_blk_idx >= BLK_NUM_FOR_L2_CACHE) {
1877 /* The L2 Cache is full. Need to flush it now */
1878 nand_dbg_print(NAND_DBG_WARN,
1879 "L2 Cache is full, will start to flush it\n");
1880 flush_l2_cache();
1881 } else {
1882 cache_l2.cur_page_num = 0;
1883 }
1884 }
1885
1886 return PASS;
1887 }
1888
1889 /*
1890 * Seach in the Level2 Cache table to find the cache item.
1891 * If find, read the data from the NAND page of L2 Cache,
1892 * Otherwise, return FAIL.
1893 */
1894 static int search_l2_cache(u8 *buf, u64 logical_addr)
1895 {
1896 u32 logical_blk_num;
1897 u16 logical_page_num;
1898 struct list_head *p;
1899 struct spectra_l2_cache_list *pnd;
1900 u32 tmp = MAX_U32_VALUE;
1901 u32 phy_blk;
1902 u16 phy_page;
1903 int ret = FAIL;
1904
1905 logical_blk_num = BLK_FROM_ADDR(logical_addr);
1906 logical_page_num = PAGE_FROM_ADDR(logical_addr, logical_blk_num);
1907
1908 list_for_each(p, &cache_l2.table.list) {
1909 pnd = list_entry(p, struct spectra_l2_cache_list, list);
1910 if (pnd->logical_blk_num == logical_blk_num) {
1911 tmp = pnd->pages_array[logical_page_num];
1912 break;
1913 }
1914 }
1915
1916 if (tmp != MAX_U32_VALUE) { /* Found valid map */
1917 phy_blk = cache_l2.blk_array[(tmp >> 16) & 0xFFFF];
1918 phy_page = tmp & 0xFFFF;
1919 #if CMD_DMA
1920 /* TODO */
1921 #else
1922 ret = GLOB_LLD_Read_Page_Main(buf, phy_blk, phy_page, 1);
1923 #endif
1924 }
1925
1926 return ret;
1927 }
1928
1929 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1930 * Function: FTL_Cache_Write_Page
1931 * Inputs: Pointer to buffer, page address, cache block number
1932 * Outputs: PASS=0 / FAIL=1
1933 * Description: It writes the data in Cache Block
1934 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1935 static void FTL_Cache_Write_Page(u8 *pData, u64 page_addr,
1936 u8 cache_blk, u16 flag)
1937 {
1938 u8 *pDest;
1939 u64 addr;
1940
1941 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1942 __FILE__, __LINE__, __func__);
1943
1944 addr = Cache.array[cache_blk].address;
1945 pDest = Cache.array[cache_blk].buf;
1946
1947 pDest += (unsigned long)(page_addr - addr);
1948 Cache.array[cache_blk].changed = SET;
1949 #if CMD_DMA
1950 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
1951 int_cache[ftl_cmd_cnt].item = cache_blk;
1952 int_cache[ftl_cmd_cnt].cache.address =
1953 Cache.array[cache_blk].address;
1954 int_cache[ftl_cmd_cnt].cache.changed =
1955 Cache.array[cache_blk].changed;
1956 #endif
1957 GLOB_LLD_MemCopy_CMD(pDest, pData, DeviceInfo.wPageDataSize, flag);
1958 ftl_cmd_cnt++;
1959 #else
1960 memcpy(pDest, pData, DeviceInfo.wPageDataSize);
1961 #endif
1962 if (Cache.array[cache_blk].use_cnt < MAX_WORD_VALUE)
1963 Cache.array[cache_blk].use_cnt++;
1964 }
1965
1966 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
1967 * Function: FTL_Cache_Write
1968 * Inputs: none
1969 * Outputs: PASS=0 / FAIL=1
1970 * Description: It writes least frequently used Cache block to flash if it
1971 * has been changed
1972 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
1973 static int FTL_Cache_Write(void)
1974 {
1975 int i, bResult = PASS;
1976 u16 bNO, least_count = 0xFFFF;
1977
1978 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
1979 __FILE__, __LINE__, __func__);
1980
1981 FTL_Calculate_LRU();
1982
1983 bNO = Cache.LRU;
1984 nand_dbg_print(NAND_DBG_DEBUG, "FTL_Cache_Write: "
1985 "Least used cache block is %d\n", bNO);
1986
1987 if (Cache.array[bNO].changed != SET)
1988 return bResult;
1989
1990 nand_dbg_print(NAND_DBG_DEBUG, "FTL_Cache_Write: Cache"
1991 " Block %d containing logical block %d is dirty\n",
1992 bNO,
1993 (u32)(Cache.array[bNO].address >>
1994 DeviceInfo.nBitsInBlockDataSize));
1995 #if CMD_DMA
1996 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
1997 int_cache[ftl_cmd_cnt].item = bNO;
1998 int_cache[ftl_cmd_cnt].cache.address =
1999 Cache.array[bNO].address;
2000 int_cache[ftl_cmd_cnt].cache.changed = CLEAR;
2001 #endif
2002 #endif
2003 bResult = write_back_to_l2_cache(Cache.array[bNO].buf,
2004 Cache.array[bNO].address);
2005 if (bResult != ERR)
2006 Cache.array[bNO].changed = CLEAR;
2007
2008 least_count = Cache.array[bNO].use_cnt;
2009
2010 for (i = 0; i < CACHE_ITEM_NUM; i++) {
2011 if (i == bNO)
2012 continue;
2013 if (Cache.array[i].use_cnt > 0)
2014 Cache.array[i].use_cnt -= least_count;
2015 }
2016
2017 return bResult;
2018 }
2019
2020 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2021 * Function: FTL_Cache_Read
2022 * Inputs: Page address
2023 * Outputs: PASS=0 / FAIL=1
2024 * Description: It reads the block from device in Cache Block
2025 * Set the LRU count to 1
2026 * Mark the Cache Block as clean
2027 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2028 static int FTL_Cache_Read(u64 logical_addr)
2029 {
2030 u64 item_addr, phy_addr;
2031 u16 num;
2032 int ret;
2033
2034 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
2035 __FILE__, __LINE__, __func__);
2036
2037 num = Cache.LRU; /* The LRU cache item will be overwritten */
2038
2039 item_addr = (u64)GLOB_u64_Div(logical_addr, Cache.cache_item_size) *
2040 Cache.cache_item_size;
2041 Cache.array[num].address = item_addr;
2042 Cache.array[num].use_cnt = 1;
2043 Cache.array[num].changed = CLEAR;
2044
2045 #if CMD_DMA
2046 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
2047 int_cache[ftl_cmd_cnt].item = num;
2048 int_cache[ftl_cmd_cnt].cache.address =
2049 Cache.array[num].address;
2050 int_cache[ftl_cmd_cnt].cache.changed =
2051 Cache.array[num].changed;
2052 #endif
2053 #endif
2054 /*
2055 * Search in L2 Cache. If hit, fill data into L1 Cache item buffer,
2056 * Otherwise, read it from NAND
2057 */
2058 ret = search_l2_cache(Cache.array[num].buf, logical_addr);
2059 if (PASS == ret) /* Hit in L2 Cache */
2060 return ret;
2061
2062 /* Compute the physical start address of NAND device according to */
2063 /* the logical start address of the cache item (LRU cache item) */
2064 phy_addr = FTL_Get_Physical_Block_Addr(item_addr) +
2065 GLOB_u64_Remainder(item_addr, 2);
2066
2067 return FTL_Cache_Read_All(Cache.array[num].buf, phy_addr);
2068 }
2069
2070 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2071 * Function: FTL_Check_Block_Table
2072 * Inputs: ?
2073 * Outputs: PASS=0 / FAIL=1
2074 * Description: It checks the correctness of each block table entry
2075 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2076 static int FTL_Check_Block_Table(int wOldTable)
2077 {
2078 u32 i;
2079 int wResult = PASS;
2080 u32 blk_idx;
2081 u32 *pbt = (u32 *)g_pBlockTable;
2082 u8 *pFlag = flag_check_blk_table;
2083
2084 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
2085 __FILE__, __LINE__, __func__);
2086
2087 if (NULL != pFlag) {
2088 memset(pFlag, FAIL, DeviceInfo.wDataBlockNum);
2089 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
2090 blk_idx = (u32)(pbt[i] & (~BAD_BLOCK));
2091
2092 /*
2093 * 20081006/KBV - Changed to pFlag[i] reference
2094 * to avoid buffer overflow
2095 */
2096
2097 /*
2098 * 2008-10-20 Yunpeng Note: This change avoid
2099 * buffer overflow, but changed function of
2100 * the code, so it should be re-write later
2101 */
2102 if ((blk_idx > DeviceInfo.wSpectraEndBlock) ||
2103 PASS == pFlag[i]) {
2104 wResult = FAIL;
2105 break;
2106 } else {
2107 pFlag[i] = PASS;
2108 }
2109 }
2110 }
2111
2112 return wResult;
2113 }
2114
2115
2116 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2117 * Function: FTL_Write_Block_Table
2118 * Inputs: flasg
2119 * Outputs: 0=Block Table was updated. No write done. 1=Block write needs to
2120 * happen. -1 Error
2121 * Description: It writes the block table
2122 * Block table always mapped to LBA 0 which inturn mapped
2123 * to any physical block
2124 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2125 static int FTL_Write_Block_Table(int wForce)
2126 {
2127 u32 *pbt = (u32 *)g_pBlockTable;
2128 int wSuccess = PASS;
2129 u32 wTempBlockTableIndex;
2130 u16 bt_pages, new_bt_offset;
2131 u8 blockchangeoccured = 0;
2132
2133 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
2134 __FILE__, __LINE__, __func__);
2135
2136 bt_pages = FTL_Get_Block_Table_Flash_Size_Pages();
2137
2138 if (IN_PROGRESS_BLOCK_TABLE != g_cBlockTableStatus)
2139 return 0;
2140
2141 if (PASS == wForce) {
2142 g_wBlockTableOffset =
2143 (u16)(DeviceInfo.wPagesPerBlock - bt_pages);
2144 #if CMD_DMA
2145 p_BTableChangesDelta =
2146 (struct BTableChangesDelta *)g_pBTDelta_Free;
2147 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
2148
2149 p_BTableChangesDelta->ftl_cmd_cnt = ftl_cmd_cnt;
2150 p_BTableChangesDelta->g_wBlockTableOffset =
2151 g_wBlockTableOffset;
2152 p_BTableChangesDelta->ValidFields = 0x01;
2153 #endif
2154 }
2155
2156 nand_dbg_print(NAND_DBG_DEBUG,
2157 "Inside FTL_Write_Block_Table: block %d Page:%d\n",
2158 g_wBlockTableIndex, g_wBlockTableOffset);
2159
2160 do {
2161 new_bt_offset = g_wBlockTableOffset + bt_pages + 1;
2162 if ((0 == (new_bt_offset % DeviceInfo.wPagesPerBlock)) ||
2163 (new_bt_offset > DeviceInfo.wPagesPerBlock) ||
2164 (FAIL == wSuccess)) {
2165 wTempBlockTableIndex = FTL_Replace_Block_Table();
2166 if (BAD_BLOCK == wTempBlockTableIndex)
2167 return ERR;
2168 if (!blockchangeoccured) {
2169 bt_block_changed = 1;
2170 blockchangeoccured = 1;
2171 }
2172
2173 g_wBlockTableIndex = wTempBlockTableIndex;
2174 g_wBlockTableOffset = 0;
2175 pbt[BLOCK_TABLE_INDEX] = g_wBlockTableIndex;
2176 #if CMD_DMA
2177 p_BTableChangesDelta =
2178 (struct BTableChangesDelta *)g_pBTDelta_Free;
2179 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
2180
2181 p_BTableChangesDelta->ftl_cmd_cnt =
2182 ftl_cmd_cnt;
2183 p_BTableChangesDelta->g_wBlockTableOffset =
2184 g_wBlockTableOffset;
2185 p_BTableChangesDelta->g_wBlockTableIndex =
2186 g_wBlockTableIndex;
2187 p_BTableChangesDelta->ValidFields = 0x03;
2188
2189 p_BTableChangesDelta =
2190 (struct BTableChangesDelta *)g_pBTDelta_Free;
2191 g_pBTDelta_Free +=
2192 sizeof(struct BTableChangesDelta);
2193
2194 p_BTableChangesDelta->ftl_cmd_cnt =
2195 ftl_cmd_cnt;
2196 p_BTableChangesDelta->BT_Index =
2197 BLOCK_TABLE_INDEX;
2198 p_BTableChangesDelta->BT_Entry_Value =
2199 pbt[BLOCK_TABLE_INDEX];
2200 p_BTableChangesDelta->ValidFields = 0x0C;
2201 #endif
2202 }
2203
2204 wSuccess = FTL_Write_Block_Table_Data();
2205 if (FAIL == wSuccess)
2206 MARK_BLOCK_AS_BAD(pbt[BLOCK_TABLE_INDEX]);
2207 } while (FAIL == wSuccess);
2208
2209 g_cBlockTableStatus = CURRENT_BLOCK_TABLE;
2210
2211 return 1;
2212 }
2213
2214 static int force_format_nand(void)
2215 {
2216 u32 i;
2217
2218 /* Force erase the whole unprotected physical partiton of NAND */
2219 printk(KERN_ALERT "Start to force erase whole NAND device ...\n");
2220 printk(KERN_ALERT "From phyical block %d to %d\n",
2221 DeviceInfo.wSpectraStartBlock, DeviceInfo.wSpectraEndBlock);
2222 for (i = DeviceInfo.wSpectraStartBlock; i <= DeviceInfo.wSpectraEndBlock; i++) {
2223 if (GLOB_LLD_Erase_Block(i))
2224 printk(KERN_ERR "Failed to force erase NAND block %d\n", i);
2225 }
2226 printk(KERN_ALERT "Force Erase ends. Please reboot the system ...\n");
2227 while(1);
2228
2229 return PASS;
2230 }
2231
2232 int GLOB_FTL_Flash_Format(void)
2233 {
2234 //return FTL_Format_Flash(1);
2235 return force_format_nand();
2236
2237 }
2238
2239 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2240 * Function: FTL_Search_Block_Table_IN_Block
2241 * Inputs: Block Number
2242 * Pointer to page
2243 * Outputs: PASS / FAIL
2244 * Page contatining the block table
2245 * Description: It searches the block table in the block
2246 * passed as an argument.
2247 *
2248 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2249 static int FTL_Search_Block_Table_IN_Block(u32 BT_Block,
2250 u8 BT_Tag, u16 *Page)
2251 {
2252 u16 i, j, k;
2253 u16 Result = PASS;
2254 u16 Last_IPF = 0;
2255 u8 BT_Found = 0;
2256 u8 *tagarray;
2257 u8 *tempbuf = tmp_buf_search_bt_in_block;
2258 u8 *pSpareBuf = spare_buf_search_bt_in_block;
2259 u8 *pSpareBufBTLastPage = spare_buf_bt_search_bt_in_block;
2260 u8 bt_flag_last_page = 0xFF;
2261 u8 search_in_previous_pages = 0;
2262 u16 bt_pages;
2263
2264 nand_dbg_print(NAND_DBG_DEBUG, "%s, Line %d, Function: %s\n",
2265 __FILE__, __LINE__, __func__);
2266
2267 nand_dbg_print(NAND_DBG_DEBUG,
2268 "Searching block table in %u block\n",
2269 (unsigned int)BT_Block);
2270
2271 bt_pages = FTL_Get_Block_Table_Flash_Size_Pages();
2272
2273 for (i = bt_pages; i < DeviceInfo.wPagesPerBlock;
2274 i += (bt_pages + 1)) {
2275 nand_dbg_print(NAND_DBG_DEBUG,
2276 "Searching last IPF: %d\n", i);
2277 Result = GLOB_LLD_Read_Page_Main_Polling(tempbuf,
2278 BT_Block, i, 1);
2279
2280 if (0 == memcmp(tempbuf, g_pIPF, DeviceInfo.wPageDataSize)) {
2281 if ((i + bt_pages + 1) < DeviceInfo.wPagesPerBlock) {
2282 continue;
2283 } else {
2284 search_in_previous_pages = 1;
2285 Last_IPF = i;
2286 }
2287 }
2288
2289 if (!search_in_previous_pages) {
2290 if (i != bt_pages) {
2291 i -= (bt_pages + 1);
2292 Last_IPF = i;
2293 }
2294 }
2295
2296 if (0 == Last_IPF)
2297 break;
2298
2299 if (!search_in_previous_pages) {
2300 i = i + 1;
2301 nand_dbg_print(NAND_DBG_DEBUG,
2302 "Reading the spare area of Block %u Page %u",
2303 (unsigned int)BT_Block, i);
2304 Result = GLOB_LLD_Read_Page_Spare(pSpareBuf,
2305 BT_Block, i, 1);
2306 nand_dbg_print(NAND_DBG_DEBUG,
2307 "Reading the spare area of Block %u Page %u",
2308 (unsigned int)BT_Block, i + bt_pages - 1);
2309 Result = GLOB_LLD_Read_Page_Spare(pSpareBufBTLastPage,
2310 BT_Block, i + bt_pages - 1, 1);
2311
2312 k = 0;
2313 j = FTL_Extract_Block_Table_Tag(pSpareBuf, &tagarray);
2314 if (j) {
2315 for (; k < j; k++) {
2316 if (tagarray[k] == BT_Tag)
2317 break;
2318 }
2319 }
2320
2321 if (k < j)
2322 bt_flag = tagarray[k];
2323 else
2324 Result = FAIL;
2325
2326 if (Result == PASS) {
2327 k = 0;
2328 j = FTL_Extract_Block_Table_Tag(
2329 pSpareBufBTLastPage, &tagarray);
2330 if (j) {
2331 for (; k < j; k++) {
2332 if (tagarray[k] == BT_Tag)
2333 break;
2334 }
2335 }
2336
2337 if (k < j)
2338 bt_flag_last_page = tagarray[k];
2339 else
2340 Result = FAIL;
2341
2342 if (Result == PASS) {
2343 if (bt_flag == bt_flag_last_page) {
2344 nand_dbg_print(NAND_DBG_DEBUG,
2345 "Block table is found"
2346 " in page after IPF "
2347 "at block %d "
2348 "page %d\n",
2349 (int)BT_Block, i);
2350 BT_Found = 1;
2351 *Page = i;
2352 g_cBlockTableStatus =
2353 CURRENT_BLOCK_TABLE;
2354 break;
2355 } else {
2356 Result = FAIL;
2357 }
2358 }
2359 }
2360 }
2361
2362 if (search_in_previous_pages)
2363 i = i - bt_pages;
2364 else
2365 i = i - (bt_pages + 1);
2366
2367 Result = PASS;
2368
2369 nand_dbg_print(NAND_DBG_DEBUG,
2370 "Reading the spare area of Block %d Page %d",
2371 (int)BT_Block, i);
2372
2373 Result = GLOB_LLD_Read_Page_Spare(pSpareBuf, BT_Block, i, 1);
2374 nand_dbg_print(NAND_DBG_DEBUG,
2375 "Reading the spare area of Block %u Page %u",
2376 (unsigned int)BT_Block, i + bt_pages - 1);
2377
2378 Result = GLOB_LLD_Read_Page_Spare(pSpareBufBTLastPage,
2379 BT_Block, i + bt_pages - 1, 1);
2380
2381 k = 0;
2382 j = FTL_Extract_Block_Table_Tag(pSpareBuf, &tagarray);
2383 if (j) {
2384 for (; k < j; k++) {
2385 if (tagarray[k] == BT_Tag)
2386 break;
2387 }
2388 }
2389
2390 if (k < j)
2391 bt_flag = tagarray[k];
2392 else
2393 Result = FAIL;
2394
2395 if (Result == PASS) {
2396 k = 0;
2397 j = FTL_Extract_Block_Table_Tag(pSpareBufBTLastPage,
2398 &tagarray);
2399 if (j) {
2400 for (; k < j; k++) {
2401 if (tagarray[k] == BT_Tag)
2402 break;
2403 }
2404 }
2405
2406 if (k < j) {
2407 bt_flag_last_page = tagarray[k];
2408 } else {
2409 Result = FAIL;
2410 break;
2411 }
2412
2413 if (Result == PASS) {
2414 if (bt_flag == bt_flag_last_page) {
2415 nand_dbg_print(NAND_DBG_DEBUG,
2416 "Block table is found "
2417 "in page prior to IPF "
2418 "at block %u page %d\n",
2419 (unsigned int)BT_Block, i);
2420 BT_Found = 1;
2421 *Page = i;
2422 g_cBlockTableStatus =
2423 IN_PROGRESS_BLOCK_TABLE;
2424 break;
2425 } else {
2426 Result = FAIL;
2427 break;
2428 }
2429 }
2430 }
2431 }
2432
2433 if (Result == FAIL) {
2434 if ((Last_IPF > bt_pages) && (i < Last_IPF) && (!BT_Found)) {
2435 BT_Found = 1;
2436 *Page = i - (bt_pages + 1);
2437 }
2438 if ((Last_IPF == bt_pages) && (i < Last_IPF) && (!BT_Found))
2439 goto func_return;
2440 }
2441
2442 if (Last_IPF == 0) {
2443 i = 0;
2444 Result = PASS;
2445 nand_dbg_print(NAND_DBG_DEBUG, "Reading the spare area of "
2446 "Block %u Page %u", (unsigned int)BT_Block, i);
2447
2448 Result = GLOB_LLD_Read_Page_Spare(pSpareBuf, BT_Block, i, 1);
2449 nand_dbg_print(NAND_DBG_DEBUG,
2450 "Reading the spare area of Block %u Page %u",
2451 (unsigned int)BT_Block, i + bt_pages - 1);
2452 Result = GLOB_LLD_Read_Page_Spare(pSpareBufBTLastPage,
2453 BT_Block, i + bt_pages - 1, 1);
2454
2455 k = 0;
2456 j = FTL_Extract_Block_Table_Tag(pSpareBuf, &tagarray);
2457 if (j) {
2458 for (; k < j; k++) {
2459 if (tagarray[k] == BT_Tag)
2460 break;
2461 }
2462 }
2463
2464 if (k < j)
2465 bt_flag = tagarray[k];
2466 else
2467 Result = FAIL;
2468
2469 if (Result == PASS) {
2470 k = 0;
2471 j = FTL_Extract_Block_Table_Tag(pSpareBufBTLastPage,
2472 &tagarray);
2473 if (j) {
2474 for (; k < j; k++) {
2475 if (tagarray[k] == BT_Tag)
2476 break;
2477 }
2478 }
2479
2480 if (k < j)
2481 bt_flag_last_page = tagarray[k];
2482 else
2483 Result = FAIL;
2484
2485 if (Result == PASS) {
2486 if (bt_flag == bt_flag_last_page) {
2487 nand_dbg_print(NAND_DBG_DEBUG,
2488 "Block table is found "
2489 "in page after IPF at "
2490 "block %u page %u\n",
2491 (unsigned int)BT_Block,
2492 (unsigned int)i);
2493 BT_Found = 1;
2494 *Page = i;
2495 g_cBlockTableStatus =
2496 CURRENT_BLOCK_TABLE;
2497 goto func_return;
2498 } else {
2499 Result = FAIL;
2500 }
2501 }
2502 }
2503
2504 if (Result == FAIL)
2505 goto func_return;
2506 }
2507 func_return:
2508 return Result;
2509 }
2510
2511 u8 *get_blk_table_start_addr(void)
2512 {
2513 return g_pBlockTable;
2514 }
2515
2516 unsigned long get_blk_table_len(void)
2517 {
2518 return DeviceInfo.wDataBlockNum * sizeof(u32);
2519 }
2520
2521 u8 *get_wear_leveling_table_start_addr(void)
2522 {
2523 return g_pWearCounter;
2524 }
2525
2526 unsigned long get_wear_leveling_table_len(void)
2527 {
2528 return DeviceInfo.wDataBlockNum * sizeof(u8);
2529 }
2530
2531 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2532 * Function: FTL_Read_Block_Table
2533 * Inputs: none
2534 * Outputs: PASS / FAIL
2535 * Description: read the flash spare area and find a block containing the
2536 * most recent block table(having largest block_table_counter).
2537 * Find the last written Block table in this block.
2538 * Check the correctness of Block Table
2539 * If CDMA is enabled, this function is called in
2540 * polling mode.
2541 * We don't need to store changes in Block table in this
2542 * function as it is called only at initialization
2543 *
2544 * Note: Currently this function is called at initialization
2545 * before any read/erase/write command issued to flash so,
2546 * there is no need to wait for CDMA list to complete as of now
2547 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2548 static int FTL_Read_Block_Table(void)
2549 {
2550 u16 i = 0;
2551 int k, j;
2552 u8 *tempBuf, *tagarray;
2553 int wResult = FAIL;
2554 int status = FAIL;
2555 u8 block_table_found = 0;
2556 int search_result;
2557 u32 Block;
2558 u16 Page = 0;
2559 u16 PageCount;
2560 u16 bt_pages;
2561 int wBytesCopied = 0, tempvar;
2562
2563 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
2564 __FILE__, __LINE__, __func__);
2565
2566 tempBuf = tmp_buf1_read_blk_table;
2567 bt_pages = FTL_Get_Block_Table_Flash_Size_Pages();
2568
2569 for (j = DeviceInfo.wSpectraStartBlock;
2570 j <= (int)DeviceInfo.wSpectraEndBlock;
2571 j++) {
2572 status = GLOB_LLD_Read_Page_Spare(tempBuf, j, 0, 1);
2573 k = 0;
2574 i = FTL_Extract_Block_Table_Tag(tempBuf, &tagarray);
2575 if (i) {
2576 status = GLOB_LLD_Read_Page_Main_Polling(tempBuf,
2577 j, 0, 1);
2578 for (; k < i; k++) {
2579 if (tagarray[k] == tempBuf[3])
2580 break;
2581 }
2582 }
2583
2584 if (k < i)
2585 k = tagarray[k];
2586 else
2587 continue;
2588
2589 nand_dbg_print(NAND_DBG_DEBUG,
2590 "Block table is contained in Block %d %d\n",
2591 (unsigned int)j, (unsigned int)k);
2592
2593 if (g_pBTBlocks[k-FIRST_BT_ID] == BTBLOCK_INVAL) {
2594 g_pBTBlocks[k-FIRST_BT_ID] = j;
2595 block_table_found = 1;
2596 } else {
2597 printk(KERN_ERR "FTL_Read_Block_Table -"
2598 "This should never happens. "
2599 "Two block table have same counter %u!\n", k);
2600 }
2601 }
2602
2603 if (block_table_found) {
2604 if (g_pBTBlocks[FIRST_BT_ID - FIRST_BT_ID] != BTBLOCK_INVAL &&
2605 g_pBTBlocks[LAST_BT_ID - FIRST_BT_ID] != BTBLOCK_INVAL) {
2606 j = LAST_BT_ID;
2607 while ((j > FIRST_BT_ID) &&
2608 (g_pBTBlocks[j - FIRST_BT_ID] != BTBLOCK_INVAL))
2609 j--;
2610 if (j == FIRST_BT_ID) {
2611 j = LAST_BT_ID;
2612 last_erased = LAST_BT_ID;
2613 } else {
2614 last_erased = (u8)j + 1;
2615 while ((j > FIRST_BT_ID) && (BTBLOCK_INVAL ==
2616 g_pBTBlocks[j - FIRST_BT_ID]))
2617 j--;
2618 }
2619 } else {
2620 j = FIRST_BT_ID;
2621 while (g_pBTBlocks[j - FIRST_BT_ID] == BTBLOCK_INVAL)
2622 j++;
2623 last_erased = (u8)j;
2624 while ((j < LAST_BT_ID) && (BTBLOCK_INVAL !=
2625 g_pBTBlocks[j - FIRST_BT_ID]))
2626 j++;
2627 if (g_pBTBlocks[j-FIRST_BT_ID] == BTBLOCK_INVAL)
2628 j--;
2629 }
2630
2631 if (last_erased > j)
2632 j += (1 + LAST_BT_ID - FIRST_BT_ID);
2633
2634 for (; (j >= last_erased) && (FAIL == wResult); j--) {
2635 i = (j - FIRST_BT_ID) %
2636 (1 + LAST_BT_ID - FIRST_BT_ID);
2637 search_result =
2638 FTL_Search_Block_Table_IN_Block(g_pBTBlocks[i],
2639 i + FIRST_BT_ID, &Page);
2640 if (g_cBlockTableStatus == IN_PROGRESS_BLOCK_TABLE)
2641 block_table_found = 0;
2642
2643 while ((search_result == PASS) && (FAIL == wResult)) {
2644 nand_dbg_print(NAND_DBG_DEBUG,
2645 "FTL_Read_Block_Table:"
2646 "Block: %u Page: %u "
2647 "contains block table\n",
2648 (unsigned int)g_pBTBlocks[i],
2649 (unsigned int)Page);
2650
2651 tempBuf = tmp_buf2_read_blk_table;
2652
2653 for (k = 0; k < bt_pages; k++) {
2654 Block = g_pBTBlocks[i];
2655 PageCount = 1;
2656
2657 status =
2658 GLOB_LLD_Read_Page_Main_Polling(
2659 tempBuf, Block, Page, PageCount);
2660
2661 tempvar = k ? 0 : 4;
2662
2663 wBytesCopied +=
2664 FTL_Copy_Block_Table_From_Flash(
2665 tempBuf + tempvar,
2666 DeviceInfo.wPageDataSize - tempvar,
2667 wBytesCopied);
2668
2669 Page++;
2670 }
2671
2672 wResult = FTL_Check_Block_Table(FAIL);
2673 if (FAIL == wResult) {
2674 block_table_found = 0;
2675 if (Page > bt_pages)
2676 Page -= ((bt_pages<<1) + 1);
2677 else
2678 search_result = FAIL;
2679 }
2680 }
2681 }
2682 }
2683
2684 if (PASS == wResult) {
2685 if (!block_table_found)
2686 FTL_Execute_SPL_Recovery();
2687
2688 if (g_cBlockTableStatus == IN_PROGRESS_BLOCK_TABLE)
2689 g_wBlockTableOffset = (u16)Page + 1;
2690 else
2691 g_wBlockTableOffset = (u16)Page - bt_pages;
2692
2693 g_wBlockTableIndex = (u32)g_pBTBlocks[i];
2694
2695 #if CMD_DMA
2696 if (DeviceInfo.MLCDevice)
2697 memcpy(g_pBTStartingCopy, g_pBlockTable,
2698 DeviceInfo.wDataBlockNum * sizeof(u32)
2699 + DeviceInfo.wDataBlockNum * sizeof(u8)
2700 + DeviceInfo.wDataBlockNum * sizeof(u16));
2701 else
2702 memcpy(g_pBTStartingCopy, g_pBlockTable,
2703 DeviceInfo.wDataBlockNum * sizeof(u32)
2704 + DeviceInfo.wDataBlockNum * sizeof(u8));
2705 #endif
2706 }
2707
2708 if (FAIL == wResult)
2709 printk(KERN_ERR "Yunpeng - "
2710 "Can not find valid spectra block table!\n");
2711
2712 #if AUTO_FORMAT_FLASH
2713 if (FAIL == wResult) {
2714 nand_dbg_print(NAND_DBG_DEBUG, "doing auto-format\n");
2715 wResult = FTL_Format_Flash(0);
2716 }
2717 #endif
2718
2719 return wResult;
2720 }
2721
2722 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2723 * Function: FTL_Get_Page_Num
2724 * Inputs: Size in bytes
2725 * Outputs: Size in pages
2726 * Description: It calculates the pages required for the length passed
2727 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2728 static u32 FTL_Get_Page_Num(u64 length)
2729 {
2730 return (u32)((length >> DeviceInfo.nBitsInPageDataSize) +
2731 (GLOB_u64_Remainder(length , 1) > 0 ? 1 : 0));
2732 }
2733
2734 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2735 * Function: FTL_Get_Physical_Block_Addr
2736 * Inputs: Block Address (byte format)
2737 * Outputs: Physical address of the block.
2738 * Description: It translates LBA to PBA by returning address stored
2739 * at the LBA location in the block table
2740 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2741 static u64 FTL_Get_Physical_Block_Addr(u64 logical_addr)
2742 {
2743 u32 *pbt;
2744 u64 physical_addr;
2745
2746 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
2747 __FILE__, __LINE__, __func__);
2748
2749 pbt = (u32 *)g_pBlockTable;
2750 physical_addr = (u64) DeviceInfo.wBlockDataSize *
2751 (pbt[BLK_FROM_ADDR(logical_addr)] & (~BAD_BLOCK));
2752
2753 return physical_addr;
2754 }
2755
2756 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2757 * Function: FTL_Get_Block_Index
2758 * Inputs: Physical Block no.
2759 * Outputs: Logical block no. /BAD_BLOCK
2760 * Description: It returns the logical block no. for the PBA passed
2761 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2762 static u32 FTL_Get_Block_Index(u32 wBlockNum)
2763 {
2764 u32 *pbt = (u32 *)g_pBlockTable;
2765 u32 i;
2766
2767 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
2768 __FILE__, __LINE__, __func__);
2769
2770 for (i = 0; i < DeviceInfo.wDataBlockNum; i++)
2771 if (wBlockNum == (pbt[i] & (~BAD_BLOCK)))
2772 return i;
2773
2774 return BAD_BLOCK;
2775 }
2776
2777 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2778 * Function: GLOB_FTL_Wear_Leveling
2779 * Inputs: none
2780 * Outputs: PASS=0
2781 * Description: This is static wear leveling (done by explicit call)
2782 * do complete static wear leveling
2783 * do complete garbage collection
2784 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2785 int GLOB_FTL_Wear_Leveling(void)
2786 {
2787 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d, Function: %s\n",
2788 __FILE__, __LINE__, __func__);
2789
2790 FTL_Static_Wear_Leveling();
2791 GLOB_FTL_Garbage_Collection();
2792
2793 return PASS;
2794 }
2795
2796 static void find_least_most_worn(u8 *chg,
2797 u32 *least_idx, u8 *least_cnt,
2798 u32 *most_idx, u8 *most_cnt)
2799 {
2800 u32 *pbt = (u32 *)g_pBlockTable;
2801 u32 idx;
2802 u8 cnt;
2803 int i;
2804
2805 for (i = BLOCK_TABLE_INDEX + 1; i < DeviceInfo.wDataBlockNum; i++) {
2806 if (IS_BAD_BLOCK(i) || PASS == chg[i])
2807 continue;
2808
2809 idx = (u32) ((~BAD_BLOCK) & pbt[i]);
2810 cnt = g_pWearCounter[idx - DeviceInfo.wSpectraStartBlock];
2811
2812 if (IS_SPARE_BLOCK(i)) {
2813 if (cnt > *most_cnt) {
2814 *most_cnt = cnt;
2815 *most_idx = idx;
2816 }
2817 }
2818
2819 if (IS_DATA_BLOCK(i)) {
2820 if (cnt < *least_cnt) {
2821 *least_cnt = cnt;
2822 *least_idx = idx;
2823 }
2824 }
2825
2826 if (PASS == chg[*most_idx] || PASS == chg[*least_idx]) {
2827 debug_boundary_error(*most_idx,
2828 DeviceInfo.wDataBlockNum, 0);
2829 debug_boundary_error(*least_idx,
2830 DeviceInfo.wDataBlockNum, 0);
2831 continue;
2832 }
2833 }
2834 }
2835
2836 static int move_blks_for_wear_leveling(u8 *chg,
2837 u32 *least_idx, u32 *rep_blk_num, int *result)
2838 {
2839 u32 *pbt = (u32 *)g_pBlockTable;
2840 u32 rep_blk;
2841 int j, ret_cp_blk, ret_erase;
2842 int ret = PASS;
2843
2844 chg[*least_idx] = PASS;
2845 debug_boundary_error(*least_idx, DeviceInfo.wDataBlockNum, 0);
2846
2847 rep_blk = FTL_Replace_MWBlock();
2848 if (rep_blk != BAD_BLOCK) {
2849 nand_dbg_print(NAND_DBG_DEBUG,
2850 "More than two spare blocks exist so do it\n");
2851 nand_dbg_print(NAND_DBG_DEBUG, "Block Replaced is %d\n",
2852 rep_blk);
2853
2854 chg[rep_blk] = PASS;
2855
2856 if (IN_PROGRESS_BLOCK_TABLE != g_cBlockTableStatus) {
2857 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
2858 FTL_Write_IN_Progress_Block_Table_Page();
2859 }
2860
2861 for (j = 0; j < RETRY_TIMES; j++) {
2862 ret_cp_blk = FTL_Copy_Block((u64)(*least_idx) *
2863 DeviceInfo.wBlockDataSize,
2864 (u64)rep_blk * DeviceInfo.wBlockDataSize);
2865 if (FAIL == ret_cp_blk) {
2866 ret_erase = GLOB_FTL_Block_Erase((u64)rep_blk
2867 * DeviceInfo.wBlockDataSize);
2868 if (FAIL == ret_erase)
2869 MARK_BLOCK_AS_BAD(pbt[rep_blk]);
2870 } else {
2871 nand_dbg_print(NAND_DBG_DEBUG,
2872 "FTL_Copy_Block == OK\n");
2873 break;
2874 }
2875 }
2876
2877 if (j < RETRY_TIMES) {
2878 u32 tmp;
2879 u32 old_idx = FTL_Get_Block_Index(*least_idx);
2880 u32 rep_idx = FTL_Get_Block_Index(rep_blk);
2881 tmp = (u32)(DISCARD_BLOCK | pbt[old_idx]);
2882 pbt[old_idx] = (u32)((~SPARE_BLOCK) &
2883 pbt[rep_idx]);
2884 pbt[rep_idx] = tmp;
2885 #if CMD_DMA
2886 p_BTableChangesDelta = (struct BTableChangesDelta *)
2887 g_pBTDelta_Free;
2888 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
2889 p_BTableChangesDelta->ftl_cmd_cnt =
2890 ftl_cmd_cnt;
2891 p_BTableChangesDelta->BT_Index = old_idx;
2892 p_BTableChangesDelta->BT_Entry_Value = pbt[old_idx];
2893 p_BTableChangesDelta->ValidFields = 0x0C;
2894
2895 p_BTableChangesDelta = (struct BTableChangesDelta *)
2896 g_pBTDelta_Free;
2897 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
2898
2899 p_BTableChangesDelta->ftl_cmd_cnt =
2900 ftl_cmd_cnt;
2901 p_BTableChangesDelta->BT_Index = rep_idx;
2902 p_BTableChangesDelta->BT_Entry_Value = pbt[rep_idx];
2903 p_BTableChangesDelta->ValidFields = 0x0C;
2904 #endif
2905 } else {
2906 pbt[FTL_Get_Block_Index(rep_blk)] |= BAD_BLOCK;
2907 #if CMD_DMA
2908 p_BTableChangesDelta = (struct BTableChangesDelta *)
2909 g_pBTDelta_Free;
2910 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
2911
2912 p_BTableChangesDelta->ftl_cmd_cnt =
2913 ftl_cmd_cnt;
2914 p_BTableChangesDelta->BT_Index =
2915 FTL_Get_Block_Index(rep_blk);
2916 p_BTableChangesDelta->BT_Entry_Value =
2917 pbt[FTL_Get_Block_Index(rep_blk)];
2918 p_BTableChangesDelta->ValidFields = 0x0C;
2919 #endif
2920 *result = FAIL;
2921 ret = FAIL;
2922 }
2923
2924 if (((*rep_blk_num)++) > WEAR_LEVELING_BLOCK_NUM)
2925 ret = FAIL;
2926 } else {
2927 printk(KERN_ERR "Less than 3 spare blocks exist so quit\n");
2928 ret = FAIL;
2929 }
2930
2931 return ret;
2932 }
2933
2934 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
2935 * Function: FTL_Static_Wear_Leveling
2936 * Inputs: none
2937 * Outputs: PASS=0 / FAIL=1
2938 * Description: This is static wear leveling (done by explicit call)
2939 * search for most&least used
2940 * if difference < GATE:
2941 * update the block table with exhange
2942 * mark block table in flash as IN_PROGRESS
2943 * copy flash block
2944 * the caller should handle GC clean up after calling this function
2945 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
2946 int FTL_Static_Wear_Leveling(void)
2947 {
2948 u8 most_worn_cnt;
2949 u8 least_worn_cnt;
2950 u32 most_worn_idx;
2951 u32 least_worn_idx;
2952 int result = PASS;
2953 int go_on = PASS;
2954 u32 replaced_blks = 0;
2955 u8 *chang_flag = flags_static_wear_leveling;
2956
2957 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d, Function: %s\n",
2958 __FILE__, __LINE__, __func__);
2959
2960 if (!chang_flag)
2961 return FAIL;
2962
2963 memset(chang_flag, FAIL, DeviceInfo.wDataBlockNum);
2964 while (go_on == PASS) {
2965 nand_dbg_print(NAND_DBG_DEBUG,
2966 "starting static wear leveling\n");
2967 most_worn_cnt = 0;
2968 least_worn_cnt = 0xFF;
2969 least_worn_idx = BLOCK_TABLE_INDEX;
2970 most_worn_idx = BLOCK_TABLE_INDEX;
2971
2972 find_least_most_worn(chang_flag, &least_worn_idx,
2973 &least_worn_cnt, &most_worn_idx, &most_worn_cnt);
2974
2975 nand_dbg_print(NAND_DBG_DEBUG,
2976 "Used and least worn is block %u, whos count is %u\n",
2977 (unsigned int)least_worn_idx,
2978 (unsigned int)least_worn_cnt);
2979
2980 nand_dbg_print(NAND_DBG_DEBUG,
2981 "Free and most worn is block %u, whos count is %u\n",
2982 (unsigned int)most_worn_idx,
2983 (unsigned int)most_worn_cnt);
2984
2985 if ((most_worn_cnt > least_worn_cnt) &&
2986 (most_worn_cnt - least_worn_cnt > WEAR_LEVELING_GATE))
2987 go_on = move_blks_for_wear_leveling(chang_flag,
2988 &least_worn_idx, &replaced_blks, &result);
2989 else
2990 go_on = FAIL;
2991 }
2992
2993 return result;
2994 }
2995
2996 #if CMD_DMA
2997 static int do_garbage_collection(u32 discard_cnt)
2998 {
2999 u32 *pbt = (u32 *)g_pBlockTable;
3000 u32 pba;
3001 u8 bt_block_erased = 0;
3002 int i, cnt, ret = FAIL;
3003 u64 addr;
3004
3005 i = 0;
3006 while ((i < DeviceInfo.wDataBlockNum) && (discard_cnt > 0) &&
3007 ((ftl_cmd_cnt + 28) < 256)) {
3008 if (((pbt[i] & BAD_BLOCK) != BAD_BLOCK) &&
3009 (pbt[i] & DISCARD_BLOCK)) {
3010 if (IN_PROGRESS_BLOCK_TABLE != g_cBlockTableStatus) {
3011 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
3012 FTL_Write_IN_Progress_Block_Table_Page();
3013 }
3014
3015 addr = FTL_Get_Physical_Block_Addr((u64)i *
3016 DeviceInfo.wBlockDataSize);
3017 pba = BLK_FROM_ADDR(addr);
3018
3019 for (cnt = FIRST_BT_ID; cnt <= LAST_BT_ID; cnt++) {
3020 if (pba == g_pBTBlocks[cnt - FIRST_BT_ID]) {
3021 nand_dbg_print(NAND_DBG_DEBUG,
3022 "GC will erase BT block %u\n",
3023 (unsigned int)pba);
3024 discard_cnt--;
3025 i++;
3026 bt_block_erased = 1;
3027 break;
3028 }
3029 }
3030
3031 if (bt_block_erased) {
3032 bt_block_erased = 0;
3033 continue;
3034 }
3035
3036 addr = FTL_Get_Physical_Block_Addr((u64)i *
3037 DeviceInfo.wBlockDataSize);
3038
3039 if (PASS == GLOB_FTL_Block_Erase(addr)) {
3040 pbt[i] &= (u32)(~DISCARD_BLOCK);
3041 pbt[i] |= (u32)(SPARE_BLOCK);
3042 p_BTableChangesDelta =
3043 (struct BTableChangesDelta *)
3044 g_pBTDelta_Free;
3045 g_pBTDelta_Free +=
3046 sizeof(struct BTableChangesDelta);
3047 p_BTableChangesDelta->ftl_cmd_cnt =
3048 ftl_cmd_cnt - 1;
3049 p_BTableChangesDelta->BT_Index = i;
3050 p_BTableChangesDelta->BT_Entry_Value = pbt[i];
3051 p_BTableChangesDelta->ValidFields = 0x0C;
3052 discard_cnt--;
3053 ret = PASS;
3054 } else {
3055 MARK_BLOCK_AS_BAD(pbt[i]);
3056 }
3057 }
3058
3059 i++;
3060 }
3061
3062 return ret;
3063 }
3064
3065 #else
3066 static int do_garbage_collection(u32 discard_cnt)
3067 {
3068 u32 *pbt = (u32 *)g_pBlockTable;
3069 u32 pba;
3070 u8 bt_block_erased = 0;
3071 int i, cnt, ret = FAIL;
3072 u64 addr;
3073
3074 i = 0;
3075 while ((i < DeviceInfo.wDataBlockNum) && (discard_cnt > 0)) {
3076 if (((pbt[i] & BAD_BLOCK) != BAD_BLOCK) &&
3077 (pbt[i] & DISCARD_BLOCK)) {
3078 if (IN_PROGRESS_BLOCK_TABLE != g_cBlockTableStatus) {
3079 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
3080 FTL_Write_IN_Progress_Block_Table_Page();
3081 }
3082
3083 addr = FTL_Get_Physical_Block_Addr((u64)i *
3084 DeviceInfo.wBlockDataSize);
3085 pba = BLK_FROM_ADDR(addr);
3086
3087 for (cnt = FIRST_BT_ID; cnt <= LAST_BT_ID; cnt++) {
3088 if (pba == g_pBTBlocks[cnt - FIRST_BT_ID]) {
3089 nand_dbg_print(NAND_DBG_DEBUG,
3090 "GC will erase BT block %d\n",
3091 pba);
3092 discard_cnt--;
3093 i++;
3094 bt_block_erased = 1;
3095 break;
3096 }
3097 }
3098
3099 if (bt_block_erased) {
3100 bt_block_erased = 0;
3101 continue;
3102 }
3103
3104 /* If the discard block is L2 cache block, then just skip it */
3105 for (cnt = 0; cnt < BLK_NUM_FOR_L2_CACHE; cnt++) {
3106 if (cache_l2.blk_array[cnt] == pba) {
3107 nand_dbg_print(NAND_DBG_DEBUG,
3108 "GC will erase L2 cache blk %d\n",
3109 pba);
3110 break;
3111 }
3112 }
3113 if (cnt < BLK_NUM_FOR_L2_CACHE) { /* Skip it */
3114 discard_cnt--;
3115 i++;
3116 continue;
3117 }
3118
3119 addr = FTL_Get_Physical_Block_Addr((u64)i *
3120 DeviceInfo.wBlockDataSize);
3121
3122 if (PASS == GLOB_FTL_Block_Erase(addr)) {
3123 pbt[i] &= (u32)(~DISCARD_BLOCK);
3124 pbt[i] |= (u32)(SPARE_BLOCK);
3125 discard_cnt--;
3126 ret = PASS;
3127 } else {
3128 MARK_BLOCK_AS_BAD(pbt[i]);
3129 }
3130 }
3131
3132 i++;
3133 }
3134
3135 return ret;
3136 }
3137 #endif
3138
3139 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3140 * Function: GLOB_FTL_Garbage_Collection
3141 * Inputs: none
3142 * Outputs: PASS / FAIL (returns the number of un-erased blocks
3143 * Description: search the block table for all discarded blocks to erase
3144 * for each discarded block:
3145 * set the flash block to IN_PROGRESS
3146 * erase the block
3147 * update the block table
3148 * write the block table to flash
3149 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3150 int GLOB_FTL_Garbage_Collection(void)
3151 {
3152 u32 i;
3153 u32 wDiscard = 0;
3154 int wResult = FAIL;
3155 u32 *pbt = (u32 *)g_pBlockTable;
3156
3157 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d, Function: %s\n",
3158 __FILE__, __LINE__, __func__);
3159
3160 if (GC_Called) {
3161 printk(KERN_ALERT "GLOB_FTL_Garbage_Collection() "
3162 "has been re-entered! Exit.\n");
3163 return PASS;
3164 }
3165
3166 GC_Called = 1;
3167
3168 GLOB_FTL_BT_Garbage_Collection();
3169
3170 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
3171 if (IS_DISCARDED_BLOCK(i))
3172 wDiscard++;
3173 }
3174
3175 if (wDiscard <= 0) {
3176 GC_Called = 0;
3177 return wResult;
3178 }
3179
3180 nand_dbg_print(NAND_DBG_DEBUG,
3181 "Found %d discarded blocks\n", wDiscard);
3182
3183 FTL_Write_Block_Table(FAIL);
3184
3185 wResult = do_garbage_collection(wDiscard);
3186
3187 FTL_Write_Block_Table(FAIL);
3188
3189 GC_Called = 0;
3190
3191 return wResult;
3192 }
3193
3194
3195 #if CMD_DMA
3196 static int do_bt_garbage_collection(void)
3197 {
3198 u32 pba, lba;
3199 u32 *pbt = (u32 *)g_pBlockTable;
3200 u32 *pBTBlocksNode = (u32 *)g_pBTBlocks;
3201 u64 addr;
3202 int i, ret = FAIL;
3203
3204 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3205 __FILE__, __LINE__, __func__);
3206
3207 if (BT_GC_Called)
3208 return PASS;
3209
3210 BT_GC_Called = 1;
3211
3212 for (i = last_erased; (i <= LAST_BT_ID) &&
3213 (g_pBTBlocks[((i + 2) % (1 + LAST_BT_ID - FIRST_BT_ID)) +
3214 FIRST_BT_ID - FIRST_BT_ID] != BTBLOCK_INVAL) &&
3215 ((ftl_cmd_cnt + 28)) < 256; i++) {
3216 pba = pBTBlocksNode[i - FIRST_BT_ID];
3217 lba = FTL_Get_Block_Index(pba);
3218 nand_dbg_print(NAND_DBG_DEBUG,
3219 "do_bt_garbage_collection: pba %d, lba %d\n",
3220 pba, lba);
3221 nand_dbg_print(NAND_DBG_DEBUG,
3222 "Block Table Entry: %d", pbt[lba]);
3223
3224 if (((pbt[lba] & BAD_BLOCK) != BAD_BLOCK) &&
3225 (pbt[lba] & DISCARD_BLOCK)) {
3226 nand_dbg_print(NAND_DBG_DEBUG,
3227 "do_bt_garbage_collection_cdma: "
3228 "Erasing Block tables present in block %d\n",
3229 pba);
3230 addr = FTL_Get_Physical_Block_Addr((u64)lba *
3231 DeviceInfo.wBlockDataSize);
3232 if (PASS == GLOB_FTL_Block_Erase(addr)) {
3233 pbt[lba] &= (u32)(~DISCARD_BLOCK);
3234 pbt[lba] |= (u32)(SPARE_BLOCK);
3235
3236 p_BTableChangesDelta =
3237 (struct BTableChangesDelta *)
3238 g_pBTDelta_Free;
3239 g_pBTDelta_Free +=
3240 sizeof(struct BTableChangesDelta);
3241
3242 p_BTableChangesDelta->ftl_cmd_cnt =
3243 ftl_cmd_cnt - 1;
3244 p_BTableChangesDelta->BT_Index = lba;
3245 p_BTableChangesDelta->BT_Entry_Value =
3246 pbt[lba];
3247
3248 p_BTableChangesDelta->ValidFields = 0x0C;
3249
3250 ret = PASS;
3251 pBTBlocksNode[last_erased - FIRST_BT_ID] =
3252 BTBLOCK_INVAL;
3253 nand_dbg_print(NAND_DBG_DEBUG,
3254 "resetting bt entry at index %d "
3255 "value %d\n", i,
3256 pBTBlocksNode[i - FIRST_BT_ID]);
3257 if (last_erased == LAST_BT_ID)
3258 last_erased = FIRST_BT_ID;
3259 else
3260 last_erased++;
3261 } else {
3262 MARK_BLOCK_AS_BAD(pbt[lba]);
3263 }
3264 }
3265 }
3266
3267 BT_GC_Called = 0;
3268
3269 return ret;
3270 }
3271
3272 #else
3273 static int do_bt_garbage_collection(void)
3274 {
3275 u32 pba, lba;
3276 u32 *pbt = (u32 *)g_pBlockTable;
3277 u32 *pBTBlocksNode = (u32 *)g_pBTBlocks;
3278 u64 addr;
3279 int i, ret = FAIL;
3280
3281 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3282 __FILE__, __LINE__, __func__);
3283
3284 if (BT_GC_Called)
3285 return PASS;
3286
3287 BT_GC_Called = 1;
3288
3289 for (i = last_erased; (i <= LAST_BT_ID) &&
3290 (g_pBTBlocks[((i + 2) % (1 + LAST_BT_ID - FIRST_BT_ID)) +
3291 FIRST_BT_ID - FIRST_BT_ID] != BTBLOCK_INVAL); i++) {
3292 pba = pBTBlocksNode[i - FIRST_BT_ID];
3293 lba = FTL_Get_Block_Index(pba);
3294 nand_dbg_print(NAND_DBG_DEBUG,
3295 "do_bt_garbage_collection_cdma: pba %d, lba %d\n",
3296 pba, lba);
3297 nand_dbg_print(NAND_DBG_DEBUG,
3298 "Block Table Entry: %d", pbt[lba]);
3299
3300 if (((pbt[lba] & BAD_BLOCK) != BAD_BLOCK) &&
3301 (pbt[lba] & DISCARD_BLOCK)) {
3302 nand_dbg_print(NAND_DBG_DEBUG,
3303 "do_bt_garbage_collection: "
3304 "Erasing Block tables present in block %d\n",
3305 pba);
3306 addr = FTL_Get_Physical_Block_Addr((u64)lba *
3307 DeviceInfo.wBlockDataSize);
3308 if (PASS == GLOB_FTL_Block_Erase(addr)) {
3309 pbt[lba] &= (u32)(~DISCARD_BLOCK);
3310 pbt[lba] |= (u32)(SPARE_BLOCK);
3311 ret = PASS;
3312 pBTBlocksNode[last_erased - FIRST_BT_ID] =
3313 BTBLOCK_INVAL;
3314 nand_dbg_print(NAND_DBG_DEBUG,
3315 "resetting bt entry at index %d "
3316 "value %d\n", i,
3317 pBTBlocksNode[i - FIRST_BT_ID]);
3318 if (last_erased == LAST_BT_ID)
3319 last_erased = FIRST_BT_ID;
3320 else
3321 last_erased++;
3322 } else {
3323 MARK_BLOCK_AS_BAD(pbt[lba]);
3324 }
3325 }
3326 }
3327
3328 BT_GC_Called = 0;
3329
3330 return ret;
3331 }
3332
3333 #endif
3334
3335 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3336 * Function: GLOB_FTL_BT_Garbage_Collection
3337 * Inputs: none
3338 * Outputs: PASS / FAIL (returns the number of un-erased blocks
3339 * Description: Erases discarded blocks containing Block table
3340 *
3341 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3342 int GLOB_FTL_BT_Garbage_Collection(void)
3343 {
3344 return do_bt_garbage_collection();
3345 }
3346
3347 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3348 * Function: FTL_Replace_OneBlock
3349 * Inputs: Block number 1
3350 * Block number 2
3351 * Outputs: Replaced Block Number
3352 * Description: Interchange block table entries at wBlockNum and wReplaceNum
3353 *
3354 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3355 static u32 FTL_Replace_OneBlock(u32 blk, u32 rep_blk)
3356 {
3357 u32 tmp_blk;
3358 u32 replace_node = BAD_BLOCK;
3359 u32 *pbt = (u32 *)g_pBlockTable;
3360
3361 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3362 __FILE__, __LINE__, __func__);
3363
3364 if (rep_blk != BAD_BLOCK) {
3365 if (IS_BAD_BLOCK(blk))
3366 tmp_blk = pbt[blk];
3367 else
3368 tmp_blk = DISCARD_BLOCK | (~SPARE_BLOCK & pbt[blk]);
3369
3370 replace_node = (u32) ((~SPARE_BLOCK) & pbt[rep_blk]);
3371 pbt[blk] = replace_node;
3372 pbt[rep_blk] = tmp_blk;
3373
3374 #if CMD_DMA
3375 p_BTableChangesDelta =
3376 (struct BTableChangesDelta *)g_pBTDelta_Free;
3377 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
3378
3379 p_BTableChangesDelta->ftl_cmd_cnt = ftl_cmd_cnt;
3380 p_BTableChangesDelta->BT_Index = blk;
3381 p_BTableChangesDelta->BT_Entry_Value = pbt[blk];
3382
3383 p_BTableChangesDelta->ValidFields = 0x0C;
3384
3385 p_BTableChangesDelta =
3386 (struct BTableChangesDelta *)g_pBTDelta_Free;
3387 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
3388
3389 p_BTableChangesDelta->ftl_cmd_cnt = ftl_cmd_cnt;
3390 p_BTableChangesDelta->BT_Index = rep_blk;
3391 p_BTableChangesDelta->BT_Entry_Value = pbt[rep_blk];
3392 p_BTableChangesDelta->ValidFields = 0x0C;
3393 #endif
3394 }
3395
3396 return replace_node;
3397 }
3398
3399 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3400 * Function: FTL_Write_Block_Table_Data
3401 * Inputs: Block table size in pages
3402 * Outputs: PASS=0 / FAIL=1
3403 * Description: Write block table data in flash
3404 * If first page and last page
3405 * Write data+BT flag
3406 * else
3407 * Write data
3408 * BT flag is a counter. Its value is incremented for block table
3409 * write in a new Block
3410 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3411 static int FTL_Write_Block_Table_Data(void)
3412 {
3413 u64 dwBlockTableAddr, pTempAddr;
3414 u32 Block;
3415 u16 Page, PageCount;
3416 u8 *tempBuf = tmp_buf_write_blk_table_data;
3417 int wBytesCopied;
3418 u16 bt_pages;
3419
3420 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3421 __FILE__, __LINE__, __func__);
3422
3423 dwBlockTableAddr =
3424 (u64)((u64)g_wBlockTableIndex * DeviceInfo.wBlockDataSize +
3425 (u64)g_wBlockTableOffset * DeviceInfo.wPageDataSize);
3426 pTempAddr = dwBlockTableAddr;
3427
3428 bt_pages = FTL_Get_Block_Table_Flash_Size_Pages();
3429
3430 nand_dbg_print(NAND_DBG_DEBUG, "FTL_Write_Block_Table_Data: "
3431 "page= %d BlockTableIndex= %d "
3432 "BlockTableOffset=%d\n", bt_pages,
3433 g_wBlockTableIndex, g_wBlockTableOffset);
3434
3435 Block = BLK_FROM_ADDR(pTempAddr);
3436 Page = PAGE_FROM_ADDR(pTempAddr, Block);
3437 PageCount = 1;
3438
3439 if (bt_block_changed) {
3440 if (bt_flag == LAST_BT_ID) {
3441 bt_flag = FIRST_BT_ID;
3442 g_pBTBlocks[bt_flag - FIRST_BT_ID] = Block;
3443 } else if (bt_flag < LAST_BT_ID) {
3444 bt_flag++;
3445 g_pBTBlocks[bt_flag - FIRST_BT_ID] = Block;
3446 }
3447
3448 if ((bt_flag > (LAST_BT_ID-4)) &&
3449 g_pBTBlocks[FIRST_BT_ID - FIRST_BT_ID] !=
3450 BTBLOCK_INVAL) {
3451 bt_block_changed = 0;
3452 GLOB_FTL_BT_Garbage_Collection();
3453 }
3454
3455 bt_block_changed = 0;
3456 nand_dbg_print(NAND_DBG_DEBUG,
3457 "Block Table Counter is %u Block %u\n",
3458 bt_flag, (unsigned int)Block);
3459 }
3460
3461 memset(tempBuf, 0, 3);
3462 tempBuf[3] = bt_flag;
3463 wBytesCopied = FTL_Copy_Block_Table_To_Flash(tempBuf + 4,
3464 DeviceInfo.wPageDataSize - 4, 0);
3465 memset(&tempBuf[wBytesCopied + 4], 0xff,
3466 DeviceInfo.wPageSize - (wBytesCopied + 4));
3467 FTL_Insert_Block_Table_Signature(&tempBuf[DeviceInfo.wPageDataSize],
3468 bt_flag);
3469
3470 #if CMD_DMA
3471 memcpy(g_pNextBlockTable, tempBuf,
3472 DeviceInfo.wPageSize * sizeof(u8));
3473 nand_dbg_print(NAND_DBG_DEBUG, "Writing First Page of Block Table "
3474 "Block %u Page %u\n", (unsigned int)Block, Page);
3475 if (FAIL == GLOB_LLD_Write_Page_Main_Spare_cdma(g_pNextBlockTable,
3476 Block, Page, 1,
3477 LLD_CMD_FLAG_MODE_CDMA | LLD_CMD_FLAG_ORDER_BEFORE_REST)) {
3478 nand_dbg_print(NAND_DBG_WARN, "NAND Program fail in "
3479 "%s, Line %d, Function: %s, "
3480 "new Bad Block %d generated!\n",
3481 __FILE__, __LINE__, __func__, Block);
3482 goto func_return;
3483 }
3484
3485 ftl_cmd_cnt++;
3486 g_pNextBlockTable += ((DeviceInfo.wPageSize * sizeof(u8)));
3487 #else
3488 if (FAIL == GLOB_LLD_Write_Page_Main_Spare(tempBuf, Block, Page, 1)) {
3489 nand_dbg_print(NAND_DBG_WARN,
3490 "NAND Program fail in %s, Line %d, Function: %s, "
3491 "new Bad Block %d generated!\n",
3492 __FILE__, __LINE__, __func__, Block);
3493 goto func_return;
3494 }
3495 #endif
3496
3497 if (bt_pages > 1) {
3498 PageCount = bt_pages - 1;
3499 if (PageCount > 1) {
3500 wBytesCopied += FTL_Copy_Block_Table_To_Flash(tempBuf,
3501 DeviceInfo.wPageDataSize * (PageCount - 1),
3502 wBytesCopied);
3503
3504 #if CMD_DMA
3505 memcpy(g_pNextBlockTable, tempBuf,
3506 (PageCount - 1) * DeviceInfo.wPageDataSize);
3507 if (FAIL == GLOB_LLD_Write_Page_Main_cdma(
3508 g_pNextBlockTable, Block, Page + 1,
3509 PageCount - 1)) {
3510 nand_dbg_print(NAND_DBG_WARN,
3511 "NAND Program fail in %s, Line %d, "
3512 "Function: %s, "
3513 "new Bad Block %d generated!\n",
3514 __FILE__, __LINE__, __func__,
3515 (int)Block);
3516 goto func_return;
3517 }
3518
3519 ftl_cmd_cnt++;
3520 g_pNextBlockTable += (PageCount - 1) *
3521 DeviceInfo.wPageDataSize * sizeof(u8);
3522 #else
3523 if (FAIL == GLOB_LLD_Write_Page_Main(tempBuf,
3524 Block, Page + 1, PageCount - 1)) {
3525 nand_dbg_print(NAND_DBG_WARN,
3526 "NAND Program fail in %s, Line %d, "
3527 "Function: %s, "
3528 "new Bad Block %d generated!\n",
3529 __FILE__, __LINE__, __func__,
3530 (int)Block);
3531 goto func_return;
3532 }
3533 #endif
3534 }
3535
3536 wBytesCopied = FTL_Copy_Block_Table_To_Flash(tempBuf,
3537 DeviceInfo.wPageDataSize, wBytesCopied);
3538 memset(&tempBuf[wBytesCopied], 0xff,
3539 DeviceInfo.wPageSize-wBytesCopied);
3540 FTL_Insert_Block_Table_Signature(
3541 &tempBuf[DeviceInfo.wPageDataSize], bt_flag);
3542 #if CMD_DMA
3543 memcpy(g_pNextBlockTable, tempBuf,
3544 DeviceInfo.wPageSize * sizeof(u8));
3545 nand_dbg_print(NAND_DBG_DEBUG,
3546 "Writing the last Page of Block Table "
3547 "Block %u Page %u\n",
3548 (unsigned int)Block, Page + bt_pages - 1);
3549 if (FAIL == GLOB_LLD_Write_Page_Main_Spare_cdma(
3550 g_pNextBlockTable, Block, Page + bt_pages - 1, 1,
3551 LLD_CMD_FLAG_MODE_CDMA |
3552 LLD_CMD_FLAG_ORDER_BEFORE_REST)) {
3553 nand_dbg_print(NAND_DBG_WARN,
3554 "NAND Program fail in %s, Line %d, "
3555 "Function: %s, new Bad Block %d generated!\n",
3556 __FILE__, __LINE__, __func__, Block);
3557 goto func_return;
3558 }
3559 ftl_cmd_cnt++;
3560 #else
3561 if (FAIL == GLOB_LLD_Write_Page_Main_Spare(tempBuf,
3562 Block, Page+bt_pages - 1, 1)) {
3563 nand_dbg_print(NAND_DBG_WARN,
3564 "NAND Program fail in %s, Line %d, "
3565 "Function: %s, "
3566 "new Bad Block %d generated!\n",
3567 __FILE__, __LINE__, __func__, Block);
3568 goto func_return;
3569 }
3570 #endif
3571 }
3572
3573 nand_dbg_print(NAND_DBG_DEBUG, "FTL_Write_Block_Table_Data: done\n");
3574
3575 func_return:
3576 return PASS;
3577 }
3578
3579 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3580 * Function: FTL_Replace_Block_Table
3581 * Inputs: None
3582 * Outputs: PASS=0 / FAIL=1
3583 * Description: Get a new block to write block table
3584 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3585 static u32 FTL_Replace_Block_Table(void)
3586 {
3587 u32 blk;
3588 int gc;
3589
3590 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3591 __FILE__, __LINE__, __func__);
3592
3593 blk = FTL_Replace_LWBlock(BLOCK_TABLE_INDEX, &gc);
3594
3595 if ((BAD_BLOCK == blk) && (PASS == gc)) {
3596 GLOB_FTL_Garbage_Collection();
3597 blk = FTL_Replace_LWBlock(BLOCK_TABLE_INDEX, &gc);
3598 }
3599 if (BAD_BLOCK == blk)
3600 printk(KERN_ERR "%s, %s: There is no spare block. "
3601 "It should never happen\n",
3602 __FILE__, __func__);
3603
3604 nand_dbg_print(NAND_DBG_DEBUG, "New Block table Block is %d\n", blk);
3605
3606 return blk;
3607 }
3608
3609 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3610 * Function: FTL_Replace_LWBlock
3611 * Inputs: Block number
3612 * Pointer to Garbage Collect flag
3613 * Outputs:
3614 * Description: Determine the least weared block by traversing
3615 * block table
3616 * Set Garbage collection to be called if number of spare
3617 * block is less than Free Block Gate count
3618 * Change Block table entry to map least worn block for current
3619 * operation
3620 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3621 static u32 FTL_Replace_LWBlock(u32 wBlockNum, int *pGarbageCollect)
3622 {
3623 u32 i;
3624 u32 *pbt = (u32 *)g_pBlockTable;
3625 u8 wLeastWornCounter = 0xFF;
3626 u32 wLeastWornIndex = BAD_BLOCK;
3627 u32 wSpareBlockNum = 0;
3628 u32 wDiscardBlockNum = 0;
3629
3630 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3631 __FILE__, __LINE__, __func__);
3632
3633 if (IS_SPARE_BLOCK(wBlockNum)) {
3634 *pGarbageCollect = FAIL;
3635 pbt[wBlockNum] = (u32)(pbt[wBlockNum] & (~SPARE_BLOCK));
3636 #if CMD_DMA
3637 p_BTableChangesDelta =
3638 (struct BTableChangesDelta *)g_pBTDelta_Free;
3639 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
3640 p_BTableChangesDelta->ftl_cmd_cnt =
3641 ftl_cmd_cnt;
3642 p_BTableChangesDelta->BT_Index = (u32)(wBlockNum);
3643 p_BTableChangesDelta->BT_Entry_Value = pbt[wBlockNum];
3644 p_BTableChangesDelta->ValidFields = 0x0C;
3645 #endif
3646 return pbt[wBlockNum];
3647 }
3648
3649 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
3650 if (IS_DISCARDED_BLOCK(i))
3651 wDiscardBlockNum++;
3652
3653 if (IS_SPARE_BLOCK(i)) {
3654 u32 wPhysicalIndex = (u32)((~BAD_BLOCK) & pbt[i]);
3655 if (wPhysicalIndex > DeviceInfo.wSpectraEndBlock)
3656 printk(KERN_ERR "FTL_Replace_LWBlock: "
3657 "This should never occur!\n");
3658 if (g_pWearCounter[wPhysicalIndex -
3659 DeviceInfo.wSpectraStartBlock] <
3660 wLeastWornCounter) {
3661 wLeastWornCounter =
3662 g_pWearCounter[wPhysicalIndex -
3663 DeviceInfo.wSpectraStartBlock];
3664 wLeastWornIndex = i;
3665 }
3666 wSpareBlockNum++;
3667 }
3668 }
3669
3670 nand_dbg_print(NAND_DBG_WARN,
3671 "FTL_Replace_LWBlock: Least Worn Counter %d\n",
3672 (int)wLeastWornCounter);
3673
3674 if ((wDiscardBlockNum >= NUM_FREE_BLOCKS_GATE) ||
3675 (wSpareBlockNum <= NUM_FREE_BLOCKS_GATE))
3676 *pGarbageCollect = PASS;
3677 else
3678 *pGarbageCollect = FAIL;
3679
3680 nand_dbg_print(NAND_DBG_DEBUG,
3681 "FTL_Replace_LWBlock: Discarded Blocks %u Spare"
3682 " Blocks %u\n",
3683 (unsigned int)wDiscardBlockNum,
3684 (unsigned int)wSpareBlockNum);
3685
3686 return FTL_Replace_OneBlock(wBlockNum, wLeastWornIndex);
3687 }
3688
3689 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3690 * Function: FTL_Replace_MWBlock
3691 * Inputs: None
3692 * Outputs: most worn spare block no./BAD_BLOCK
3693 * Description: It finds most worn spare block.
3694 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3695 static u32 FTL_Replace_MWBlock(void)
3696 {
3697 u32 i;
3698 u32 *pbt = (u32 *)g_pBlockTable;
3699 u8 wMostWornCounter = 0;
3700 u32 wMostWornIndex = BAD_BLOCK;
3701 u32 wSpareBlockNum = 0;
3702
3703 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3704 __FILE__, __LINE__, __func__);
3705
3706 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
3707 if (IS_SPARE_BLOCK(i)) {
3708 u32 wPhysicalIndex = (u32)((~SPARE_BLOCK) & pbt[i]);
3709 if (g_pWearCounter[wPhysicalIndex -
3710 DeviceInfo.wSpectraStartBlock] >
3711 wMostWornCounter) {
3712 wMostWornCounter =
3713 g_pWearCounter[wPhysicalIndex -
3714 DeviceInfo.wSpectraStartBlock];
3715 wMostWornIndex = wPhysicalIndex;
3716 }
3717 wSpareBlockNum++;
3718 }
3719 }
3720
3721 if (wSpareBlockNum <= 2)
3722 return BAD_BLOCK;
3723
3724 return wMostWornIndex;
3725 }
3726
3727 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3728 * Function: FTL_Replace_Block
3729 * Inputs: Block Address
3730 * Outputs: PASS=0 / FAIL=1
3731 * Description: If block specified by blk_addr parameter is not free,
3732 * replace it with the least worn block.
3733 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3734 static int FTL_Replace_Block(u64 blk_addr)
3735 {
3736 u32 current_blk = BLK_FROM_ADDR(blk_addr);
3737 u32 *pbt = (u32 *)g_pBlockTable;
3738 int wResult = PASS;
3739 int GarbageCollect = FAIL;
3740
3741 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3742 __FILE__, __LINE__, __func__);
3743
3744 if (IS_SPARE_BLOCK(current_blk)) {
3745 pbt[current_blk] = (~SPARE_BLOCK) & pbt[current_blk];
3746 #if CMD_DMA
3747 p_BTableChangesDelta =
3748 (struct BTableChangesDelta *)g_pBTDelta_Free;
3749 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
3750 p_BTableChangesDelta->ftl_cmd_cnt =
3751 ftl_cmd_cnt;
3752 p_BTableChangesDelta->BT_Index = current_blk;
3753 p_BTableChangesDelta->BT_Entry_Value = pbt[current_blk];
3754 p_BTableChangesDelta->ValidFields = 0x0C ;
3755 #endif
3756 return wResult;
3757 }
3758
3759 FTL_Replace_LWBlock(current_blk, &GarbageCollect);
3760
3761 if (PASS == GarbageCollect)
3762 wResult = GLOB_FTL_Garbage_Collection();
3763
3764 return wResult;
3765 }
3766
3767 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3768 * Function: GLOB_FTL_Is_BadBlock
3769 * Inputs: block number to test
3770 * Outputs: PASS (block is BAD) / FAIL (block is not bad)
3771 * Description: test if this block number is flagged as bad
3772 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3773 int GLOB_FTL_Is_BadBlock(u32 wBlockNum)
3774 {
3775 u32 *pbt = (u32 *)g_pBlockTable;
3776
3777 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3778 __FILE__, __LINE__, __func__);
3779
3780 if (wBlockNum >= DeviceInfo.wSpectraStartBlock
3781 && BAD_BLOCK == (pbt[wBlockNum] & BAD_BLOCK))
3782 return PASS;
3783 else
3784 return FAIL;
3785 }
3786
3787 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3788 * Function: GLOB_FTL_Flush_Cache
3789 * Inputs: none
3790 * Outputs: PASS=0 / FAIL=1
3791 * Description: flush all the cache blocks to flash
3792 * if a cache block is not dirty, don't do anything with it
3793 * else, write the block and update the block table
3794 * Note: This function should be called at shutdown/power down.
3795 * to write important data into device
3796 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3797 int GLOB_FTL_Flush_Cache(void)
3798 {
3799 int i, ret;
3800
3801 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d, Function: %s\n",
3802 __FILE__, __LINE__, __func__);
3803
3804 for (i = 0; i < CACHE_ITEM_NUM; i++) {
3805 if (SET == Cache.array[i].changed) {
3806 #if CMD_DMA
3807 #if RESTORE_CACHE_ON_CDMA_CHAIN_FAILURE
3808 int_cache[ftl_cmd_cnt].item = i;
3809 int_cache[ftl_cmd_cnt].cache.address =
3810 Cache.array[i].address;
3811 int_cache[ftl_cmd_cnt].cache.changed = CLEAR;
3812 #endif
3813 #endif
3814 ret = write_back_to_l2_cache(Cache.array[i].buf, Cache.array[i].address);
3815 if (PASS == ret) {
3816 Cache.array[i].changed = CLEAR;
3817 } else {
3818 printk(KERN_ALERT "Failed when write back to L2 cache!\n");
3819 /* TODO - How to handle this? */
3820 }
3821 }
3822 }
3823
3824 flush_l2_cache();
3825
3826 return FTL_Write_Block_Table(FAIL);
3827 }
3828
3829 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3830 * Function: GLOB_FTL_Page_Read
3831 * Inputs: pointer to data
3832 * logical address of data (u64 is LBA * Bytes/Page)
3833 * Outputs: PASS=0 / FAIL=1
3834 * Description: reads a page of data into RAM from the cache
3835 * if the data is not already in cache, read from flash to cache
3836 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3837 int GLOB_FTL_Page_Read(u8 *data, u64 logical_addr)
3838 {
3839 u16 cache_item;
3840 int res = PASS;
3841
3842 nand_dbg_print(NAND_DBG_DEBUG, "GLOB_FTL_Page_Read - "
3843 "page_addr: %llu\n", logical_addr);
3844
3845 cache_item = FTL_Cache_If_Hit(logical_addr);
3846
3847 if (UNHIT_CACHE_ITEM == cache_item) {
3848 nand_dbg_print(NAND_DBG_DEBUG,
3849 "GLOB_FTL_Page_Read: Cache not hit\n");
3850 res = FTL_Cache_Write();
3851 if (ERR == FTL_Cache_Read(logical_addr))
3852 res = ERR;
3853 cache_item = Cache.LRU;
3854 }
3855
3856 FTL_Cache_Read_Page(data, logical_addr, cache_item);
3857
3858 return res;
3859 }
3860
3861 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3862 * Function: GLOB_FTL_Page_Write
3863 * Inputs: pointer to data
3864 * address of data (ADDRESSTYPE is LBA * Bytes/Page)
3865 * Outputs: PASS=0 / FAIL=1
3866 * Description: writes a page of data from RAM to the cache
3867 * if the data is not already in cache, write back the
3868 * least recently used block and read the addressed block
3869 * from flash to cache
3870 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3871 int GLOB_FTL_Page_Write(u8 *pData, u64 dwPageAddr)
3872 {
3873 u16 cache_blk;
3874 u32 *pbt = (u32 *)g_pBlockTable;
3875 int wResult = PASS;
3876
3877 nand_dbg_print(NAND_DBG_TRACE, "GLOB_FTL_Page_Write - "
3878 "dwPageAddr: %llu\n", dwPageAddr);
3879
3880 cache_blk = FTL_Cache_If_Hit(dwPageAddr);
3881
3882 if (UNHIT_CACHE_ITEM == cache_blk) {
3883 wResult = FTL_Cache_Write();
3884 if (IS_BAD_BLOCK(BLK_FROM_ADDR(dwPageAddr))) {
3885 wResult = FTL_Replace_Block(dwPageAddr);
3886 pbt[BLK_FROM_ADDR(dwPageAddr)] |= SPARE_BLOCK;
3887 if (wResult == FAIL)
3888 return FAIL;
3889 }
3890 if (ERR == FTL_Cache_Read(dwPageAddr))
3891 wResult = ERR;
3892 cache_blk = Cache.LRU;
3893 FTL_Cache_Write_Page(pData, dwPageAddr, cache_blk, 0);
3894 } else {
3895 #if CMD_DMA
3896 FTL_Cache_Write_Page(pData, dwPageAddr, cache_blk,
3897 LLD_CMD_FLAG_ORDER_BEFORE_REST);
3898 #else
3899 FTL_Cache_Write_Page(pData, dwPageAddr, cache_blk, 0);
3900 #endif
3901 }
3902
3903 return wResult;
3904 }
3905
3906 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3907 * Function: GLOB_FTL_Block_Erase
3908 * Inputs: address of block to erase (now in byte format, should change to
3909 * block format)
3910 * Outputs: PASS=0 / FAIL=1
3911 * Description: erases the specified block
3912 * increments the erase count
3913 * If erase count reaches its upper limit,call function to
3914 * do the ajustment as per the relative erase count values
3915 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
3916 int GLOB_FTL_Block_Erase(u64 blk_addr)
3917 {
3918 int status;
3919 u32 BlkIdx;
3920
3921 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
3922 __FILE__, __LINE__, __func__);
3923
3924 BlkIdx = (u32)(blk_addr >> DeviceInfo.nBitsInBlockDataSize);
3925
3926 if (BlkIdx < DeviceInfo.wSpectraStartBlock) {
3927 printk(KERN_ERR "GLOB_FTL_Block_Erase: "
3928 "This should never occur\n");
3929 return FAIL;
3930 }
3931
3932 #if CMD_DMA
3933 status = GLOB_LLD_Erase_Block_cdma(BlkIdx, LLD_CMD_FLAG_MODE_CDMA);
3934 if (status == FAIL)
3935 nand_dbg_print(NAND_DBG_WARN,
3936 "NAND Program fail in %s, Line %d, "
3937 "Function: %s, new Bad Block %d generated!\n",
3938 __FILE__, __LINE__, __func__, BlkIdx);
3939 #else
3940 status = GLOB_LLD_Erase_Block(BlkIdx);
3941 if (status == FAIL) {
3942 nand_dbg_print(NAND_DBG_WARN,
3943 "NAND Program fail in %s, Line %d, "
3944 "Function: %s, new Bad Block %d generated!\n",
3945 __FILE__, __LINE__, __func__, BlkIdx);
3946 return status;
3947 }
3948 #endif
3949
3950 if (DeviceInfo.MLCDevice) {
3951 g_pReadCounter[BlkIdx - DeviceInfo.wSpectraStartBlock] = 0;
3952 if (g_cBlockTableStatus != IN_PROGRESS_BLOCK_TABLE) {
3953 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
3954 FTL_Write_IN_Progress_Block_Table_Page();
3955 }
3956 }
3957
3958 g_pWearCounter[BlkIdx - DeviceInfo.wSpectraStartBlock]++;
3959
3960 #if CMD_DMA
3961 p_BTableChangesDelta =
3962 (struct BTableChangesDelta *)g_pBTDelta_Free;
3963 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
3964 p_BTableChangesDelta->ftl_cmd_cnt = ftl_cmd_cnt;
3965 p_BTableChangesDelta->WC_Index =
3966 BlkIdx - DeviceInfo.wSpectraStartBlock;
3967 p_BTableChangesDelta->WC_Entry_Value =
3968 g_pWearCounter[BlkIdx - DeviceInfo.wSpectraStartBlock];
3969 p_BTableChangesDelta->ValidFields = 0x30;
3970
3971 if (DeviceInfo.MLCDevice) {
3972 p_BTableChangesDelta =
3973 (struct BTableChangesDelta *)g_pBTDelta_Free;
3974 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
3975 p_BTableChangesDelta->ftl_cmd_cnt =
3976 ftl_cmd_cnt;
3977 p_BTableChangesDelta->RC_Index =
3978 BlkIdx - DeviceInfo.wSpectraStartBlock;
3979 p_BTableChangesDelta->RC_Entry_Value =
3980 g_pReadCounter[BlkIdx -
3981 DeviceInfo.wSpectraStartBlock];
3982 p_BTableChangesDelta->ValidFields = 0xC0;
3983 }
3984
3985 ftl_cmd_cnt++;
3986 #endif
3987
3988 if (g_pWearCounter[BlkIdx - DeviceInfo.wSpectraStartBlock] == 0xFE)
3989 FTL_Adjust_Relative_Erase_Count(BlkIdx);
3990
3991 return status;
3992 }
3993
3994
3995 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
3996 * Function: FTL_Adjust_Relative_Erase_Count
3997 * Inputs: index to block that was just incremented and is at the max
3998 * Outputs: PASS=0 / FAIL=1
3999 * Description: If any erase counts at MAX, adjusts erase count of every
4000 * block by substracting least worn
4001 * counter from counter value of every entry in wear table
4002 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
4003 static int FTL_Adjust_Relative_Erase_Count(u32 Index_of_MAX)
4004 {
4005 u8 wLeastWornCounter = MAX_BYTE_VALUE;
4006 u8 wWearCounter;
4007 u32 i, wWearIndex;
4008 u32 *pbt = (u32 *)g_pBlockTable;
4009 int wResult = PASS;
4010
4011 nand_dbg_print(NAND_DBG_TRACE, "%s, Line %d, Function: %s\n",
4012 __FILE__, __LINE__, __func__);
4013
4014 for (i = 0; i < DeviceInfo.wDataBlockNum; i++) {
4015 if (IS_BAD_BLOCK(i))
4016 continue;
4017 wWearIndex = (u32)(pbt[i] & (~BAD_BLOCK));
4018
4019 if ((wWearIndex - DeviceInfo.wSpectraStartBlock) < 0)
4020 printk(KERN_ERR "FTL_Adjust_Relative_Erase_Count:"
4021 "This should never occur\n");
4022 wWearCounter = g_pWearCounter[wWearIndex -
4023 DeviceInfo.wSpectraStartBlock];
4024 if (wWearCounter < wLeastWornCounter)
4025 wLeastWornCounter = wWearCounter;
4026 }
4027
4028 if (wLeastWornCounter == 0) {
4029 nand_dbg_print(NAND_DBG_WARN,
4030 "Adjusting Wear Levelling Counters: Special Case\n");
4031 g_pWearCounter[Index_of_MAX -
4032 DeviceInfo.wSpectraStartBlock]--;
4033 #if CMD_DMA
4034 p_BTableChangesDelta =
4035 (struct BTableChangesDelta *)g_pBTDelta_Free;
4036 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
4037 p_BTableChangesDelta->ftl_cmd_cnt = ftl_cmd_cnt;
4038 p_BTableChangesDelta->WC_Index =
4039 Index_of_MAX - DeviceInfo.wSpectraStartBlock;
4040 p_BTableChangesDelta->WC_Entry_Value =
4041 g_pWearCounter[Index_of_MAX -
4042 DeviceInfo.wSpectraStartBlock];
4043 p_BTableChangesDelta->ValidFields = 0x30;
4044 #endif
4045 FTL_Static_Wear_Leveling();
4046 } else {
4047 for (i = 0; i < DeviceInfo.wDataBlockNum; i++)
4048 if (!IS_BAD_BLOCK(i)) {
4049 wWearIndex = (u32)(pbt[i] & (~BAD_BLOCK));
4050 g_pWearCounter[wWearIndex -
4051 DeviceInfo.wSpectraStartBlock] =
4052 (u8)(g_pWearCounter
4053 [wWearIndex -
4054 DeviceInfo.wSpectraStartBlock] -
4055 wLeastWornCounter);
4056 #if CMD_DMA
4057 p_BTableChangesDelta =
4058 (struct BTableChangesDelta *)g_pBTDelta_Free;
4059 g_pBTDelta_Free +=
4060 sizeof(struct BTableChangesDelta);
4061
4062 p_BTableChangesDelta->ftl_cmd_cnt =
4063 ftl_cmd_cnt;
4064 p_BTableChangesDelta->WC_Index = wWearIndex -
4065 DeviceInfo.wSpectraStartBlock;
4066 p_BTableChangesDelta->WC_Entry_Value =
4067 g_pWearCounter[wWearIndex -
4068 DeviceInfo.wSpectraStartBlock];
4069 p_BTableChangesDelta->ValidFields = 0x30;
4070 #endif
4071 }
4072 }
4073
4074 return wResult;
4075 }
4076
4077 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
4078 * Function: FTL_Write_IN_Progress_Block_Table_Page
4079 * Inputs: None
4080 * Outputs: None
4081 * Description: It writes in-progress flag page to the page next to
4082 * block table
4083 ***********************************************************************/
4084 static int FTL_Write_IN_Progress_Block_Table_Page(void)
4085 {
4086 int wResult = PASS;
4087 u16 bt_pages;
4088 u16 dwIPFPageAddr;
4089 #if CMD_DMA
4090 #else
4091 u32 *pbt = (u32 *)g_pBlockTable;
4092 u32 wTempBlockTableIndex;
4093 #endif
4094
4095 nand_dbg_print(NAND_DBG_WARN, "%s, Line %d, Function: %s\n",
4096 __FILE__, __LINE__, __func__);
4097
4098 bt_pages = FTL_Get_Block_Table_Flash_Size_Pages();
4099
4100 dwIPFPageAddr = g_wBlockTableOffset + bt_pages;
4101
4102 nand_dbg_print(NAND_DBG_DEBUG, "Writing IPF at "
4103 "Block %d Page %d\n",
4104 g_wBlockTableIndex, dwIPFPageAddr);
4105
4106 #if CMD_DMA
4107 wResult = GLOB_LLD_Write_Page_Main_Spare_cdma(g_pIPF,
4108 g_wBlockTableIndex, dwIPFPageAddr, 1,
4109 LLD_CMD_FLAG_MODE_CDMA | LLD_CMD_FLAG_ORDER_BEFORE_REST);
4110 if (wResult == FAIL) {
4111 nand_dbg_print(NAND_DBG_WARN,
4112 "NAND Program fail in %s, Line %d, "
4113 "Function: %s, new Bad Block %d generated!\n",
4114 __FILE__, __LINE__, __func__,
4115 g_wBlockTableIndex);
4116 }
4117 g_wBlockTableOffset = dwIPFPageAddr + 1;
4118 p_BTableChangesDelta = (struct BTableChangesDelta *)g_pBTDelta_Free;
4119 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
4120 p_BTableChangesDelta->ftl_cmd_cnt = ftl_cmd_cnt;
4121 p_BTableChangesDelta->g_wBlockTableOffset = g_wBlockTableOffset;
4122 p_BTableChangesDelta->ValidFields = 0x01;
4123 ftl_cmd_cnt++;
4124 #else
4125 wResult = GLOB_LLD_Write_Page_Main_Spare(g_pIPF,
4126 g_wBlockTableIndex, dwIPFPageAddr, 1);
4127 if (wResult == FAIL) {
4128 nand_dbg_print(NAND_DBG_WARN,
4129 "NAND Program fail in %s, Line %d, "
4130 "Function: %s, new Bad Block %d generated!\n",
4131 __FILE__, __LINE__, __func__,
4132 (int)g_wBlockTableIndex);
4133 MARK_BLOCK_AS_BAD(pbt[BLOCK_TABLE_INDEX]);
4134 wTempBlockTableIndex = FTL_Replace_Block_Table();
4135 bt_block_changed = 1;
4136 if (BAD_BLOCK == wTempBlockTableIndex)
4137 return ERR;
4138 g_wBlockTableIndex = wTempBlockTableIndex;
4139 g_wBlockTableOffset = 0;
4140 /* Block table tag is '00'. Means it's used one */
4141 pbt[BLOCK_TABLE_INDEX] = g_wBlockTableIndex;
4142 return FAIL;
4143 }
4144 g_wBlockTableOffset = dwIPFPageAddr + 1;
4145 #endif
4146 return wResult;
4147 }
4148
4149 /*&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
4150 * Function: FTL_Read_Disturbance
4151 * Inputs: block address
4152 * Outputs: PASS=0 / FAIL=1
4153 * Description: used to handle read disturbance. Data in block that
4154 * reaches its read limit is moved to new block
4155 *&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&*/
4156 int FTL_Read_Disturbance(u32 blk_addr)
4157 {
4158 int wResult = FAIL;
4159 u32 *pbt = (u32 *) g_pBlockTable;
4160 u32 dwOldBlockAddr = blk_addr;
4161 u32 wBlockNum;
4162 u32 i;
4163 u32 wLeastReadCounter = 0xFFFF;
4164 u32 wLeastReadIndex = BAD_BLOCK;
4165 u32 wSpareBlockNum = 0;
4166 u32 wTempNode;
4167 u32 wReplacedNode;
4168 u8 *g_pTempBuf;
4169
4170 nand_dbg_print(NAND_DBG_DEBUG, "%s, Line %d, Function: %s\n",
4171 __FILE__, __LINE__, __func__);
4172
4173 #if CMD_DMA
4174 g_pTempBuf = cp_back_buf_copies[cp_back_buf_idx];
4175 cp_back_buf_idx++;
4176 if (cp_back_buf_idx > COPY_BACK_BUF_NUM) {
4177 printk(KERN_ERR "cp_back_buf_copies overflow! Exit."
4178 "Maybe too many pending commands in your CDMA chain.\n");
4179 return FAIL;
4180 }
4181 #else
4182 g_pTempBuf = tmp_buf_read_disturbance;
4183 #endif
4184
4185 wBlockNum = FTL_Get_Block_Index(blk_addr);
4186
4187 do {
4188 /* This is a bug.Here 'i' should be logical block number
4189 * and start from 1 (0 is reserved for block table).
4190 * Have fixed it. - Yunpeng 2008. 12. 19
4191 */
4192 for (i = 1; i < DeviceInfo.wDataBlockNum; i++) {
4193 if (IS_SPARE_BLOCK(i)) {
4194 u32 wPhysicalIndex =
4195 (u32)((~SPARE_BLOCK) & pbt[i]);
4196 if (g_pReadCounter[wPhysicalIndex -
4197 DeviceInfo.wSpectraStartBlock] <
4198 wLeastReadCounter) {
4199 wLeastReadCounter =
4200 g_pReadCounter[wPhysicalIndex -
4201 DeviceInfo.wSpectraStartBlock];
4202 wLeastReadIndex = i;
4203 }
4204 wSpareBlockNum++;
4205 }
4206 }
4207
4208 if (wSpareBlockNum <= NUM_FREE_BLOCKS_GATE) {
4209 wResult = GLOB_FTL_Garbage_Collection();
4210 if (PASS == wResult)
4211 continue;
4212 else
4213 break;
4214 } else {
4215 wTempNode = (u32)(DISCARD_BLOCK | pbt[wBlockNum]);
4216 wReplacedNode = (u32)((~SPARE_BLOCK) &
4217 pbt[wLeastReadIndex]);
4218 #if CMD_DMA
4219 pbt[wBlockNum] = wReplacedNode;
4220 pbt[wLeastReadIndex] = wTempNode;
4221 p_BTableChangesDelta =
4222 (struct BTableChangesDelta *)g_pBTDelta_Free;
4223 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
4224
4225 p_BTableChangesDelta->ftl_cmd_cnt =
4226 ftl_cmd_cnt;
4227 p_BTableChangesDelta->BT_Index = wBlockNum;
4228 p_BTableChangesDelta->BT_Entry_Value = pbt[wBlockNum];
4229 p_BTableChangesDelta->ValidFields = 0x0C;
4230
4231 p_BTableChangesDelta =
4232 (struct BTableChangesDelta *)g_pBTDelta_Free;
4233 g_pBTDelta_Free += sizeof(struct BTableChangesDelta);
4234
4235 p_BTableChangesDelta->ftl_cmd_cnt =
4236 ftl_cmd_cnt;
4237 p_BTableChangesDelta->BT_Index = wLeastReadIndex;
4238 p_BTableChangesDelta->BT_Entry_Value =
4239 pbt[wLeastReadIndex];
4240 p_BTableChangesDelta->ValidFields = 0x0C;
4241
4242 wResult = GLOB_LLD_Read_Page_Main_cdma(g_pTempBuf,
4243 dwOldBlockAddr, 0, DeviceInfo.wPagesPerBlock,
4244 LLD_CMD_FLAG_MODE_CDMA);
4245 if (wResult == FAIL)
4246 return wResult;
4247
4248 ftl_cmd_cnt++;
4249
4250 if (wResult != FAIL) {
4251 if (FAIL == GLOB_LLD_Write_Page_Main_cdma(
4252 g_pTempBuf, pbt[wBlockNum], 0,
4253 DeviceInfo.wPagesPerBlock)) {
4254 nand_dbg_print(NAND_DBG_WARN,
4255 "NAND Program fail in "
4256 "%s, Line %d, Function: %s, "
4257 "new Bad Block %d "
4258 "generated!\n",
4259 __FILE__, __LINE__, __func__,
4260 (int)pbt[wBlockNum]);
4261 wResult = FAIL;
4262 MARK_BLOCK_AS_BAD(pbt[wBlockNum]);
4263 }
4264 ftl_cmd_cnt++;
4265 }
4266 #else
4267 wResult = GLOB_LLD_Read_Page_Main(g_pTempBuf,
4268 dwOldBlockAddr, 0, DeviceInfo.wPagesPerBlock);
4269 if (wResult == FAIL)
4270 return wResult;
4271
4272 if (wResult != FAIL) {
4273 /* This is a bug. At this time, pbt[wBlockNum]
4274 is still the physical address of
4275 discard block, and should not be write.
4276 Have fixed it as below.
4277 -- Yunpeng 2008.12.19
4278 */
4279 wResult = GLOB_LLD_Write_Page_Main(g_pTempBuf,
4280 wReplacedNode, 0,
4281 DeviceInfo.wPagesPerBlock);
4282 if (wResult == FAIL) {
4283 nand_dbg_print(NAND_DBG_WARN,
4284 "NAND Program fail in "
4285 "%s, Line %d, Function: %s, "
4286 "new Bad Block %d "
4287 "generated!\n",
4288 __FILE__, __LINE__, __func__,
4289 (int)wReplacedNode);
4290 MARK_BLOCK_AS_BAD(wReplacedNode);
4291 } else {
4292 pbt[wBlockNum] = wReplacedNode;
4293 pbt[wLeastReadIndex] = wTempNode;
4294 }
4295 }
4296
4297 if ((wResult == PASS) && (g_cBlockTableStatus !=
4298 IN_PROGRESS_BLOCK_TABLE)) {
4299 g_cBlockTableStatus = IN_PROGRESS_BLOCK_TABLE;
4300 FTL_Write_IN_Progress_Block_Table_Page();
4301 }
4302 #endif
4303 }
4304 } while (wResult != PASS)
4305 ;
4306
4307 #if CMD_DMA
4308 /* ... */
4309 #endif
4310
4311 return wResult;
4312 }
4313
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree