Commit | Line | Data |
---|---|---|
14077ea6 PK |
1 | /* |
2 | * S3C series device definition for nand device | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License version 2 as | |
6 | * published by the Free Software Foundation. | |
7 | */ | |
8 | ||
9 | #include <linux/kernel.h> | |
10 | #include <linux/platform_device.h> | |
11 | ||
2a3a1804 BD |
12 | #include <linux/mtd/mtd.h> |
13 | #include <linux/mtd/partitions.h> | |
14 | ||
14077ea6 PK |
15 | #include <mach/map.h> |
16 | #include <plat/devs.h> | |
2a3a1804 | 17 | #include <plat/nand.h> |
14077ea6 PK |
18 | |
19 | static struct resource s3c_nand_resource[] = { | |
20 | [0] = { | |
21 | .start = S3C_PA_NAND, | |
22 | .end = S3C_PA_NAND + SZ_1M, | |
23 | .flags = IORESOURCE_MEM, | |
24 | } | |
25 | }; | |
26 | ||
27 | struct platform_device s3c_device_nand = { | |
28 | .name = "s3c2410-nand", | |
29 | .id = -1, | |
30 | .num_resources = ARRAY_SIZE(s3c_nand_resource), | |
31 | .resource = s3c_nand_resource, | |
32 | }; | |
33 | ||
34 | EXPORT_SYMBOL(s3c_device_nand); | |
2a3a1804 BD |
35 | |
36 | /** | |
37 | * s3c_nand_copy_set() - copy nand set data | |
38 | * @set: The new structure, directly copied from the old. | |
39 | * | |
40 | * Copy all the fields from the NAND set field from what is probably __initdata | |
41 | * to new kernel memory. The code returns 0 if the copy happened correctly or | |
42 | * an error code for the calling function to display. | |
43 | * | |
44 | * Note, we currently do not try and look to see if we've already copied the | |
45 | * data in a previous set. | |
46 | */ | |
47 | static int __init s3c_nand_copy_set(struct s3c2410_nand_set *set) | |
48 | { | |
49 | void *ptr; | |
50 | int size; | |
51 | ||
52 | size = sizeof(struct mtd_partition) * set->nr_partitions; | |
53 | if (size) { | |
54 | ptr = kmemdup(set->partitions, size, GFP_KERNEL); | |
55 | set->partitions = ptr; | |
56 | ||
57 | if (!ptr) | |
58 | return -ENOMEM; | |
59 | } | |
60 | ||
9b96918a RL |
61 | if (set->nr_map && set->nr_chips) { |
62 | size = sizeof(int) * set->nr_chips; | |
2a3a1804 BD |
63 | ptr = kmemdup(set->nr_map, size, GFP_KERNEL); |
64 | set->nr_map = ptr; | |
65 | ||
66 | if (!ptr) | |
67 | return -ENOMEM; | |
68 | } | |
69 | ||
70 | if (set->ecc_layout) { | |
71 | ptr = kmemdup(set->ecc_layout, | |
72 | sizeof(struct nand_ecclayout), GFP_KERNEL); | |
73 | set->ecc_layout = ptr; | |
74 | ||
75 | if (!ptr) | |
76 | return -ENOMEM; | |
77 | } | |
78 | ||
79 | return 0; | |
80 | } | |
81 | ||
82 | void __init s3c_nand_set_platdata(struct s3c2410_platform_nand *nand) | |
83 | { | |
84 | struct s3c2410_platform_nand *npd; | |
85 | int size; | |
86 | int ret; | |
87 | ||
88 | /* note, if we get a failure in allocation, we simply drop out of the | |
89 | * function. If there is so little memory available at initialisation | |
90 | * time then there is little chance the system is going to run. | |
91 | */ | |
92 | ||
93 | npd = kmemdup(nand, sizeof(struct s3c2410_platform_nand), GFP_KERNEL); | |
94 | if (!npd) { | |
95 | printk(KERN_ERR "%s: failed copying platform data\n", __func__); | |
96 | return; | |
97 | } | |
98 | ||
99 | /* now see if we need to copy any of the nand set data */ | |
100 | ||
101 | size = sizeof(struct s3c2410_nand_set) * npd->nr_sets; | |
102 | if (size) { | |
103 | struct s3c2410_nand_set *from = npd->sets; | |
104 | struct s3c2410_nand_set *to; | |
105 | int i; | |
106 | ||
107 | to = kmemdup(from, size, GFP_KERNEL); | |
108 | npd->sets = to; /* set, even if we failed */ | |
109 | ||
110 | if (!to) { | |
111 | printk(KERN_ERR "%s: no memory for sets\n", __func__); | |
112 | return; | |
113 | } | |
114 | ||
115 | for (i = 0; i < npd->nr_sets; i++) { | |
116 | ret = s3c_nand_copy_set(to); | |
2b542a13 | 117 | if (ret) { |
2a3a1804 BD |
118 | printk(KERN_ERR "%s: failed to copy set %d\n", |
119 | __func__, i); | |
120 | return; | |
121 | } | |
122 | to++; | |
123 | } | |
124 | } | |
2b542a13 BD |
125 | |
126 | s3c_device_nand.dev.platform_data = npd; | |
2a3a1804 BD |
127 | } |
128 | ||
129 | EXPORT_SYMBOL_GPL(s3c_nand_set_platdata); |