1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
/**
* @file
*
* @ingroup lpc32xx_nand_mlc
*
* @brief lpc32xx_mlc_read_blocks() implementation.
*/
/*
* Copyright (c) 2010 embedded brains GmbH. All rights reserved.
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.org/license/LICENSE.
*/
#include <bsp/nand-mlc.h>
#include <string.h>
static rtems_status_code read_page(
uint32_t first_page_of_block,
uint32_t page,
uint32_t page_data [MLC_LARGE_DATA_WORD_COUNT],
uint32_t page_spare [MLC_LARGE_SPARE_WORD_COUNT]
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
uint32_t page_index = first_page_of_block + page;
bool possible_bad_page = page == 0 || page == 1;
if (possible_bad_page) {
memset(page_spare, 0, MLC_LARGE_SPARE_SIZE);
}
sc = lpc32xx_mlc_read_page(page_index, page_data, page_spare, NULL);
if (possible_bad_page && lpc32xx_mlc_is_bad_page(page_spare)) {
return RTEMS_UNSATISFIED;
} else if (sc == RTEMS_SUCCESSFUL) {
return RTEMS_SUCCESSFUL;
} else {
return sc;
}
}
rtems_status_code lpc32xx_mlc_read_blocks(
uint32_t block_begin,
uint32_t block_end,
lpc32xx_mlc_read_process process,
void *process_arg,
uint32_t page_buffer_0 [MLC_LARGE_DATA_WORD_COUNT],
uint32_t page_buffer_1 [MLC_LARGE_DATA_WORD_COUNT]
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
uint32_t page_spare_0 [MLC_LARGE_SPARE_WORD_COUNT];
uint32_t page_spare_1 [MLC_LARGE_SPARE_WORD_COUNT];
uint32_t pages_per_block = lpc32xx_mlc_pages_per_block();
uint32_t page_size = lpc32xx_mlc_page_size();
uint32_t block = 0;
uint32_t first_page_of_block = block_begin * pages_per_block;
for (
block = block_begin;
block != block_end;
++block, first_page_of_block += pages_per_block
) {
uint32_t page = 0;
bool done = false;
sc = read_page(first_page_of_block, 0, page_buffer_0, page_spare_0);
if (sc == RTEMS_UNSATISFIED) {
continue;
} else if (sc != RTEMS_SUCCESSFUL) {
goto done;
}
sc = read_page(first_page_of_block, 1, page_buffer_1, page_spare_1);
if (sc == RTEMS_UNSATISFIED) {
continue;
} else if (sc != RTEMS_SUCCESSFUL) {
goto done;
}
done = (*process)(
process_arg,
first_page_of_block + 0,
page_size,
page_buffer_0,
page_spare_0
);
if (done) {
goto done;
}
done = (*process)(
process_arg,
first_page_of_block + 1,
page_size,
page_buffer_1,
page_spare_1
);
if (done) {
goto done;
}
for (page = 2; page < pages_per_block; ++page) {
sc = read_page(first_page_of_block, page, page_buffer_1, page_spare_1);
if (sc != RTEMS_SUCCESSFUL) {
goto done;
}
done = (*process)(
process_arg,
first_page_of_block + page,
page_size,
page_buffer_1,
page_spare_1
);
if (done) {
goto done;
}
}
}
done:
return sc;
}
|