Use the local BBM helpers to check for and mark bad blocks.

Signed-off-by: Lee Jones <lee.jo...@linaro.org>
---
 drivers/mtd/nand/stm_nand_bch.c | 51 +++++++++++++++++++++++++++++++++++++++++
 1 file changed, 51 insertions(+)

diff --git a/drivers/mtd/nand/stm_nand_bch.c b/drivers/mtd/nand/stm_nand_bch.c
index 55f4a4c..38658b8 100644
--- a/drivers/mtd/nand/stm_nand_bch.c
+++ b/drivers/mtd/nand/stm_nand_bch.c
@@ -1218,6 +1218,55 @@ static int flex_do_write_ops(struct nandi_controller 
*nandi,
        return 0;
 }
 
+static int bch_mtd_block_isbad(struct mtd_info *mtd, loff_t offs)
+{
+       struct nand_chip *chip = mtd->priv;
+       struct nandi_controller *nandi = chip->priv;
+
+       uint32_t block;
+
+       /* Check for invalid offset */
+       if (offs > mtd->size)
+               return -EINVAL;
+
+       block = offs >> nandi->block_shift;
+
+       /* Protect blocks reserved for BBTs */
+       if (block >= (nandi->blocks_per_device - NAND_IBBT_NBLOCKS))
+               return 1;
+
+       return bbt_is_block_bad(nandi->info.bbt_info.bbt, block);
+}
+
+static int bch_mtd_block_markbad(struct mtd_info *mtd, loff_t offs)
+{
+       struct nand_chip *chip = mtd->priv;
+       struct nandi_controller *nandi = chip->priv;
+
+       uint32_t block;
+       int ret;
+
+       /* Is block already considered bad? (will also catch invalid offsets) */
+       ret = mtd_block_isbad(mtd, offs);
+       if (ret < 0)
+               return ret;
+       if (ret == 1)
+               return 0;
+
+       /* Mark bad */
+       block = offs >> nandi->block_shift;
+       bbt_set_block_mark(nandi->info.bbt_info.bbt, block, BBT_MARK_BAD_WEAR);
+
+       /* Update BBTs, incrementing bbt_vers */
+       nand_get_device(mtd, FL_WRITING);
+       ret = bch_update_bbts(nandi, &nandi->info.bbt_info,
+                             NAND_IBBT_UPDATE_BOTH,
+                             nandi->info.bbt_info.bbt_vers[0] + 1);
+       nand_release_device(mtd);
+
+       return ret;
+}
+
 static int bch_mtd_erase(struct mtd_info *mtd, struct erase_info *instr)
 {
        struct nand_chip *chip = mtd->priv;
@@ -1405,6 +1454,8 @@ static void nandi_set_mtd_defaults(struct 
nandi_controller *nandi,
        mtd->subpage_sft = 0;
 
        mtd->_erase = bch_mtd_erase;
+       mtd->_block_isbad = bch_mtd_block_isbad;
+       mtd->_block_markbad = bch_mtd_block_markbad;
 
        mtd->_point = NULL;
        mtd->_unpoint = NULL;
-- 
1.8.3.2

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to