mtd: nand: Move Hynix specific init/detection logic in nand_hynix.c
[platform/kernel/linux-rpi.git] / drivers / mtd / nand / nand_hynix.c
1 /*
2  * Copyright (C) 2017 Free Electrons
3  * Copyright (C) 2017 NextThing Co
4  *
5  * Author: Boris Brezillon <boris.brezillon@free-electrons.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  */
17
18 #include <linux/mtd/nand.h>
19
20 static void hynix_nand_decode_id(struct nand_chip *chip)
21 {
22         struct mtd_info *mtd = nand_to_mtd(chip);
23
24         /* Hynix MLC   (6 byte ID): Hynix H27UBG8T2B (p.22) */
25         if (chip->id.len == 6 && !nand_is_slc(chip)) {
26                 u8 tmp, extid = chip->id.data[3];
27
28                 /* Extract pagesize */
29                 mtd->writesize = 2048 << (extid & 0x03);
30                 extid >>= 2;
31
32                 /* Extract oobsize */
33                 switch (((extid >> 2) & 0x4) | (extid & 0x3)) {
34                 case 0:
35                         mtd->oobsize = 128;
36                         break;
37                 case 1:
38                         mtd->oobsize = 224;
39                         break;
40                 case 2:
41                         mtd->oobsize = 448;
42                         break;
43                 case 3:
44                         mtd->oobsize = 64;
45                         break;
46                 case 4:
47                         mtd->oobsize = 32;
48                         break;
49                 case 5:
50                         mtd->oobsize = 16;
51                         break;
52                 default:
53                         mtd->oobsize = 640;
54                         break;
55                 }
56
57                 /* Extract blocksize */
58                 extid >>= 2;
59                 tmp = ((extid >> 1) & 0x04) | (extid & 0x03);
60                 if (tmp < 0x03)
61                         mtd->erasesize = (128 * 1024) << tmp;
62                 else if (tmp == 0x03)
63                         mtd->erasesize = 768 * 1024;
64                 else
65                         mtd->erasesize = (64 * 1024) << tmp;
66         } else {
67                 nand_decode_ext_id(chip);
68         }
69 }
70
71 static int hynix_nand_init(struct nand_chip *chip)
72 {
73         if (!nand_is_slc(chip))
74                 chip->bbt_options |= NAND_BBT_SCANLASTPAGE;
75         else
76                 chip->bbt_options |= NAND_BBT_SCAN2NDPAGE;
77
78         return 0;
79 }
80
81 const struct nand_manufacturer_ops hynix_nand_manuf_ops = {
82         .detect = hynix_nand_decode_id,
83         .init = hynix_nand_init,
84 };