LXR uboot/drivers/mtd/nand/nand.c

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