1
2
3
4
5
6
7
8
9#include <linux/kernel.h>
10#include <linux/mtd/nand.h>
11#include <linux/module.h>
12#include <linux/sizes.h>
13#include "sm_common.h"
14
15static struct nand_ecclayout nand_oob_sm = {
16 .eccbytes = 6,
17 .eccpos = {8, 9, 10, 13, 14, 15},
18 .oobfree = {
19 {.offset = 0 , .length = 4},
20 {.offset = 6 , .length = 2},
21 {.offset = 11, .length = 2}
22 }
23};
24
25
26
27
28
29
30
31static struct nand_ecclayout nand_oob_sm_small = {
32 .eccbytes = 3,
33 .eccpos = {0, 1, 2},
34 .oobfree = {
35 {.offset = 3 , .length = 2},
36 {.offset = 6 , .length = 2},
37 }
38};
39
40
41static int sm_block_markbad(struct mtd_info *mtd, loff_t ofs)
42{
43 struct mtd_oob_ops ops;
44 struct sm_oob oob;
45 int ret, error = 0;
46
47 memset(&oob, -1, SM_OOB_SIZE);
48 oob.block_status = 0x0F;
49
50
51
52 ops.mode = MTD_OPS_PLACE_OOB;
53 ops.ooboffs = 0;
54 ops.ooblen = mtd->oobsize;
55 ops.oobbuf = (void *)&oob;
56 ops.datbuf = NULL;
57
58
59 ret = mtd_write_oob(mtd, ofs, &ops);
60 if (ret < 0 || ops.oobretlen != SM_OOB_SIZE) {
61 printk(KERN_NOTICE
62 "sm_common: can't mark sector at %i as bad\n",
63 (int)ofs);
64 error = -EIO;
65 } else
66 mtd->ecc_stats.badblocks++;
67
68 return error;
69}
70
71static struct nand_flash_dev nand_smartmedia_flash_ids[] = {
72 LEGACY_ID_NAND("SmartMedia 2MiB 3,3V ROM", 0x5d, 2, SZ_8K, NAND_ROM),
73 LEGACY_ID_NAND("SmartMedia 4MiB 3,3V", 0xe3, 4, SZ_8K, 0),
74 LEGACY_ID_NAND("SmartMedia 4MiB 3,3/5V", 0xe5, 4, SZ_8K, 0),
75 LEGACY_ID_NAND("SmartMedia 4MiB 5V", 0x6b, 4, SZ_8K, 0),
76 LEGACY_ID_NAND("SmartMedia 4MiB 3,3V ROM", 0xd5, 4, SZ_8K, NAND_ROM),
77 LEGACY_ID_NAND("SmartMedia 8MiB 3,3V", 0xe6, 8, SZ_8K, 0),
78 LEGACY_ID_NAND("SmartMedia 8MiB 3,3V ROM", 0xd6, 8, SZ_8K, NAND_ROM),
79 LEGACY_ID_NAND("SmartMedia 16MiB 3,3V", 0x73, 16, SZ_16K, 0),
80 LEGACY_ID_NAND("SmartMedia 16MiB 3,3V ROM", 0x57, 16, SZ_16K, NAND_ROM),
81 LEGACY_ID_NAND("SmartMedia 32MiB 3,3V", 0x75, 32, SZ_16K, 0),
82 LEGACY_ID_NAND("SmartMedia 32MiB 3,3V ROM", 0x58, 32, SZ_16K, NAND_ROM),
83 LEGACY_ID_NAND("SmartMedia 64MiB 3,3V", 0x76, 64, SZ_16K, 0),
84 LEGACY_ID_NAND("SmartMedia 64MiB 3,3V ROM", 0xd9, 64, SZ_16K, NAND_ROM),
85 LEGACY_ID_NAND("SmartMedia 128MiB 3,3V", 0x79, 128, SZ_16K, 0),
86 LEGACY_ID_NAND("SmartMedia 128MiB 3,3V ROM", 0xda, 128, SZ_16K, NAND_ROM),
87 LEGACY_ID_NAND("SmartMedia 256MiB 3, 3V", 0x71, 256, SZ_16K, 0),
88 LEGACY_ID_NAND("SmartMedia 256MiB 3,3V ROM", 0x5b, 256, SZ_16K, NAND_ROM),
89 {NULL}
90};
91
92static struct nand_flash_dev nand_xd_flash_ids[] = {
93 LEGACY_ID_NAND("xD 16MiB 3,3V", 0x73, 16, SZ_16K, 0),
94 LEGACY_ID_NAND("xD 32MiB 3,3V", 0x75, 32, SZ_16K, 0),
95 LEGACY_ID_NAND("xD 64MiB 3,3V", 0x76, 64, SZ_16K, 0),
96 LEGACY_ID_NAND("xD 128MiB 3,3V", 0x79, 128, SZ_16K, 0),
97 LEGACY_ID_NAND("xD 256MiB 3,3V", 0x71, 256, SZ_16K, NAND_BROKEN_XD),
98 LEGACY_ID_NAND("xD 512MiB 3,3V", 0xdc, 512, SZ_16K, NAND_BROKEN_XD),
99 LEGACY_ID_NAND("xD 1GiB 3,3V", 0xd3, 1024, SZ_16K, NAND_BROKEN_XD),
100 LEGACY_ID_NAND("xD 2GiB 3,3V", 0xd5, 2048, SZ_16K, NAND_BROKEN_XD),
101 {NULL}
102};
103
104int sm_register_device(struct mtd_info *mtd, int smartmedia)
105{
106 struct nand_chip *chip = mtd->priv;
107 int ret;
108
109 chip->options |= NAND_SKIP_BBTSCAN;
110
111
112 ret = nand_scan_ident(mtd, 1, smartmedia ?
113 nand_smartmedia_flash_ids : nand_xd_flash_ids);
114
115 if (ret)
116 return ret;
117
118
119 chip->badblockpos = 0x05;
120 chip->badblockbits = 7;
121 chip->block_markbad = sm_block_markbad;
122
123
124 if (mtd->writesize == SM_SECTOR_SIZE)
125 chip->ecc.layout = &nand_oob_sm;
126 else if (mtd->writesize == SM_SMALL_PAGE)
127 chip->ecc.layout = &nand_oob_sm_small;
128 else
129 return -ENODEV;
130
131 ret = nand_scan_tail(mtd);
132
133 if (ret)
134 return ret;
135
136 return mtd_device_register(mtd, NULL, 0);
137}
138EXPORT_SYMBOL_GPL(sm_register_device);
139
140MODULE_LICENSE("GPL");
141MODULE_AUTHOR("Maxim Levitsky <maximlevitsky@gmail.com>");
142MODULE_DESCRIPTION("Common SmartMedia/xD functions");
143