projects / qemu.git / blame
| Commit | Line | Data |
|---|---|---|
| 3e3d5815 AZ |
1 | /* |
| 2 | * Calculate Error-correcting Codes. Used by NAND Flash controllers | |
| 3 | * (not by NAND chips). | |
| 4 | * | |
| 5 | * Copyright (c) 2006 Openedhand Ltd. | |
| 6 | * Written by Andrzej Zaborowski <[email protected]> | |
| 7 | * | |
| 8 | * This code is licensed under the GNU GPL v2. | |
| 9 | */ | |
| 10 | ||
| 9ff6755b | 11 | #include "vl.h" |
| 3e3d5815 AZ |
12 | |
| 13 | /* | |
| 14 | * Pre-calculated 256-way 1 byte column parity. Table borrowed from Linux. | |
| 15 | */ | |
| 16 | static const uint8_t nand_ecc_precalc_table[] = { | |
| 17 | 0x00, 0x55, 0x56, 0x03, 0x59, 0x0c, 0x0f, 0x5a, | |
| 18 | 0x5a, 0x0f, 0x0c, 0x59, 0x03, 0x56, 0x55, 0x00, | |
| 19 | 0x65, 0x30, 0x33, 0x66, 0x3c, 0x69, 0x6a, 0x3f, | |
| 20 | 0x3f, 0x6a, 0x69, 0x3c, 0x66, 0x33, 0x30, 0x65, | |
| 21 | 0x66, 0x33, 0x30, 0x65, 0x3f, 0x6a, 0x69, 0x3c, | |
| 22 | 0x3c, 0x69, 0x6a, 0x3f, 0x65, 0x30, 0x33, 0x66, | |
| 23 | 0x03, 0x56, 0x55, 0x00, 0x5a, 0x0f, 0x0c, 0x59, | |
| 24 | 0x59, 0x0c, 0x0f, 0x5a, 0x00, 0x55, 0x56, 0x03, | |
| 25 | 0x69, 0x3c, 0x3f, 0x6a, 0x30, 0x65, 0x66, 0x33, | |
| 26 | 0x33, 0x66, 0x65, 0x30, 0x6a, 0x3f, 0x3c, 0x69, | |
| 27 | 0x0c, 0x59, 0x5a, 0x0f, 0x55, 0x00, 0x03, 0x56, | |
| 28 | 0x56, 0x03, 0x00, 0x55, 0x0f, 0x5a, 0x59, 0x0c, | |
| 29 | 0x0f, 0x5a, 0x59, 0x0c, 0x56, 0x03, 0x00, 0x55, | |
| 30 | 0x55, 0x00, 0x03, 0x56, 0x0c, 0x59, 0x5a, 0x0f, | |
| 31 | 0x6a, 0x3f, 0x3c, 0x69, 0x33, 0x66, 0x65, 0x30, | |
| 32 | 0x30, 0x65, 0x66, 0x33, 0x69, 0x3c, 0x3f, 0x6a, | |
| 33 | 0x6a, 0x3f, 0x3c, 0x69, 0x33, 0x66, 0x65, 0x30, | |
| 34 | 0x30, 0x65, 0x66, 0x33, 0x69, 0x3c, 0x3f, 0x6a, | |
| 35 | 0x0f, 0x5a, 0x59, 0x0c, 0x56, 0x03, 0x00, 0x55, | |
| 36 | 0x55, 0x00, 0x03, 0x56, 0x0c, 0x59, 0x5a, 0x0f, | |
| 37 | 0x0c, 0x59, 0x5a, 0x0f, 0x55, 0x00, 0x03, 0x56, | |
| 38 | 0x56, 0x03, 0x00, 0x55, 0x0f, 0x5a, 0x59, 0x0c, | |
| 39 | 0x69, 0x3c, 0x3f, 0x6a, 0x30, 0x65, 0x66, 0x33, | |
| 40 | 0x33, 0x66, 0x65, 0x30, 0x6a, 0x3f, 0x3c, 0x69, | |
| 41 | 0x03, 0x56, 0x55, 0x00, 0x5a, 0x0f, 0x0c, 0x59, | |
| 42 | 0x59, 0x0c, 0x0f, 0x5a, 0x00, 0x55, 0x56, 0x03, | |
| 43 | 0x66, 0x33, 0x30, 0x65, 0x3f, 0x6a, 0x69, 0x3c, | |
| 44 | 0x3c, 0x69, 0x6a, 0x3f, 0x65, 0x30, 0x33, 0x66, | |
| 45 | 0x65, 0x30, 0x33, 0x66, 0x3c, 0x69, 0x6a, 0x3f, | |
| 46 | 0x3f, 0x6a, 0x69, 0x3c, 0x66, 0x33, 0x30, 0x65, | |
| 47 | 0x00, 0x55, 0x56, 0x03, 0x59, 0x0c, 0x0f, 0x5a, | |
| 48 | 0x5a, 0x0f, 0x0c, 0x59, 0x03, 0x56, 0x55, 0x00, | |
| 49 | }; | |
| 50 | ||
| 51 | /* Update ECC parity count. */ | |
| 9ff6755b | 52 | uint8_t ecc_digest(struct ecc_state_s *s, uint8_t sample) |
| 3e3d5815 AZ |
53 | { |
| 54 | uint8_t idx = nand_ecc_precalc_table[sample]; | |
| 55 | ||
| 56 | s->cp ^= idx & 0x3f; | |
| 57 | if (idx & 0x40) { | |
| 58 | s->lp[0] ^= ~s->count; | |
| 59 | s->lp[1] ^= s->count; | |
| 60 | } | |
| 61 | s->count ++; | |
| 62 | ||
| 63 | return sample; | |
| 64 | } | |
| 65 | ||
| 66 | /* Reinitialise the counters. */ | |
| 9ff6755b | 67 | void ecc_reset(struct ecc_state_s *s) |
| 3e3d5815 AZ |
68 | { |
| 69 | s->lp[0] = 0x0000; | |
| 70 | s->lp[1] = 0x0000; | |
| 71 | s->cp = 0x00; | |
| 72 | s->count = 0; | |
| 73 | } | |
| aa941b94 AZ |
74 | |
| 75 | /* Save/restore */ | |
| 9ff6755b | 76 | void ecc_put(QEMUFile *f, struct ecc_state_s *s) |
| aa941b94 AZ |
77 | { |
| 78 | qemu_put_8s(f, &s->cp); | |
| 79 | qemu_put_be16s(f, &s->lp[0]); | |
| 80 | qemu_put_be16s(f, &s->lp[1]); | |
| 81 | qemu_put_be16s(f, &s->count); | |
| 82 | } | |
| 83 | ||
| 9ff6755b | 84 | void ecc_get(QEMUFile *f, struct ecc_state_s *s) |
| aa941b94 AZ |
85 | { |
| 86 | qemu_get_8s(f, &s->cp); | |
| 87 | qemu_get_be16s(f, &s->lp[0]); | |
| 88 | qemu_get_be16s(f, &s->lp[1]); | |
| 89 | qemu_get_be16s(f, &s->count); | |
| 90 | } |