1
2
3
4
5
6
7
8#include <common.h>
9#include <nand.h>
10#include <errno.h>
11#include <linux/mtd/concat.h>
12
13#ifndef CONFIG_SYS_NAND_BASE_LIST
14#define CONFIG_SYS_NAND_BASE_LIST { CONFIG_SYS_NAND_BASE }
15#endif
16
17int nand_curr_device = -1;
18
19static struct mtd_info *nand_info[CONFIG_SYS_MAX_NAND_DEVICE];
20
21#ifndef CONFIG_SYS_NAND_SELF_INIT
22static struct nand_chip nand_chip[CONFIG_SYS_MAX_NAND_DEVICE];
23static ulong base_address[CONFIG_SYS_MAX_NAND_DEVICE] = CONFIG_SYS_NAND_BASE_LIST;
24#endif
25
26static char dev_name[CONFIG_SYS_MAX_NAND_DEVICE][8];
27
28static unsigned long total_nand_size;
29
30struct mtd_info *get_nand_dev_by_index(int dev)
31{
32 if (dev < 0 || dev >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[dev] ||
33 !nand_info[dev]->name)
34 return NULL;
35
36 return nand_info[dev];
37}
38
39int nand_mtd_to_devnum(struct mtd_info *mtd)
40{
41 int i;
42
43 for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) {
44 if (mtd && get_nand_dev_by_index(i) == mtd)
45 return i;
46 }
47
48 return -ENODEV;
49}
50
51
52int nand_register(int devnum, struct mtd_info *mtd)
53{
54 if (devnum >= CONFIG_SYS_MAX_NAND_DEVICE)
55 return -EINVAL;
56
57 nand_info[devnum] = mtd;
58
59 sprintf(dev_name[devnum], "nand%d", devnum);
60 mtd->name = dev_name[devnum];
61
62#ifdef CONFIG_MTD_DEVICE
63
64
65
66
67 add_mtd_device(mtd);
68#endif
69
70 total_nand_size += mtd->size / 1024;
71
72 if (nand_curr_device == -1)
73 nand_curr_device = devnum;
74
75 return 0;
76}
77
78#ifndef CONFIG_SYS_NAND_SELF_INIT
79static void nand_init_chip(int i)
80{
81 struct nand_chip *nand = &nand_chip[i];
82 struct mtd_info *mtd = nand_to_mtd(nand);
83 ulong base_addr = base_address[i];
84 int maxchips = CONFIG_SYS_NAND_MAX_CHIPS;
85
86 if (maxchips < 1)
87 maxchips = 1;
88
89 nand->IO_ADDR_R = nand->IO_ADDR_W = (void __iomem *)base_addr;
90
91 if (board_nand_init(nand))
92 return;
93
94 if (nand_scan(mtd, maxchips))
95 return;
96
97 nand_register(i, mtd);
98}
99#endif
100
101#ifdef CONFIG_MTD_CONCAT
102static void create_mtd_concat(void)
103{
104 struct mtd_info *nand_info_list[CONFIG_SYS_MAX_NAND_DEVICE];
105 int nand_devices_found = 0;
106 int i;
107
108 for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) {
109 struct mtd_info *mtd = get_nand_dev_by_index(i);
110 if (mtd != NULL) {
111 nand_info_list[nand_devices_found] = mtd;
112 nand_devices_found++;
113 }
114 }
115 if (nand_devices_found > 1) {
116 struct mtd_info *mtd;
117 char c_mtd_name[16];
118
119
120
121
122 sprintf(c_mtd_name, "nand%d", nand_devices_found);
123 mtd = mtd_concat_create(nand_info_list, nand_devices_found,
124 c_mtd_name);
125
126 if (mtd == NULL)
127 return;
128
129 nand_register(nand_devices_found, mtd);
130 }
131
132 return;
133}
134#else
135static void create_mtd_concat(void)
136{
137}
138#endif
139
140unsigned long nand_size(void)
141{
142 return total_nand_size;
143}
144
145void nand_init(void)
146{
147 static int initialized;
148
149
150
151
152
153 if (initialized)
154 return;
155 initialized = 1;
156
157#ifdef CONFIG_SYS_NAND_SELF_INIT
158 board_nand_init();
159#else
160 int i;
161
162 for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++)
163 nand_init_chip(i);
164#endif
165
166#ifdef CONFIG_SYS_NAND_SELECT_DEVICE
167
168
169
170 board_nand_select_device(mtd_to_nand(get_nand_dev_by_index(nand_curr_device)),
171 nand_curr_device);
172#endif
173
174 create_mtd_concat();
175}
176