mtd: Workaround wrong write protect status on some xD cards
[deliverable/linux.git] / drivers / mtd / nand / sm_common.c
CommitLineData
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
13static 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
29static 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
39static 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
70int 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}
103EXPORT_SYMBOL_GPL(sm_register_device);
104
105MODULE_LICENSE("GPL");
106MODULE_AUTHOR("Maxim Levitsky <maximlevitsky@gmail.com>");
107MODULE_DESCRIPTION("Common SmartMedia/xD functions");
This page took 0.027849 seconds and 5 git commands to generate.