Commit | Line | Data |
---|---|---|
9fc51a37 ML |
1 | /* |
2 | * Copyright © 2009 - Maxim Levitsky | |
3 | * Common routines & support for xD format | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify | |
6 | * it under the terms of the GNU General Public License version 2 as | |
7 | * published by the Free Software Foundation. | |
8 | */ | |
9 | #include <linux/kernel.h> | |
10 | #include <linux/mtd/nand.h> | |
11 | #include "sm_common.h" | |
12 | ||
13 | static struct nand_ecclayout nand_oob_sm = { | |
14 | .eccbytes = 6, | |
15 | .eccpos = {8, 9, 10, 13, 14, 15}, | |
16 | .oobfree = { | |
17 | {.offset = 0 , .length = 4}, /* reserved */ | |
18 | {.offset = 6 , .length = 2}, /* LBA1 */ | |
19 | {.offset = 11, .length = 2} /* LBA2 */ | |
20 | } | |
21 | }; | |
22 | ||
23 | /* NOTE: This layout is is not compatabable with SmartMedia, */ | |
24 | /* because the 256 byte devices have page depenent oob layout */ | |
25 | /* However it does preserve the bad block markers */ | |
26 | /* If you use smftl, it will bypass this and work correctly */ | |
27 | /* If you not, then you break SmartMedia compliance anyway */ | |
28 | ||
29 | static struct nand_ecclayout nand_oob_sm_small = { | |
30 | .eccbytes = 3, | |
31 | .eccpos = {0, 1, 2}, | |
32 | .oobfree = { | |
33 | {.offset = 3 , .length = 2}, /* reserved */ | |
34 | {.offset = 6 , .length = 2}, /* LBA1 */ | |
35 | } | |
36 | }; | |
37 | ||
38 | ||
39 | static int sm_block_markbad(struct mtd_info *mtd, loff_t ofs) | |
40 | { | |
41 | struct mtd_oob_ops ops; | |
42 | struct sm_oob oob; | |
43 | int ret, error = 0; | |
44 | ||
45 | memset(&oob, -1, SM_OOB_SIZE); | |
46 | oob.block_status = 0x0F; | |
47 | ||
48 | /* As long as this function is called on erase block boundaries | |
49 | it will work correctly for 256 byte nand */ | |
50 | ops.mode = MTD_OOB_PLACE; | |
51 | ops.ooboffs = 0; | |
52 | ops.ooblen = mtd->oobsize; | |
53 | ops.oobbuf = (void *)&oob; | |
54 | ops.datbuf = NULL; | |
55 | ||
56 | ||
57 | ret = mtd->write_oob(mtd, ofs, &ops); | |
58 | if (ret < 0 || ops.oobretlen != SM_OOB_SIZE) { | |
59 | printk(KERN_NOTICE | |
60 | "sm_common: can't mark sector at %i as bad\n", | |
61 | (int)ofs); | |
62 | error = -EIO; | |
63 | } else | |
64 | mtd->ecc_stats.badblocks++; | |
65 | ||
66 | return error; | |
67 | } | |
68 | ||
69 | ||
70 | int sm_register_device(struct mtd_info *mtd) | |
71 | { | |
72 | struct nand_chip *chip = (struct nand_chip *)mtd->priv; | |
73 | int ret; | |
74 | ||
75 | chip->options |= NAND_SKIP_BBTSCAN | NAND_SMARTMEDIA; | |
76 | ||
77 | /* Scan for card properties */ | |
5e81e88a | 78 | ret = nand_scan_ident(mtd, 1, NULL); |
9fc51a37 ML |
79 | |
80 | if (ret) | |
81 | return ret; | |
82 | ||
83 | /* Bad block marker postion */ | |
84 | chip->badblockpos = 0x05; | |
85 | chip->badblockbits = 7; | |
86 | chip->block_markbad = sm_block_markbad; | |
87 | ||
88 | /* ECC layout */ | |
89 | if (mtd->writesize == SM_SECTOR_SIZE) | |
90 | chip->ecc.layout = &nand_oob_sm; | |
91 | else if (mtd->writesize == SM_SMALL_PAGE) | |
92 | chip->ecc.layout = &nand_oob_sm_small; | |
93 | else | |
94 | return -ENODEV; | |
95 | ||
96 | ret = nand_scan_tail(mtd); | |
97 | ||
98 | if (ret) | |
99 | return ret; | |
100 | ||
101 | return add_mtd_device(mtd); | |
102 | } | |
103 | EXPORT_SYMBOL_GPL(sm_register_device); | |
104 | ||
105 | MODULE_LICENSE("GPL"); | |
106 | MODULE_AUTHOR("Maxim Levitsky <maximlevitsky@gmail.com>"); | |
107 | MODULE_DESCRIPTION("Common SmartMedia/xD functions"); |