1 #include <linux/kernel.h>
2 #include <linux/module.h>
3 #include <linux/list.h>
4 #include <linux/random.h>
5 #include <linux/string.h>
6 #include <linux/bitops.h>
7 #include <linux/slab.h>
20 #if defined(CONFIG_MTD_NAND) || defined(CONFIG_MTD_NAND_MODULE)
22 struct nand_ecc_test {
24 void (*prepare)(
void *,
void *,
void *,
void *,
const size_t);
25 int (*verify)(
void *,
void *,
void *,
const size_t);
33 #ifdef __LITTLE_ENDIAN
34 #define __change_bit_le(nr, addr) __change_bit(nr, addr)
35 #elif defined(__BIG_ENDIAN)
36 #define __change_bit_le(nr, addr) \
37 __change_bit((nr) ^ ((BITS_PER_LONG - 1) & ~0x7), addr)
39 #error "Unknown byte order"
42 static void single_bit_error_data(
void *error_data,
void *correct_data,
47 memcpy(error_data, correct_data, size);
48 __change_bit_le(offset, error_data);
51 static void double_bit_error_data(
void *error_data,
void *correct_data,
59 }
while (offset[0] == offset[1]);
61 memcpy(error_data, correct_data, size);
63 __change_bit_le(offset[0], error_data);
64 __change_bit_le(offset[1], error_data);
67 static unsigned int random_ecc_bit(
size_t size)
76 while (offset == 16 || offset == 17)
83 static void single_bit_error_ecc(
void *error_ecc,
void *correct_ecc,
86 unsigned int offset = random_ecc_bit(size);
88 memcpy(error_ecc, correct_ecc, 3);
89 __change_bit_le(offset, error_ecc);
92 static void double_bit_error_ecc(
void *error_ecc,
void *correct_ecc,
95 unsigned int offset[2];
97 offset[0] = random_ecc_bit(size);
99 offset[1] = random_ecc_bit(size);
100 }
while (offset[0] == offset[1]);
102 memcpy(error_ecc, correct_ecc, 3);
103 __change_bit_le(offset[0], error_ecc);
104 __change_bit_le(offset[1], error_ecc);
107 static void no_bit_error(
void *error_data,
void *error_ecc,
108 void *correct_data,
void *correct_ecc,
const size_t size)
110 memcpy(error_data, correct_data, size);
111 memcpy(error_ecc, correct_ecc, 3);
114 static int no_bit_error_verify(
void *error_data,
void *error_ecc,
115 void *correct_data,
const size_t size)
117 unsigned char calc_ecc[3];
122 if (ret == 0 && !
memcmp(correct_data, error_data, size))
128 static void single_bit_error_in_data(
void *error_data,
void *error_ecc,
129 void *correct_data,
void *correct_ecc,
const size_t size)
131 single_bit_error_data(error_data, correct_data, size);
132 memcpy(error_ecc, correct_ecc, 3);
135 static void single_bit_error_in_ecc(
void *error_data,
void *error_ecc,
136 void *correct_data,
void *correct_ecc,
const size_t size)
138 memcpy(error_data, correct_data, size);
139 single_bit_error_ecc(error_ecc, correct_ecc, size);
142 static int single_bit_error_correct(
void *error_data,
void *error_ecc,
143 void *correct_data,
const size_t size)
145 unsigned char calc_ecc[3];
150 if (ret == 1 && !
memcmp(correct_data, error_data, size))
156 static void double_bit_error_in_data(
void *error_data,
void *error_ecc,
157 void *correct_data,
void *correct_ecc,
const size_t size)
159 double_bit_error_data(error_data, correct_data, size);
160 memcpy(error_ecc, correct_ecc, 3);
163 static void single_bit_error_in_data_and_ecc(
void *error_data,
void *error_ecc,
164 void *correct_data,
void *correct_ecc,
const size_t size)
166 single_bit_error_data(error_data, correct_data, size);
167 single_bit_error_ecc(error_ecc, correct_ecc, size);
170 static void double_bit_error_in_ecc(
void *error_data,
void *error_ecc,
171 void *correct_data,
void *correct_ecc,
const size_t size)
173 memcpy(error_data, correct_data, size);
174 double_bit_error_ecc(error_ecc, correct_ecc, size);
177 static int double_bit_error_detect(
void *error_data,
void *error_ecc,
178 void *correct_data,
const size_t size)
180 unsigned char calc_ecc[3];
186 return (ret == -1) ? 0 : -
EINVAL;
189 static const struct nand_ecc_test nand_ecc_test[] = {
191 .name =
"no-bit-error",
192 .prepare = no_bit_error,
193 .verify = no_bit_error_verify,
196 .name =
"single-bit-error-in-data-correct",
197 .prepare = single_bit_error_in_data,
198 .verify = single_bit_error_correct,
201 .name =
"single-bit-error-in-ecc-correct",
202 .prepare = single_bit_error_in_ecc,
203 .verify = single_bit_error_correct,
206 .name =
"double-bit-error-in-data-detect",
207 .prepare = double_bit_error_in_data,
208 .verify = double_bit_error_detect,
211 .name =
"single-bit-error-in-data-and-ecc-detect",
212 .prepare = single_bit_error_in_data_and_ecc,
213 .verify = double_bit_error_detect,
216 .name =
"double-bit-error-in-ecc-detect",
217 .prepare = double_bit_error_in_ecc,
218 .verify = double_bit_error_detect,
222 static void dump_data_ecc(
void *error_data,
void *error_ecc,
void *correct_data,
223 void *correct_ecc,
const size_t size)
225 pr_info(
"hexdump of error data:\n");
227 error_data, size,
false);
228 print_hex_dump(
KERN_INFO,
"hexdump of error ecc: ",
231 pr_info(
"hexdump of correct data:\n");
233 correct_data, size,
false);
234 print_hex_dump(
KERN_INFO,
"hexdump of correct ecc: ",
238 static int nand_ecc_test_run(
const size_t size)
252 if (!error_data || !error_ecc || !correct_data || !correct_ecc) {
260 for (i = 0; i <
ARRAY_SIZE(nand_ecc_test); i++) {
261 nand_ecc_test[
i].prepare(error_data, error_ecc,
262 correct_data, correct_ecc, size);
263 err = nand_ecc_test[
i].verify(error_data, error_ecc,
267 pr_err(
"mtd_nandecctest: not ok - %s-%zd\n",
268 nand_ecc_test[i].
name, size);
269 dump_data_ecc(error_data, error_ecc,
270 correct_data, correct_ecc, size);
273 pr_info(
"mtd_nandecctest: ok - %s-%zd\n",
274 nand_ecc_test[i].
name, size);
287 static int nand_ecc_test_run(
const size_t size)
294 static int __init ecc_test_init(
void)
298 err = nand_ecc_test_run(256);
302 return nand_ecc_test_run(512);
305 static void __exit ecc_test_exit(
void)