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