drivers/mtd/nand/raw/nand.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * (C) Copyright 2005
   4  * 2N Telekomunikace, a.s. <www.2n.cz>
   5  * Ladislav Michl <michl@2n.cz>
   6  */
   7
   8 #include <common.h>
   9 #include <nand.h>
  10 #include <errno.h>
  11 #include <linux/mtd/concat.h>
  12 #include <linux/mtd/rawnand.h>
  13
  14 #ifndef CFG_SYS_NAND_BASE_LIST
  15 #define CFG_SYS_NAND_BASE_LIST { CFG_SYS_NAND_BASE }
  16 #endif
  17
  18 int nand_curr_device = -1;
  19
  20 static struct mtd_info *nand_info[CONFIG_SYS_MAX_NAND_DEVICE];
  21
  22 #if !CONFIG_IS_ENABLED(SYS_NAND_SELF_INIT)
  23 static struct nand_chip nand_chip[CONFIG_SYS_MAX_NAND_DEVICE];
  24 static ulong base_address[CONFIG_SYS_MAX_NAND_DEVICE] = CFG_SYS_NAND_BASE_LIST;
  25 #endif
  26
  27 static char dev_name[CONFIG_SYS_MAX_NAND_DEVICE][8];
  28
  29 static unsigned long total_nand_size; /* in kiB */
  30
  31 struct mtd_info *get_nand_dev_by_index(int dev)
  32 {
  33         if (dev < 0 || dev >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[dev] ||
  34             !nand_info[dev]->name)
  35                 return NULL;
  36
  37         return nand_info[dev];
  38 }
  39
  40 int nand_mtd_to_devnum(struct mtd_info *mtd)
  41 {
  42         int i;
  43
  44         for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) {
  45                 if (mtd && get_nand_dev_by_index(i) == mtd)
  46                         return i;
  47         }
  48
  49         return -ENODEV;
  50 }
  51
  52 /* Register an initialized NAND mtd device with the U-Boot NAND command. */
  53 int nand_register(int devnum, struct mtd_info *mtd)
  54 {
  55         if (devnum >= CONFIG_SYS_MAX_NAND_DEVICE)
  56                 return -EINVAL;
  57
  58         nand_info[devnum] = mtd;
  59
  60         sprintf(dev_name[devnum], "nand%d", devnum);
  61         mtd->name = dev_name[devnum];
  62
  63 #ifdef CONFIG_MTD
  64         /*
  65          * Add MTD device so that we can reference it later
  66          * via the mtdcore infrastructure (e.g. ubi).
  67          */
  68         add_mtd_device(mtd);
  69 #endif
  70
  71         total_nand_size += mtd->size / 1024;
  72
  73         if (nand_curr_device == -1)
  74                 nand_curr_device = devnum;
  75
  76         return 0;
  77 }
  78
  79 #if !CONFIG_IS_ENABLED(SYS_NAND_SELF_INIT)
  80 static void nand_init_chip(int i)
  81 {
  82         struct nand_chip *nand = &nand_chip[i];
  83         struct mtd_info *mtd = nand_to_mtd(nand);
  84         ulong base_addr = base_address[i];
  85         int maxchips = CONFIG_SYS_NAND_MAX_CHIPS;
  86
  87         if (maxchips < 1)
  88                 maxchips = 1;
  89
  90         nand->IO_ADDR_R = nand->IO_ADDR_W = (void  __iomem *)base_addr;
  91
  92         if (board_nand_init(nand))
  93                 return;
  94
  95         if (nand_scan(mtd, maxchips))
  96                 return;
  97
  98         nand_register(i, mtd);
  99 }
 100 #endif
 101
 102 #ifdef CONFIG_MTD_CONCAT
 103 static void create_mtd_concat(void)
 104 {
 105         struct mtd_info *nand_info_list[CONFIG_SYS_MAX_NAND_DEVICE];
 106         int nand_devices_found = 0;
 107         int i;
 108
 109         for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) {
 110                 struct mtd_info *mtd = get_nand_dev_by_index(i);
 111                 if (mtd != NULL) {
 112                         nand_info_list[nand_devices_found] = mtd;
 113                         nand_devices_found++;
 114                 }
 115         }
 116         if (nand_devices_found > 1) {
 117                 struct mtd_info *mtd;
 118                 char c_mtd_name[16];
 119
 120                 /*
 121                  * We detected multiple devices. Concatenate them together.
 122                  */
 123                 sprintf(c_mtd_name, "nand%d", nand_devices_found);
 124                 mtd = mtd_concat_create(nand_info_list, nand_devices_found,
 125                                         c_mtd_name);
 126
 127                 if (mtd == NULL)
 128                         return;
 129
 130                 nand_register(nand_devices_found, mtd);
 131         }
 132
 133         return;
 134 }
 135 #else
 136 static void create_mtd_concat(void)
 137 {
 138 }
 139 #endif
 140
 141 unsigned long nand_size(void)
 142 {
 143         return total_nand_size;
 144 }
 145
 146 void nand_init(void)
 147 {
 148         static int initialized;
 149
 150         /*
 151          * Avoid initializing NAND Flash multiple times,
 152          * otherwise it will calculate a wrong total size.
 153          */
 154         if (initialized)
 155                 return;
 156         initialized = 1;
 157
 158 #if CONFIG_IS_ENABLED(SYS_NAND_SELF_INIT)
 159         board_nand_init();
 160 #else
 161         int i;
 162
 163         for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++)
 164                 nand_init_chip(i);
 165 #endif
 166
 167 #ifdef CONFIG_SYS_NAND_SELECT_DEVICE
 168         /*
 169          * Select the chip in the board/cpu specific driver
 170          */
 171         board_nand_select_device(mtd_to_nand(get_nand_dev_by_index(nand_curr_device)),
 172                                  nand_curr_device);
 173 #endif
 174
 175         create_mtd_concat();
 176 }