target/linux/ramips/patches-4.4/0040-nand-add-mtk-nand-hack-hook.patch

   1 From 61e17c2f864698033f4661e1fc7ba63d4d982491 Mon Sep 17 00:00:00 2001
   2 From: John Crispin <blogic@openwrt.org>
   3 Date: Mon, 7 Dec 2015 17:21:55 +0100
   4 Subject: [PATCH 40/53] nand: add mtk-nand hack/hook
   5
   6 Signed-off-by: John Crispin <blogic@openwrt.org>
   7 ---
   8  drivers/mtd/nand/mtk_nand.c         |   34 ++++++++++++++++++++++++++++++----
   9  drivers/mtd/nand/nand_base.c        |    9 ++++++++-
  10  drivers/mtd/nand/nand_device_list.h |    2 ++
  11  include/linux/mtd/nand.h            |    4 ++++
  12  4 files changed, 44 insertions(+), 5 deletions(-)
  13
  14 --- a/drivers/mtd/nand/mtk_nand.c
  15 +++ b/drivers/mtd/nand/mtk_nand.c
  16 @@ -110,6 +110,10 @@ int part_num = NUM_PARTITIONS;
  17  int manu_id;
  18  int dev_id;
  19
  20 +/* this constant was taken from linux/nand/nand.h v 3.14
  21 + * in later versions it seems it was removed in order to save a bit of space
  22 + */
  23 +#define NAND_MAX_OOBSIZE 774
  24  static u8 local_oob_buf[NAND_MAX_OOBSIZE];
  25
  26  static u8 nand_badblock_offset = 0;
  27 @@ -348,7 +352,7 @@ mtk_nand_check_bch_error(struct mtd_info
  28                 if (0xF == u4ErrNum) {
  29                         mtd->ecc_stats.failed++;
  30                         bRet = false;
  31 -                       //printk(KERN_ERR"UnCorrectable at PageAddr=%d\n", u4PageAddr);
  32 +                       printk(KERN_ERR"mtk_nand: UnCorrectable at PageAddr=%d\n", u4PageAddr);
  33                 } else {
  34                         for (i = 0; i < ((u4ErrNum + 1) >> 1); ++i) {
  35                                 au4ErrBitLoc[i] = DRV_Reg32(ECC_DECEL0_REG32 + i);
  36 @@ -1422,7 +1426,7 @@ mtk_nand_erase_hw(struct mtd_info *mtd,
  37  {
  38         struct nand_chip *chip = (struct nand_chip *)mtd->priv;
  39
  40 -       chip->erase_cmd(mtd, page);
  41 +       chip->erase(mtd, page);
  42
  43         return chip->waitfunc(mtd, chip);
  44  }
  45 @@ -2094,8 +2098,8 @@ mtk_nand_probe(struct platform_device *p
  46         nand_chip->write_page = mtk_nand_write_page;
  47         nand_chip->ecc.write_oob = mtk_nand_write_oob;
  48         nand_chip->block_markbad = mtk_nand_block_markbad;   // need to add nand_get_device()/nand_release_device().
  49 -       //      nand_chip->erase = mtk_nand_erase;
  50 -       //    nand_chip->read_page = mtk_nand_read_page;
  51 +       nand_chip->erase_mtk = mtk_nand_erase;
  52 +       nand_chip->read_page = mtk_nand_read_page;
  53         nand_chip->ecc.read_oob = mtk_nand_read_oob;
  54         nand_chip->block_bad = mtk_nand_block_bad;
  55
  56 @@ -2175,6 +2179,21 @@ mtk_nand_probe(struct platform_device *p
  57         nand_chip->pagemask = (nand_chip->chipsize >> nand_chip->page_shift) - 1;
  58         nand_chip->phys_erase_shift = ffs(mtd->erasesize) - 1;
  59         nand_chip->chip_shift = ffs(nand_chip->chipsize) - 1;//0x1C;//ffs(nand_chip->chipsize) - 1;
  60 +
  61 +       /* allocate buffers or call select_chip here or a bit earlier*/
  62 +       {
  63 +               struct nand_buffers *nbuf = kzalloc(sizeof(*nbuf) + mtd->writesize + mtd->oobsize * 3, GFP_KERNEL);
  64 +               if (!nbuf) {
  65 +                       return -ENOMEM;
  66 +               }
  67 +               nbuf->ecccalc = (uint8_t *)(nbuf + 1);
  68 +               nbuf->ecccode = nbuf->ecccalc + mtd->oobsize;
  69 +               nbuf->databuf = nbuf->ecccode + mtd->oobsize;
  70 +
  71 +               nand_chip->buffers = nbuf;
  72 +               nand_chip->options |= NAND_OWN_BUFFERS;
  73 +       }
  74 +
  75         nand_chip->oob_poi = nand_chip->buffers->databuf + mtd->writesize;
  76         nand_chip->badblockpos = 0;
  77
  78 @@ -2251,6 +2270,9 @@ out:
  79         MSG(INIT, "[NFI] mtk_nand_probe fail, err = %d!\n", err);
  80         nand_release(mtd);
  81         platform_set_drvdata(pdev, NULL);
  82 +       if ( NULL != nand_chip->buffers) {
  83 +               kfree(nand_chip->buffers);
  84 +       }
  85         kfree(host);
  86         nand_disable_clock();
  87         return err;
  88 @@ -2261,8 +2283,12 @@ mtk_nand_remove(struct platform_device *
  89  {
  90         struct mtk_nand_host *host = platform_get_drvdata(pdev);
  91         struct mtd_info *mtd = &host->mtd;
  92 +       struct nand_chip *nand_chip = &host->nand_chip;
  93
  94         nand_release(mtd);
  95 +       if ( NULL != nand_chip->buffers) {
  96 +               kfree(nand_chip->buffers);
  97 +       }
  98         kfree(host);
  99         nand_disable_clock();
 100
 101 --- a/drivers/mtd/nand/nand_base.c
 102 +++ b/drivers/mtd/nand/nand_base.c
 103 @@ -1727,6 +1727,9 @@ static int nand_do_read_ops(struct mtd_i
 104                                                  __func__, buf);
 105
 106  read_retry:
 107 +#ifdef CONFIG_MTK_MTD_NAND
 108 +                       ret = chip->read_page(mtd, chip, bufpoi, page);
 109 +#else
 110                         chip->cmdfunc(mtd, NAND_CMD_READ0, 0x00, page);
 111
 112                         /*
 113 @@ -1745,6 +1748,7 @@ read_retry:
 114                         else
 115                                 ret = chip->ecc.read_page(mtd, chip, bufpoi,
 116                                                           oob_required, page);
 117 +#endif /* CONFIG_MTK_MTD_NAND */
 118                         if (ret < 0) {
 119                                 if (use_bufpoi)
 120                                         /* Invalidate page cache */
 121 @@ -2938,8 +2942,11 @@ int nand_erase_nand(struct mtd_info *mtd
 122                 if (page <= chip->pagebuf && chip->pagebuf <
 123                     (page + pages_per_block))
 124                         chip->pagebuf = -1;
 125 -
 126 +#ifdef CONFIG_MTK_MTD_NAND
 127 +               status = chip->erase_mtk(mtd, page & chip->pagemask);
 128 +#else
 129                 status = chip->erase(mtd, page & chip->pagemask);
 130 +#endif /* CONFIG_MTK_MTD_NAND */
 131
 132                 /*
 133                  * See if operation failed and additional status checks are
 134 --- a/drivers/mtd/nand/nand_device_list.h
 135 +++ b/drivers/mtd/nand/nand_device_list.h
 136 @@ -43,6 +43,8 @@ static const flashdev_info gen_FlashTabl
 137         {0xADBC, 0x905554, 5, 16, 512, 128, 2048, 64, 0x10801011, "H9DA4GH4JJAMC", 0},
 138      {0x01F1, 0x801D01, 4, 8, 128, 128, 2048, 64, 0x30C77fff, "S34ML01G100TF", 0},
 139      {0x92F1, 0x8095FF, 4, 8, 128, 128, 2048, 64, 0x30C77fff, "F59L1G81A", 0},
 140 +       {0xC8DA, 0x909544, 5, 8, 256, 128, 2048, 64, 0x30C77fff, "F59L2G81A", 0},
 141 +       {0xC8DC, 0x909554, 5, 8, 512, 128, 2048, 64, 0x30C77fff, "F59L4G81A", 0},
 142         {0xECD3, 0x519558, 5, 8, 1024, 128, 2048, 64, 0x44333, "K9K8G8000", 0},
 143      {0xC2F1, 0x801DC2, 4, 8, 128, 128, 2048, 64, 0x30C77fff, "MX30LF1G08AA", 0},
 144      {0x98D3, 0x902676, 5, 8, 1024, 256, 4096, 224, 0x00C25332, "TC58NVG3S0F", 0},
 145 --- a/include/linux/mtd/nand.h
 146 +++ b/include/linux/mtd/nand.h
 147 @@ -665,6 +665,10 @@ struct nand_chip {
 148         int (*write_page)(struct mtd_info *mtd, struct nand_chip *chip,
 149                         uint32_t offset, int data_len, const uint8_t *buf,
 150                         int oob_required, int page, int cached, int raw);
 151 +#ifdef CONFIG_MTK_MTD_NAND
 152 +       int (*read_page)(struct mtd_info *mtd, struct nand_chip *chip, u8 *buf, int page);
 153 +       int (*erase_mtk)(struct mtd_info *mtd, int page);
 154 +#endif /* CONFIG_MTK_MTD_NAND */
 155         int (*onfi_set_features)(struct mtd_info *mtd, struct nand_chip *chip,
 156                         int feature_addr, uint8_t *subfeature_para);
 157         int (*onfi_get_features)(struct mtd_info *mtd, struct nand_chip *chip,