mirror of
https://github.com/hanwckf/immortalwrt-mt798x.git
synced 2025-01-10 03:09:08 +08:00
200 lines
6.3 KiB
Diff
200 lines
6.3 KiB
Diff
Index: a/drivers/mtd/nand/spi/Makefile
|
|
===================================================================
|
|
--- a/drivers/mtd/nand/spi/Makefile
|
|
+++ b/drivers/mtd/nand/spi/Makefile
|
|
@@ -1,3 +1,3 @@
|
|
# SPDX-License-Identifier: GPL-2.0
|
|
-spinand-objs := core.o gigadevice.o macronix.o micron.o paragon.o toshiba.o winbond.o foresee.o etron.o esmt.o
|
|
+spinand-objs := core.o gigadevice.o macronix.o micron.o paragon.o toshiba.o winbond.o foresee.o etron.o esmt.o fmsh.o
|
|
obj-$(CONFIG_MTD_SPI_NAND) += spinand.o
|
|
Index: a/drivers/mtd/nand/spi/core.c
|
|
===================================================================
|
|
--- a/drivers/mtd/nand/spi/core.c
|
|
+++ b/drivers/mtd/nand/spi/core.c
|
|
@@ -763,6 +763,7 @@ static const struct spinand_manufacturer *spinand_manufacturers[] = {
|
|
&winbond_spinand_manufacturer,
|
|
&foresee_spinand_manufacturer,
|
|
&esmt_c8_spinand_manufacturer,
|
|
+ &fmsh_spinand_manufacturer,
|
|
};
|
|
|
|
static int spinand_manufacturer_match(struct spinand_device *spinand,
|
|
--- /dev/null
|
|
+++ b/drivers/mtd/nand/spi/fmsh.c
|
|
@@ -0,0 +1,166 @@
|
|
+// SPDX-License-Identifier: GPL-2.0
|
|
+/*
|
|
+ * Copyright (c) 2020-2021 Rockchip Electronics Co., Ltd
|
|
+ *
|
|
+ * Authors:
|
|
+ * Dingqiang Lin <jon.lin@rock-chips.com>
|
|
+ */
|
|
+
|
|
+#include <linux/device.h>
|
|
+#include <linux/kernel.h>
|
|
+#include <linux/mtd/spinand.h>
|
|
+
|
|
+#define SPINAND_MFR_FMSH 0xA1
|
|
+
|
|
+static SPINAND_OP_VARIANTS(read_cache_variants,
|
|
+ SPINAND_PAGE_READ_FROM_CACHE_QUADIO_OP(0, 2, NULL, 0),
|
|
+ SPINAND_PAGE_READ_FROM_CACHE_X4_OP(0, 1, NULL, 0),
|
|
+ SPINAND_PAGE_READ_FROM_CACHE_DUALIO_OP(0, 1, NULL, 0),
|
|
+ SPINAND_PAGE_READ_FROM_CACHE_X2_OP(0, 1, NULL, 0),
|
|
+ SPINAND_PAGE_READ_FROM_CACHE_OP(true, 0, 1, NULL, 0),
|
|
+ SPINAND_PAGE_READ_FROM_CACHE_OP(false, 0, 1, NULL, 0));
|
|
+
|
|
+static SPINAND_OP_VARIANTS(write_cache_variants,
|
|
+ SPINAND_PROG_LOAD_X4(true, 0, NULL, 0),
|
|
+ SPINAND_PROG_LOAD(true, 0, NULL, 0));
|
|
+
|
|
+static SPINAND_OP_VARIANTS(update_cache_variants,
|
|
+ SPINAND_PROG_LOAD_X4(false, 0, NULL, 0),
|
|
+ SPINAND_PROG_LOAD(false, 0, NULL, 0));
|
|
+
|
|
+static int fm25s01a_ooblayout_ecc(struct mtd_info *mtd, int section,
|
|
+ struct mtd_oob_region *region)
|
|
+{
|
|
+ return -ERANGE;
|
|
+}
|
|
+
|
|
+static int fm25s01a_ooblayout_free(struct mtd_info *mtd, int section,
|
|
+ struct mtd_oob_region *region)
|
|
+{
|
|
+ if (section)
|
|
+ return -ERANGE;
|
|
+
|
|
+ region->offset = 2;
|
|
+ region->length = 62;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct mtd_ooblayout_ops fm25s01a_ooblayout = {
|
|
+ .ecc = fm25s01a_ooblayout_ecc,
|
|
+ .free = fm25s01a_ooblayout_free,
|
|
+};
|
|
+
|
|
+static int fm25s01_ooblayout_ecc(struct mtd_info *mtd, int section,
|
|
+ struct mtd_oob_region *region)
|
|
+{
|
|
+ if (section)
|
|
+ return -ERANGE;
|
|
+
|
|
+ region->offset = 64;
|
|
+ region->length = 64;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int fm25s01_ooblayout_free(struct mtd_info *mtd, int section,
|
|
+ struct mtd_oob_region *region)
|
|
+{
|
|
+ if (section)
|
|
+ return -ERANGE;
|
|
+
|
|
+ region->offset = 2;
|
|
+ region->length = 62;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct mtd_ooblayout_ops fm25s01_ooblayout = {
|
|
+ .ecc = fm25s01_ooblayout_ecc,
|
|
+ .free = fm25s01_ooblayout_free,
|
|
+};
|
|
+
|
|
+/*
|
|
+ * ecc bits: 0xC0[4,6]
|
|
+ * [0b000], No bit errors were detected;
|
|
+ * [0b001] and [0b011], 1~6 Bit errors were detected and corrected. Not
|
|
+ * reach Flipping Bits;
|
|
+ * [0b101], Bit error count equals the bit flip
|
|
+ * detection threshold
|
|
+ * [0b010], Multiple bit errors were detected and
|
|
+ * not corrected.
|
|
+ * others, Reserved.
|
|
+ */
|
|
+static int fm25s01bi3_ecc_ecc_get_status(struct spinand_device *spinand,
|
|
+ u8 status)
|
|
+{
|
|
+ struct nand_device *nand = spinand_to_nand(spinand);
|
|
+ u8 eccsr = (status & GENMASK(6, 4)) >> 4;
|
|
+
|
|
+ if (eccsr <= 1 || eccsr == 3)
|
|
+ return eccsr;
|
|
+ else if (eccsr == 5)
|
|
+ return nand->eccreq.strength;
|
|
+ else
|
|
+ return -EBADMSG;
|
|
+}
|
|
+
|
|
+static const struct spinand_info fmsh_spinand_table[] = {
|
|
+ SPINAND_INFO("FM25S01A",
|
|
+ SPINAND_ID(SPINAND_READID_METHOD_OPCODE_DUMMY, 0xE4),
|
|
+ NAND_MEMORG(1, 2048, 64, 64, 1024, 20, 1, 1, 1),
|
|
+ NAND_ECCREQ(1, 512),
|
|
+ SPINAND_INFO_OP_VARIANTS(&read_cache_variants,
|
|
+ &write_cache_variants,
|
|
+ &update_cache_variants),
|
|
+ 0,
|
|
+ SPINAND_ECCINFO(&fm25s01a_ooblayout, NULL)),
|
|
+ SPINAND_INFO("FM25S02A",
|
|
+ SPINAND_ID(SPINAND_READID_METHOD_OPCODE_DUMMY, 0xE5),
|
|
+ NAND_MEMORG(1, 2048, 64, 64, 2048, 40, 2, 1, 1),
|
|
+ NAND_ECCREQ(1, 512),
|
|
+ SPINAND_INFO_OP_VARIANTS(&read_cache_variants,
|
|
+ &write_cache_variants,
|
|
+ &update_cache_variants),
|
|
+ SPINAND_HAS_QE_BIT,
|
|
+ SPINAND_ECCINFO(&fm25s01a_ooblayout, NULL)),
|
|
+ SPINAND_INFO("FM25S01",
|
|
+ SPINAND_ID(SPINAND_READID_METHOD_OPCODE_DUMMY, 0xA1),
|
|
+ NAND_MEMORG(1, 2048, 128, 64, 1024, 20, 1, 1, 1),
|
|
+ NAND_ECCREQ(1, 512),
|
|
+ SPINAND_INFO_OP_VARIANTS(&read_cache_variants,
|
|
+ &write_cache_variants,
|
|
+ &update_cache_variants),
|
|
+ 0,
|
|
+ SPINAND_ECCINFO(&fm25s01_ooblayout, NULL)),
|
|
+ SPINAND_INFO("FM25LS01",
|
|
+ SPINAND_ID(SPINAND_READID_METHOD_OPCODE_DUMMY, 0xA5),
|
|
+ NAND_MEMORG(1, 2048, 128, 64, 1024, 20, 1, 1, 1),
|
|
+ NAND_ECCREQ(1, 512),
|
|
+ SPINAND_INFO_OP_VARIANTS(&read_cache_variants,
|
|
+ &write_cache_variants,
|
|
+ &update_cache_variants),
|
|
+ 0,
|
|
+ SPINAND_ECCINFO(&fm25s01_ooblayout, NULL)),
|
|
+ SPINAND_INFO("FM25S01BI3",
|
|
+ SPINAND_ID(SPINAND_READID_METHOD_OPCODE_DUMMY, 0xD4),
|
|
+ NAND_MEMORG(1, 2048, 128, 64, 1024, 20, 1, 1, 1),
|
|
+ NAND_ECCREQ(8, 512),
|
|
+ SPINAND_INFO_OP_VARIANTS(&read_cache_variants,
|
|
+ &write_cache_variants,
|
|
+ &update_cache_variants),
|
|
+ SPINAND_HAS_QE_BIT,
|
|
+ SPINAND_ECCINFO(&fm25s01_ooblayout, fm25s01bi3_ecc_ecc_get_status)),
|
|
+};
|
|
+
|
|
+static const struct spinand_manufacturer_ops fmsh_spinand_manuf_ops = {
|
|
+};
|
|
+
|
|
+const struct spinand_manufacturer fmsh_spinand_manufacturer = {
|
|
+ .id = SPINAND_MFR_FMSH,
|
|
+ .name = "FMSH",
|
|
+ .chips = fmsh_spinand_table,
|
|
+ .nchips = ARRAY_SIZE(fmsh_spinand_table),
|
|
+ .ops = &fmsh_spinand_manuf_ops,
|
|
+};
|
|
+
|
|
Index: a/include/linux/mtd/spinand.h
|
|
===================================================================
|
|
--- a/include/linux/mtd/spinand.h
|
|
+++ b/include/linux/mtd/spinand.h
|
|
@@ -247,6 +247,7 @@ extern const struct spinand_manufacturer toshiba_spinand_manufacturer;
|
|
extern const struct spinand_manufacturer winbond_spinand_manufacturer;
|
|
extern const struct spinand_manufacturer foresee_spinand_manufacturer;
|
|
extern const struct spinand_manufacturer esmt_c8_spinand_manufacturer;
|
|
+extern const struct spinand_manufacturer fmsh_spinand_manufacturer;
|