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