arch/arm/plat-samsung/dev-nand.c

   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  */
  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
  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 }