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/gfp.h>
10 #include <linux/kernel.h>
11 #include <linux/platform_device.h>
12
13 #include <linux/mtd/mtd.h>
14 #include <linux/mtd/partitions.h>
15
16 #include <mach/map.h>
17 #include <plat/devs.h>
18 #include <plat/nand.h>
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);
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 */
s3c_nand_copy_set(struct s3c2410_nand_set * set)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
62 if (set->nr_map && set->nr_chips) {
63 size = sizeof(int) * set->nr_chips;
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
s3c_nand_set_platdata(struct s3c2410_platform_nand * nand)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);
118 if (ret) {
119 printk(KERN_ERR "%s: failed to copy set %d\n",
120 __func__, i);
121 return;
122 }
123 to++;
124 }
125 }
126
127 s3c_device_nand.dev.platform_data = npd;
128 }
129