Akinobu Mita | 7126bd8 | 2009-10-22 16:53:33 +0900 | [diff] [blame] | 1 | #include <linux/kernel.h> |
| 2 | #include <linux/module.h> |
| 3 | #include <linux/list.h> |
Akinobu Mita | 7126bd8 | 2009-10-22 16:53:33 +0900 | [diff] [blame] | 4 | #include <linux/random.h> |
| 5 | #include <linux/string.h> |
| 6 | #include <linux/bitops.h> |
| 7 | #include <linux/jiffies.h> |
| 8 | #include <linux/mtd/nand_ecc.h> |
| 9 | |
| 10 | #if defined(CONFIG_MTD_NAND) || defined(CONFIG_MTD_NAND_MODULE) |
| 11 | |
| 12 | static void inject_single_bit_error(void *data, size_t size) |
| 13 | { |
| 14 | unsigned long offset = random32() % (size * BITS_PER_BYTE); |
| 15 | |
| 16 | __change_bit(offset, data); |
| 17 | } |
| 18 | |
| 19 | static unsigned char data[512]; |
| 20 | static unsigned char error_data[512]; |
| 21 | |
| 22 | static int nand_ecc_test(const size_t size) |
| 23 | { |
| 24 | unsigned char code[3]; |
| 25 | unsigned char error_code[3]; |
| 26 | char testname[30]; |
| 27 | |
| 28 | BUG_ON(sizeof(data) < size); |
| 29 | |
| 30 | sprintf(testname, "nand-ecc-%zu", size); |
| 31 | |
| 32 | get_random_bytes(data, size); |
| 33 | |
| 34 | memcpy(error_data, data, size); |
| 35 | inject_single_bit_error(error_data, size); |
| 36 | |
| 37 | __nand_calculate_ecc(data, size, code); |
| 38 | __nand_calculate_ecc(error_data, size, error_code); |
| 39 | __nand_correct_data(error_data, code, error_code, size); |
| 40 | |
| 41 | if (!memcmp(data, error_data, size)) { |
| 42 | printk(KERN_INFO "mtd_nandecctest: ok - %s\n", testname); |
| 43 | return 0; |
| 44 | } |
| 45 | |
| 46 | printk(KERN_ERR "mtd_nandecctest: not ok - %s\n", testname); |
| 47 | |
| 48 | printk(KERN_DEBUG "hexdump of data:\n"); |
| 49 | print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 16, 4, |
| 50 | data, size, false); |
| 51 | printk(KERN_DEBUG "hexdump of error data:\n"); |
| 52 | print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET, 16, 4, |
| 53 | error_data, size, false); |
| 54 | |
| 55 | return -1; |
| 56 | } |
| 57 | |
| 58 | #else |
| 59 | |
| 60 | static int nand_ecc_test(const size_t size) |
| 61 | { |
| 62 | return 0; |
| 63 | } |
| 64 | |
| 65 | #endif |
| 66 | |
| 67 | static int __init ecc_test_init(void) |
| 68 | { |
| 69 | srandom32(jiffies); |
| 70 | |
| 71 | nand_ecc_test(256); |
| 72 | nand_ecc_test(512); |
| 73 | |
| 74 | return 0; |
| 75 | } |
| 76 | |
| 77 | static void __exit ecc_test_exit(void) |
| 78 | { |
| 79 | } |
| 80 | |
| 81 | module_init(ecc_test_init); |
| 82 | module_exit(ecc_test_exit); |
| 83 | |
| 84 | MODULE_DESCRIPTION("NAND ECC function test module"); |
| 85 | MODULE_AUTHOR("Akinobu Mita"); |
| 86 | MODULE_LICENSE("GPL"); |