[PATCH v3 2/2] mtd: rawnand: nuvoton: add new driver for the Nuvoton MA35 SoC
Hui-Ping Chen
hpchen0nvt at gmail.com
Wed Aug 21 07:11:32 UTC 2024
Nuvoton MA35 SoCs NAND Flash Interface Controller
supports 2KB, 4KB and 8KB page size, and up to 8-bit,
12-bit, and 24-bit hardware ECC calculation circuit
to protect data communication.
Signed-off-by: Hui-Ping Chen <hpchen0nvt at gmail.com>
---
drivers/mtd/nand/raw/Kconfig | 8 +
drivers/mtd/nand/raw/Makefile | 1 +
drivers/mtd/nand/raw/nuvoton_ma35d1_nand.c | 1068 ++++++++++++++++++++
3 files changed, 1077 insertions(+)
create mode 100644 drivers/mtd/nand/raw/nuvoton_ma35d1_nand.c
diff --git a/drivers/mtd/nand/raw/Kconfig b/drivers/mtd/nand/raw/Kconfig
index 614257308516..932bf2215470 100644
--- a/drivers/mtd/nand/raw/Kconfig
+++ b/drivers/mtd/nand/raw/Kconfig
@@ -448,6 +448,14 @@ config MTD_NAND_RENESAS
Enables support for the NAND controller found on Renesas R-Car
Gen3 and RZ/N1 SoC families.
+config MTD_NAND_NVT_MA35
+ tristate "Nuvoton MA35 SoC NAND controller"
+ depends on ARCH_MA35 || COMPILE_TEST
+ depends on OF
+ help
+ Enables support for the NAND controller found on
+ the Nuvoton MA35 series SoCs.
+
comment "Misc"
config MTD_SM_COMMON
diff --git a/drivers/mtd/nand/raw/Makefile b/drivers/mtd/nand/raw/Makefile
index 25120a4afada..cdfdfee3f5f3 100644
--- a/drivers/mtd/nand/raw/Makefile
+++ b/drivers/mtd/nand/raw/Makefile
@@ -57,6 +57,7 @@ obj-$(CONFIG_MTD_NAND_INTEL_LGM) += intel-nand-controller.o
obj-$(CONFIG_MTD_NAND_ROCKCHIP) += rockchip-nand-controller.o
obj-$(CONFIG_MTD_NAND_PL35X) += pl35x-nand-controller.o
obj-$(CONFIG_MTD_NAND_RENESAS) += renesas-nand-controller.o
+obj-$(CONFIG_MTD_NAND_NVT_MA35) += nuvoton_ma35d1_nand.o
nand-objs := nand_base.o nand_legacy.o nand_bbt.o nand_timings.o nand_ids.o
nand-objs += nand_onfi.o
diff --git a/drivers/mtd/nand/raw/nuvoton_ma35d1_nand.c b/drivers/mtd/nand/raw/nuvoton_ma35d1_nand.c
new file mode 100644
index 000000000000..b4586d7a7a45
--- /dev/null
+++ b/drivers/mtd/nand/raw/nuvoton_ma35d1_nand.c
@@ -0,0 +1,1068 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2024 Nuvoton Technology Corp.
+ */
+#include <linux/slab.h>
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+#include <linux/delay.h>
+#include <linux/clk.h>
+#include <linux/err.h>
+#include <linux/of.h>
+
+#include <linux/mtd/mtd.h>
+#include <linux/mtd/partitions.h>
+#include <linux/mtd/rawnand.h>
+#include <linux/dma-mapping.h>
+#include <linux/dmaengine.h>
+
+/* NFI DMA Registers */
+#define MA35_NFI_REG_BUFFER0 (0x000)
+#define MA35_NFI_REG_DMACTL (0x400)
+#define DMA_EN BIT(0)
+#define DMA_RST BIT(1)
+#define DMA_BUSY BIT(9)
+
+#define MA35_NFI_REG_DMASA (0x408)
+#define MA35_NFI_REG_DMABCNT (0x40C)
+#define MA35_NFI_REG_DMAINTEN (0x410)
+#define MA35_NFI_REG_DMAINTSTS (0x414)
+
+/* NFI Global Registers */
+#define MA35_NFI_REG_GCTL (0x800)
+#define NAND_EN BIT(3)
+#define MA35_NFI_REG_GINTEN (0x804)
+#define MA35_NFI_REG_GINTSTS (0x808)
+
+/* NAND-type Flash Registers */
+#define MA35_NFI_REG_NANDCTL (0x8A0)
+#define SWRST BIT(0)
+#define DMA_W_EN BIT(1)
+#define DMA_R_EN BIT(2)
+#define ECC_CHK BIT(7)
+#define PROT3BEN BIT(8)
+#define PSIZE_2K (1 << 16)
+#define PSIZE_4K (2 << 16)
+#define PSIZE_8K (3 << 16)
+#define PSIZE_MASK (3 << 16)
+#define BCH_T24 BIT(18)
+#define BCH_T8 BIT(20)
+#define BCH_T12 BIT(21)
+#define BCH_NONE (0x0)
+#define BCH_MASK (0x1f << 18)
+#define ECC_EN BIT(23)
+#define DISABLE_CS0 BIT(25)
+
+#define MA35_NFI_REG_NANDTMCTL (0x8A4)
+#define MA35_NFI_REG_NANDINTEN (0x8A8)
+#define MA35_NFI_REG_NANDINTSTS (0x8AC)
+#define INT_DMA BIT(0)
+#define INT_ECC BIT(2)
+#define INT_RB0 BIT(10)
+#define INT_RB0_STS BIT(18)
+
+#define MA35_NFI_REG_NANDCMD (0x8B0)
+#define MA35_NFI_REG_NANDADDR (0x8B4)
+#define ENDADDR BIT(31)
+
+#define MA35_NFI_REG_NANDDATA (0x8B8)
+#define MA35_NFI_REG_NANDRACTL (0x8BC)
+#define MA35_NFI_REG_NANDECTL (0x8C0)
+#define ENABLE_WP (0x0)
+#define DISABLE_WP BIT(0)
+
+#define MA35_NFI_REG_NANDECCES0 (0x8D0)
+#define ECC_STATUS_MASK (0x3)
+#define ECC_ERR_CNT_MASK (0x1f)
+
+#define MA35_NFI_REG_NANDECCES1 (0x8D4)
+#define MA35_NFI_REG_NANDECCES2 (0x8D8)
+#define MA35_NFI_REG_NANDECCES3 (0x8DC)
+
+/* NAND-type Flash BCH Error Address Registers */
+#define MA35_NFI_REG_NANDECCEA0 (0x900)
+#define MA35_NFI_REG_NANDECCEA1 (0x904)
+#define MA35_NFI_REG_NANDECCEA2 (0x908)
+#define MA35_NFI_REG_NANDECCEA3 (0x90C)
+#define MA35_NFI_REG_NANDECCEA4 (0x910)
+#define MA35_NFI_REG_NANDECCEA5 (0x914)
+#define MA35_NFI_REG_NANDECCEA6 (0x918)
+#define MA35_NFI_REG_NANDECCEA7 (0x91C)
+#define MA35_NFI_REG_NANDECCEA8 (0x920)
+#define MA35_NFI_REG_NANDECCEA9 (0x924)
+#define MA35_NFI_REG_NANDECCEA10 (0x928)
+#define MA35_NFI_REG_NANDECCEA11 (0x92C)
+
+/* NAND-type Flash BCH Error Data Registers */
+#define MA35_NFI_REG_NANDECCED0 (0x960)
+#define MA35_NFI_REG_NANDECCED1 (0x964)
+#define MA35_NFI_REG_NANDECCED2 (0x968)
+#define MA35_NFI_REG_NANDECCED3 (0x96C)
+#define MA35_NFI_REG_NANDECCED4 (0x970)
+#define MA35_NFI_REG_NANDECCED5 (0x974)
+
+/* NAND-type Flash Redundant Area Registers */
+#define MA35_NFI_REG_NANDRA0 (0xA00)
+#define MA35_NFI_REG_NANDRA1 (0xA04)
+
+#define SKIP_SPARE_BYTES 4
+
+/* BCH algorithm related constants and variables */
+static const int ma35_parity[3][4] = {
+ {0, 60, 92, 90}, /* for 2K */
+ {0, 120, 184, 180}, /* for 4K */
+ {0, 240, 368, 360}, /* for 8K */
+};
+
+struct ma35_nand_info {
+ struct nand_controller controller;
+ struct device *dev;
+ void __iomem *regs;
+ int irq;
+ struct clk *clk;
+ struct completion complete;
+
+ struct mtd_info mtd;
+ struct nand_chip chip;
+ struct mtd_partition *parts;
+ struct nand_ecclayout_user nand_oob;
+ int nr_parts;
+
+ u32 bch;
+ u8 *dma_buf;
+ spinlock_t dma_lock;
+ dma_addr_t dma_addr;
+};
+
+static int ma35_ooblayout_ecc(struct mtd_info *mtd, int section,
+ struct mtd_oob_region *oobregion)
+{
+ struct nand_chip *chip = mtd_to_nand(mtd);
+
+ if (section)
+ return -ERANGE;
+
+ oobregion->length = chip->ecc.total;
+ oobregion->offset = mtd->oobsize - oobregion->length;
+
+ return 0;
+}
+
+static int ma35_ooblayout_free(struct mtd_info *mtd, int section,
+ struct mtd_oob_region *oobregion)
+{
+ struct nand_chip *chip = mtd_to_nand(mtd);
+
+ if (section)
+ return -ERANGE;
+
+ oobregion->length = mtd->oobsize - chip->ecc.total - 2;
+ oobregion->offset = 2;
+
+ return 0;
+}
+
+static const struct mtd_ooblayout_ops ma35_ooblayout_ops = {
+ .free = ma35_ooblayout_free,
+ .ecc = ma35_ooblayout_ecc,
+};
+
+/*
+ * Initialize hardware ECC
+ */
+static void ma35_nand_hwecc_init(struct ma35_nand_info *nand)
+{
+ struct mtd_info *mtd = nand_to_mtd(&nand->chip);
+
+ /* reset nand controller */
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | SWRST,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+
+ /* Redundant area size */
+ writel(mtd->oobsize, nand->regs + MA35_NFI_REG_NANDRACTL);
+
+ /* Protect redundant 3 bytes */
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | PROT3BEN,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+
+ /* Write the ECC parity codes automatically to NAND Flash */
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | ECC_CHK,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+
+ if (nand->bch == BCH_NONE) {
+ /* Disable H/W ECC, ECC parity check enable bit during read page */
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~ECC_EN),
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ } else {
+ /* Set BCH algorithm */
+ writel((readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~BCH_MASK)) |
+ nand->bch, nand->regs + MA35_NFI_REG_NANDCTL);
+
+ /* Enable H/W ECC, ECC parity check enable bit during read page */
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | ECC_EN,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ }
+ spin_lock_init(&nand->dma_lock);
+}
+
+static void ma35_nand_initialize(struct ma35_nand_info *nand)
+{
+ writel(NAND_EN, nand->regs + MA35_NFI_REG_GCTL);
+}
+
+
+/* Define some constants for BCH */
+/* define the total padding bytes for 512/1024 data segment */
+#define BCH_PADDING_LEN_512 32
+#define BCH_PADDING_LEN_1024 64
+/* define the BCH parity code length for 512 bytes data pattern */
+#define BCH_PARITY_LEN_T8 15
+#define BCH_PARITY_LEN_T12 23
+/* define the BCH parity code length for 1024 bytes data pattern */
+#define BCH_PARITY_LEN_T24 45
+
+/* Correct data by BCH alrogithm */
+static void ma35_nfi_correctdata(struct ma35_nand_info *nand, u8 index,
+ u8 err_cnt, u8 *addr)
+{
+ u8 *ptr = (u8 *)((long)nand->regs + MA35_NFI_REG_NANDRA0);
+ u32 field_len, padding_len, parity_len;
+ u32 temp_data[24], temp_addr[24];
+ u32 total_field_num, page;
+ u32 err_data[6];
+ u8 *smra_index;
+ u8 i, j;
+
+ /* assign parameters for different BCH and page size */
+ switch (readl(nand->regs + MA35_NFI_REG_NANDCTL) & BCH_MASK) {
+ case BCH_T24:
+ field_len = 1024;
+ parity_len = BCH_PARITY_LEN_T24;
+ padding_len = BCH_PADDING_LEN_1024;
+ break;
+ case BCH_T12:
+ field_len = 512;
+ parity_len = BCH_PARITY_LEN_T12;
+ padding_len = BCH_PADDING_LEN_512;
+ break;
+ case BCH_T8:
+ field_len = 512;
+ parity_len = BCH_PARITY_LEN_T8;
+ padding_len = BCH_PADDING_LEN_512;
+ break;
+ default:
+ pr_warn("NAND ERROR: invalid SMCR_BCH_TSEL = 0x%08X\n",
+ (u32)(readl(nand->regs + MA35_NFI_REG_NANDCTL) & BCH_MASK));
+ return;
+ }
+
+ page = readl(nand->regs + MA35_NFI_REG_NANDCTL) & PSIZE_MASK;
+ switch (page) {
+ case PSIZE_8K:
+ total_field_num = 8192 / field_len; break;
+ case PSIZE_4K:
+ total_field_num = 4096 / field_len; break;
+ case PSIZE_2K:
+ total_field_num = 2048 / field_len; break;
+ default:
+ pr_warn("NAND ERROR: invalid SMCR_PSIZE = 0x%08X\n", page);
+ return;
+ }
+
+ /* got valid BCH_ECC_DATAx and parse them to temp_data[]
+ * got the valid register number of BCH_ECC_DATAx since
+ * one register include 4 error bytes
+ */
+ j = err_cnt / 4;
+ j++;
+ if (j > 6)
+ j = 6; /* there are 6 BCH_ECC_DATAx registers to support BCH T24 */
+
+ for (i = 0; i < j; i++)
+ err_data[i] = readl(nand->regs + MA35_NFI_REG_NANDECCED0 + i*4);
+
+ for (i = 0; i < j; i++) {
+ temp_data[i*4+0] = err_data[i] & 0xff;
+ temp_data[i*4+1] = (err_data[i] >> 8) & 0xff;
+ temp_data[i*4+2] = (err_data[i] >> 16) & 0xff;
+ temp_data[i*4+3] = (err_data[i] >> 24) & 0xff;
+ }
+
+ /* got valid REG_BCH_ECC_ADDRx and parse them to temp_addr[]
+ * got the valid register number of REG_BCH_ECC_ADDRx since
+ * one register include 2 error addresses
+ */
+ j = err_cnt / 2;
+ j++;
+ if (j > 12)
+ j = 12; /* there are 12 REG_BCH_ECC_ADDRx registers to support BCH T24 */
+
+ for (i = 0; i < j; i++) {
+ /* 11 bits for error address */
+ temp_addr[i*2+0] = readl(nand->regs + MA35_NFI_REG_NANDECCEA0 + i*4) & 0x07ff;
+ temp_addr[i*2+1] = (readl(nand->regs + MA35_NFI_REG_NANDECCEA0 + i*4)>>16) & 0x07ff;
+ }
+
+ /* pointer to begin address of field that with data error */
+ addr += (index-1) * field_len;
+
+ /* correct each error bytes */
+ for (i = 0; i < err_cnt; i++) {
+ /* for wrong data in field */
+ if (temp_addr[i] < field_len)
+ *(addr+temp_addr[i]) ^= temp_data[i];
+
+ /* for wrong first-3-bytes in redundancy area */
+ else if (temp_addr[i] < (field_len+3)) {
+ temp_addr[i] -= field_len;
+ temp_addr[i] += (parity_len * (index-1)); /* field offset */
+
+ *(ptr + temp_addr[i]) ^= temp_data[i];
+ }
+ /* for wrong parity code in redundancy area */
+ /* BCH_ERR_ADDRx = [data in field] + [3 bytes] + [xx] + [parity code] */
+ /* |<-- padding bytes -->| */
+ /* The BCH_ERR_ADDRx for last parity code always = field size + padding size. */
+ /* So, the first parity code = field size + padding size - parity code length. */
+ /* For example, for BCH T12, the first parity code = 512 + 32 - 23 = 521. */
+ /* That is, error byte address offset within field is */
+ else {
+ temp_addr[i] = temp_addr[i] - (field_len + padding_len - parity_len);
+
+ /* smra_index point to the first parity code of
+ * first field in register SMRA0~n
+ */
+ smra_index = (u8 *)(ptr +
+ (readl(nand->regs+MA35_NFI_REG_NANDRACTL) & 0x1ff) -
+ (parity_len * total_field_num));
+
+ /* final address = first parity code of first field + */
+ /* offset of fields + */
+ /* offset within field */
+
+ *((u8 *)smra_index + (parity_len * (index - 1)) + temp_addr[i])
+ ^= temp_data[i];
+ }
+ } /* end of for (i < err_cnt) */
+}
+
+static int ma35_nfi_correct(struct nand_chip *chip, unsigned long addr)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ struct mtd_info *mtd = nand_to_mtd(chip);
+ int status, i, j, field = 0;
+ int report_err = 0;
+ int err_cnt = 0;
+
+ if ((readl(nand->regs + MA35_NFI_REG_NANDCTL) & BCH_MASK) == BCH_T24)
+ field = mtd->writesize / 1024;
+ else
+ field = mtd->writesize / 512;
+
+ if (field < 4)
+ field = 1;
+ else
+ field /= 4;
+
+ for (j = 0; j < field; j++) {
+ status = readl(nand->regs + MA35_NFI_REG_NANDECCES0 + j*4);
+ if (!status)
+ continue;
+
+ for (i = 1; i < 5; i++) {
+ if (!(status & ECC_STATUS_MASK)) {
+ /* No error */
+ status >>= 8;
+ continue;
+
+ } else if ((status & ECC_STATUS_MASK) == 0x01) {
+ /* Correctable error */
+ err_cnt = (status >> 2) & ECC_ERR_CNT_MASK;
+ pr_warn("Field (%d, %d) have %d error!\n", j, i, err_cnt);
+ ma35_nfi_correctdata(nand, j*4+i, err_cnt, (u8 *)addr);
+ report_err += err_cnt;
+
+ } else {
+ /* uncorrectable error */
+ pr_warn("uncorrectable error! 0x%4x\n", status);
+ return -1;
+ }
+ status >>= 8;
+ }
+ }
+ return report_err;
+}
+
+
+static int ma35_nand_correct_data(struct nand_chip *chip, u_char *dat,
+ u_char *read_ecc, u_char *calc_ecc)
+{
+ return 0;
+}
+
+
+static void ma35_nand_enable_hwecc(struct nand_chip *chip, int mode)
+{
+
+}
+
+/*
+ * Initial dma controller
+ */
+static void ma35_nand_dmac_init(struct ma35_nand_info *nand)
+{
+ /* DMAC reset and enable */
+ writel(DMA_RST | DMA_EN, nand->regs + MA35_NFI_REG_DMACTL);
+ writel(DMA_EN, nand->regs + MA35_NFI_REG_DMACTL);
+
+ /* Clear DMA finished flag */
+ writel(INT_DMA | INT_ECC, nand->regs + MA35_NFI_REG_NANDINTSTS);
+
+ init_completion(&nand->complete);
+}
+
+/*
+ * read a byte from NAND controller
+ */
+static u8 ma35_nand_read_byte(struct nand_chip *chip)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ u8 ret;
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs+MA35_NFI_REG_NANDCTL);
+ ret = (u8)readl(nand->regs + MA35_NFI_REG_NANDDATA);
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+
+ return ret;
+}
+
+
+/*
+ * read data from NAND controller
+ */
+static void ma35_nand_read_buf(struct nand_chip *chip, u8 *buf, int len)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ int i;
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ for (i = 0; i < len; i++)
+ buf[i] = (u8)readl(nand->regs + MA35_NFI_REG_NANDDATA);
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+}
+/*
+ * write data to NAND controller
+ */
+
+static void ma35_nand_write_buf(struct nand_chip *chip, const u8 *buf, int len)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ int i;
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ for (i = 0; i < len; i++)
+ writel(buf[i], nand->regs + MA35_NFI_REG_NANDDATA);
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+}
+
+/*
+ * configure and start dma transfer
+ */
+static inline int ma35_nand_dma_transfer(struct nand_chip *chip,
+ const u_char *addr, u32 len, int is_write)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ struct mtd_info *mtd = nand_to_mtd(chip);
+ unsigned long timeo = jiffies + HZ/2;
+ dma_addr_t dma_addr;
+ int ret;
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs+MA35_NFI_REG_NANDCTL);
+ /* For save, wait DMAC to ready */
+ while (1) {
+ if ((readl(nand->regs + MA35_NFI_REG_DMACTL) & DMA_BUSY) == 0)
+ break;
+ if (time_after(jiffies, timeo))
+ return -ETIMEDOUT;
+ }
+
+ /* Reinitial dmac */
+ ma35_nand_dmac_init(nand);
+
+ writel(mtd->oobsize, nand->regs + MA35_NFI_REG_NANDRACTL);
+
+ /* setup and start DMA using dma_addr */
+ if (is_write) {
+ u8 *ptr = (u8 *)((long)nand->regs + MA35_NFI_REG_NANDRA0);
+
+ writel(INT_DMA, nand->regs + MA35_NFI_REG_NANDINTEN);
+ /* To mark this page as dirty. */
+ if (ptr[3] == 0xFF)
+ ptr[3] = 0;
+ if (ptr[2] == 0xFF)
+ ptr[2] = 0;
+
+ /* Fill dma_addr */
+ dma_addr = dma_map_single(nand->dev, (void *)addr, len, DMA_TO_DEVICE);
+ dma_sync_single_for_device(nand->dev, dma_addr, len, DMA_TO_DEVICE);
+ ret = dma_mapping_error(nand->dev, dma_addr);
+ if (ret) {
+ dev_err(nand->dev, "dma mapping error\n");
+ return -EINVAL;
+ }
+
+ writel((unsigned long)dma_addr, nand->regs + MA35_NFI_REG_DMASA);
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DMA_W_EN,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ wait_for_completion_timeout(&nand->complete, msecs_to_jiffies(1000));
+
+ dma_unmap_single(nand->dev, dma_addr, len, DMA_TO_DEVICE);
+ } else {
+ writel(INT_DMA | INT_ECC, nand->regs + MA35_NFI_REG_NANDINTEN);
+ /* Fill dma_addr */
+ dma_addr = dma_map_single(nand->dev, (void *)addr, len, DMA_FROM_DEVICE);
+ ret = dma_mapping_error(nand->dev, dma_addr);
+ if (ret) {
+ dev_err(nand->dev, "dma mapping error\n");
+ return -EINVAL;
+ }
+ nand->dma_buf = (u8 *) addr;
+ nand->dma_addr = dma_addr;
+
+ writel((unsigned long)dma_addr, nand->regs + MA35_NFI_REG_DMASA);
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DMA_R_EN,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ wait_for_completion_timeout(&nand->complete, msecs_to_jiffies(1000));
+
+ dma_sync_single_for_cpu(nand->dev, dma_addr, len, DMA_FROM_DEVICE);
+ dma_unmap_single(nand->dev, dma_addr, len, DMA_FROM_DEVICE);
+ }
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+
+ return 0;
+}
+
+static void ma35_read_buf_dma(struct nand_chip *chip, u_char *buf, int len)
+{
+ struct mtd_info *mtd = nand_to_mtd(chip);
+
+ if (len == mtd->writesize)
+ ma35_nand_dma_transfer(chip, buf, len, 0x0);
+ else
+ ma35_nand_read_buf(chip, buf, len);
+}
+
+static void ma35_write_buf_dma(struct nand_chip *chip, const u_char *buf, int len)
+{
+ struct mtd_info *mtd = nand_to_mtd(chip);
+
+ if (len == mtd->writesize)
+ ma35_nand_dma_transfer(chip, (u_char *)buf, len, 0x1);
+ else
+ ma35_nand_write_buf(chip, buf, len);
+}
+
+static int ma35_nand_devready(struct nand_chip *chip)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ unsigned int val;
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs+MA35_NFI_REG_NANDCTL);
+ val = (readl(nand->regs + MA35_NFI_REG_NANDINTSTS) & INT_RB0_STS) ? 1 : 0;
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs+MA35_NFI_REG_NANDCTL);
+
+ return val;
+}
+
+static int ma35_waitfunc(struct nand_chip *chip)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ unsigned long timeo = jiffies;
+ int status = -1;
+
+ timeo += msecs_to_jiffies(400);
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ while (time_before(jiffies, timeo)) {
+ status = readl(nand->regs + MA35_NFI_REG_NANDINTSTS);
+ if (status & INT_RB0) {
+ writel(INT_RB0, nand->regs + MA35_NFI_REG_NANDINTSTS);
+ status = 0;
+ break;
+ }
+ cond_resched();
+ }
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+
+ return status;
+}
+
+static void ma35_nand_command(struct nand_chip *chip, u32 command, int column, int page_addr)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ struct mtd_info *mtd = nand_to_mtd(chip);
+
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ writel(INT_RB0, nand->regs + MA35_NFI_REG_NANDINTSTS);
+
+ if (command == NAND_CMD_READOOB) {
+ command = NAND_CMD_READ0;
+ column += mtd->writesize;
+ }
+
+ switch (command) {
+ case NAND_CMD_RESET:
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ break;
+
+ case NAND_CMD_READID:
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ writel(ENDADDR|column, nand->regs + MA35_NFI_REG_NANDADDR);
+ break;
+
+ case NAND_CMD_PARAM:
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ writel(ENDADDR|column, nand->regs + MA35_NFI_REG_NANDADDR);
+ ma35_waitfunc(chip);
+ break;
+
+ case NAND_CMD_READ0:
+ writel(ENABLE_WP, nand->regs + MA35_NFI_REG_NANDECTL);
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ if (column != -1) {
+ writel(column & 0xff, nand->regs + MA35_NFI_REG_NANDADDR);
+ writel((column >> 8) & 0xff, nand->regs + MA35_NFI_REG_NANDADDR);
+ }
+ if (page_addr != -1) {
+ writel(page_addr & 0xff, nand->regs + MA35_NFI_REG_NANDADDR);
+ if (chip->options & NAND_ROW_ADDR_3) {
+ writel((page_addr >> 8) & 0xff,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ writel(((page_addr >> 16) & 0xff) | ENDADDR,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ } else {
+ writel(((page_addr >> 8) & 0xff) | ENDADDR,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ }
+ }
+ writel(NAND_CMD_READSTART, nand->regs + MA35_NFI_REG_NANDCMD);
+ ma35_waitfunc(chip);
+ break;
+
+ case NAND_CMD_ERASE1:
+ writel(DISABLE_WP, nand->regs + MA35_NFI_REG_NANDECTL);
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ writel(page_addr & 0xff, nand->regs + MA35_NFI_REG_NANDADDR);
+ if (chip->options & NAND_ROW_ADDR_3) {
+ writel((page_addr >> 8) & 0xff,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ writel(((page_addr >> 16) & 0xff) | ENDADDR,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ } else {
+ writel(((page_addr >> 8) & 0xff) | ENDADDR,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ }
+ break;
+
+ case NAND_CMD_SEQIN:
+ writel(DISABLE_WP, nand->regs + MA35_NFI_REG_NANDECTL);
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ writel(column & 0xff, nand->regs + MA35_NFI_REG_NANDADDR);
+ writel(column >> 8, nand->regs + MA35_NFI_REG_NANDADDR);
+ writel(page_addr & 0xff, nand->regs + MA35_NFI_REG_NANDADDR);
+ if (chip->options & NAND_ROW_ADDR_3) {
+ writel((page_addr >> 8) & 0xff,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ writel(((page_addr >> 16) & 0xff) | ENDADDR,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ } else {
+ writel(((page_addr >> 8) & 0xff) | ENDADDR,
+ nand->regs + MA35_NFI_REG_NANDADDR);
+ }
+ break;
+
+ case NAND_CMD_STATUS:
+ writel(DISABLE_WP, nand->regs + MA35_NFI_REG_NANDECTL);
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ break;
+
+ default:
+ writel(command, nand->regs + MA35_NFI_REG_NANDCMD);
+ }
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+}
+
+/* select chip */
+static void ma35_nand_select_chip(struct nand_chip *chip, int cs)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+
+ if (cs == 0)
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~DISABLE_CS0),
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ else
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | DISABLE_CS0,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+}
+
+static int ma35_nand_calculate_ecc(struct nand_chip *chip, const u_char *dat,
+ u_char *ecc_code)
+{
+ return 0;
+}
+
+static int ma35_nand_write_page_hwecc(struct nand_chip *chip, const u8 *buf,
+ int oob_required, int page)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ u8 *ptr = (u8 *)((long)nand->regs + MA35_NFI_REG_NANDRA0);
+ struct mtd_info *mtd = nand_to_mtd(chip);
+ u8 *ecc_calc = chip->ecc.calc_buf;
+
+ memset((void *)ptr, 0xFF, mtd->oobsize);
+ memcpy((void *)ptr, (void *)chip->oob_poi, mtd->oobsize - chip->ecc.total);
+
+ ma35_nand_command(chip, NAND_CMD_SEQIN, 0, page);
+ ma35_nand_dma_transfer(chip, buf, mtd->writesize, 0x1);
+ ma35_nand_command(chip, NAND_CMD_PAGEPROG, -1, -1);
+ ma35_waitfunc(chip);
+
+ /* Copy parity code in NANDRA to calc */
+ memcpy((void *)ecc_calc,
+ (void *)(ptr + (mtd->oobsize - chip->ecc.total)),
+ chip->ecc.total);
+
+ /* Copy parity code in calc to oob_poi */
+ memcpy((void *)(chip->oob_poi + (mtd->oobsize - chip->ecc.total)),
+ (void *)ecc_calc, chip->ecc.total);
+
+ return 0;
+}
+
+static int ma35_nand_read_page_hwecc_oob_first(struct nand_chip *chip, u8 *buf,
+ int oob_required, int page)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ char *ptr = (char *)((long)nand->regs + MA35_NFI_REG_NANDRA0);
+ struct mtd_info *mtd = nand_to_mtd(chip);
+
+ /* 1. read the OOB area */
+ ma35_nand_command(chip, NAND_CMD_READOOB, 0, page);
+ ma35_nand_read_buf(chip, chip->oob_poi, mtd->oobsize);
+
+ /* 2. copy OOB data to NANDRA for page read */
+ memcpy((void *)ptr, (void *)chip->oob_poi, mtd->oobsize);
+
+ if ((*(ptr+2) != 0) && (*(ptr+3) != 0))
+ memset((void *)buf, 0xff, mtd->writesize);
+ else {
+ /* 3. read data from nand */
+ ma35_nand_command(chip, NAND_CMD_READ0, 0, page);
+ ma35_nand_dma_transfer(chip, buf, mtd->writesize, 0x0);
+
+ /* 4. restore OOB data from SMRA */
+ memcpy((void *)chip->oob_poi, (void *)ptr, mtd->oobsize);
+ }
+
+ return 0;
+}
+
+static void ma35_layout_oob_table(struct nand_ecclayout_user *oobtable,
+ int oobsize, int eccbytes)
+{
+ oobtable->eccbytes = eccbytes;
+ oobtable->oobavail = oobsize - SKIP_SPARE_BYTES - eccbytes;
+ oobtable->oobfree[0].offset = SKIP_SPARE_BYTES;
+ oobtable->oobfree[0].length = oobsize - eccbytes - oobtable->oobfree[0].offset;
+
+ oobtable->oobfree[1].offset = 0;
+ oobtable->oobfree[1].length = 0;
+}
+
+static int ma35_nand_read_oob_hwecc(struct nand_chip *chip, int page)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ char *ptr = (char *)((long)nand->regs + MA35_NFI_REG_NANDRA0);
+ struct mtd_info *mtd = nand_to_mtd(chip);
+
+ ma35_nand_command(chip, NAND_CMD_READOOB, 0, page);
+ ma35_nand_read_buf(chip, chip->oob_poi, mtd->oobsize);
+
+ /* copy OOB data to NANDRA for page read */
+ memcpy((void *)ptr, (void *)chip->oob_poi, mtd->oobsize);
+
+ if ((*(ptr+2) != 0) && (*(ptr+3) != 0))
+ memset((void *)chip->oob_poi, 0xff, mtd->oobsize);
+
+ return 0;
+}
+
+static irqreturn_t ma35_nand_irq(int irq, void *id)
+{
+ struct ma35_nand_info *nand = (struct ma35_nand_info *)id;
+ struct mtd_info *mtd = nand_to_mtd(&nand->chip);
+ int stat = 0;
+ u32 isr;
+
+ spin_lock(&nand->dma_lock);
+
+ isr = readl(nand->regs + MA35_NFI_REG_NANDINTSTS);
+ if (isr & INT_ECC) {
+ dma_sync_single_for_cpu(nand->dev, nand->dma_addr, mtd->writesize,
+ DMA_FROM_DEVICE);
+ stat = ma35_nfi_correct(&nand->chip, (unsigned long)nand->dma_buf);
+ if (stat < 0) {
+ mtd->ecc_stats.failed++;
+ writel(DMA_RST | DMA_EN, nand->regs + MA35_NFI_REG_DMACTL);
+ writel(readl(nand->regs + MA35_NFI_REG_NANDCTL) | SWRST,
+ nand->regs + MA35_NFI_REG_NANDCTL);
+ } else if (stat > 0) {
+ mtd->ecc_stats.corrected += stat; /* Add corrected bit count */
+ }
+ writel(INT_ECC, nand->regs + MA35_NFI_REG_NANDINTSTS);
+ }
+ if (isr & INT_DMA) {
+ writel(INT_DMA, nand->regs + MA35_NFI_REG_NANDINTSTS);
+ complete(&nand->complete);
+ }
+ spin_unlock(&nand->dma_lock);
+
+ return IRQ_HANDLED;
+}
+
+static int ma35_nand_attach_chip(struct nand_chip *chip)
+{
+ struct ma35_nand_info *nand = nand_get_controller_data(chip);
+ struct mtd_info *mtd = nand_to_mtd(chip);
+ unsigned int reg;
+
+ /* Set PSize */
+ reg = readl(nand->regs + MA35_NFI_REG_NANDCTL) & (~PSIZE_MASK);
+ if (mtd->writesize == 2048)
+ writel(reg | PSIZE_2K, nand->regs + MA35_NFI_REG_NANDCTL);
+ else if (mtd->writesize == 4096)
+ writel(reg | PSIZE_4K, nand->regs + MA35_NFI_REG_NANDCTL);
+ else if (mtd->writesize == 8192)
+ writel(reg | PSIZE_8K, nand->regs + MA35_NFI_REG_NANDCTL);
+
+ if (chip->ecc.strength == 0) {
+ nand->bch = BCH_NONE; /* No ECC */
+ ma35_layout_oob_table(&nand->nand_oob, mtd->oobsize,
+ ma35_parity[mtd->writesize>>12][0]);
+
+ } else if (chip->ecc.strength <= 8) {
+ nand->bch = BCH_T8; /* T8 */
+ ma35_layout_oob_table(&nand->nand_oob, mtd->oobsize,
+ ma35_parity[mtd->writesize>>12][1]);
+
+ } else if (chip->ecc.strength <= 12) {
+ nand->bch = BCH_T12; /* T12 */
+ ma35_layout_oob_table(&nand->nand_oob, mtd->oobsize,
+ ma35_parity[mtd->writesize>>12][2]);
+
+ } else if (chip->ecc.strength <= 24) {
+ nand->bch = BCH_T24; /* T24 */
+ ma35_layout_oob_table(&nand->nand_oob, mtd->oobsize,
+ ma35_parity[mtd->writesize>>12][3]);
+
+ } else {
+ pr_warn("NAND Controller is not support this flash. (%d, %d)\n",
+ mtd->writesize, mtd->oobsize);
+ }
+
+ chip->ecc.steps = mtd->writesize / chip->ecc.size;
+ chip->ecc.bytes = nand->nand_oob.eccbytes / chip->ecc.steps;
+ chip->ecc.total = nand->nand_oob.eccbytes;
+ mtd_set_ooblayout(mtd, &ma35_ooblayout_ops);
+
+ /* add mtd-id. The string should same as uboot definition */
+ mtd->name = "nand0";
+
+ ma35_nand_hwecc_init(nand);
+
+ writel(ENABLE_WP, nand->regs + MA35_NFI_REG_NANDECTL);
+
+ return 0;
+}
+
+static const struct nand_controller_ops ma35_nand_controller_ops = {
+ .attach_chip = ma35_nand_attach_chip,
+};
+
+static int ma35_nand_probe(struct platform_device *pdev)
+{
+ struct ma35_nand_info *nand;
+ struct nand_chip *chip;
+ struct mtd_info *mtd;
+ int retval = 0;
+
+ nand = devm_kzalloc(&pdev->dev, sizeof(*nand), GFP_KERNEL);
+ if (!nand)
+ return -ENOMEM;
+
+ nand_controller_init(&nand->controller);
+
+ nand->regs = devm_platform_ioremap_resource(pdev, 0);
+ if (IS_ERR(nand->regs))
+ return PTR_ERR(nand->regs);
+
+ nand->dev = &pdev->dev;
+ chip = &nand->chip;
+ mtd = nand_to_mtd(chip);
+ nand_set_controller_data(chip, nand);
+ nand_set_flash_node(chip, pdev->dev.of_node);
+
+ mtd->priv = chip;
+ mtd->owner = THIS_MODULE;
+ mtd->dev.parent = &pdev->dev;
+
+ nand->clk = devm_clk_get(&pdev->dev, "nand_gate");
+ if (IS_ERR(nand->clk))
+ return dev_err_probe(&pdev->dev, PTR_ERR(nand->clk),
+ "failed to find nand clock\n");
+
+ retval = clk_prepare_enable(nand->clk);
+ if (retval < 0) {
+ dev_err(&pdev->dev, "failed to enable clock\n");
+ retval = -ENXIO;
+ }
+
+ nand->chip.controller = &nand->controller;
+
+ chip->legacy.cmdfunc = ma35_nand_command;
+ chip->legacy.waitfunc = ma35_waitfunc;
+ chip->legacy.read_byte = ma35_nand_read_byte;
+ chip->legacy.select_chip = ma35_nand_select_chip;
+ chip->legacy.read_buf = ma35_read_buf_dma;
+ chip->legacy.write_buf = ma35_write_buf_dma;
+ chip->legacy.dev_ready = ma35_nand_devready;
+ chip->legacy.chip_delay = 25; /* us */
+
+ /* Read OOB data first, then HW read page */
+ chip->ecc.hwctl = ma35_nand_enable_hwecc;
+ chip->ecc.calculate = ma35_nand_calculate_ecc;
+ chip->ecc.correct = ma35_nand_correct_data;
+ chip->ecc.write_page = ma35_nand_write_page_hwecc;
+ chip->ecc.read_page = ma35_nand_read_page_hwecc_oob_first;
+ chip->ecc.read_oob = ma35_nand_read_oob_hwecc;
+ chip->options |= (NAND_NO_SUBPAGE_WRITE | NAND_USES_DMA);
+
+ ma35_nand_initialize(nand);
+ platform_set_drvdata(pdev, nand);
+
+ nand->controller.ops = &ma35_nand_controller_ops;
+
+ nand->irq = platform_get_irq(pdev, 0);
+ if (nand->irq < 0)
+ return dev_err_probe(&pdev->dev, nand->irq,
+ "failed to get platform irq\n");
+
+ retval = devm_request_irq(&pdev->dev, nand->irq, ma35_nand_irq,
+ IRQF_TRIGGER_HIGH, "ma35d1-nand", nand);
+ if (retval) {
+ dev_err(&pdev->dev, "failed to request NAND irq\n");
+ clk_disable_unprepare(nand->clk);
+ return -ENXIO;
+ }
+
+ retval = nand_scan(chip, 1);
+ if (retval)
+ return retval;
+
+ if (mtd_device_register(mtd, nand->parts, nand->nr_parts)) {
+ nand_cleanup(chip);
+ devm_kfree(&pdev->dev, nand);
+ return retval;
+ }
+
+ return retval;
+}
+
+static void ma35_nand_remove(struct platform_device *pdev)
+{
+ struct ma35_nand_info *nand = platform_get_drvdata(pdev);
+ int ret;
+
+ devm_free_irq(&pdev->dev, nand->irq, nand);
+ ret = mtd_device_unregister(nand_to_mtd(&nand->chip));
+ WARN_ON(ret);
+ nand_cleanup(&nand->chip);
+ clk_disable_unprepare(nand->clk);
+}
+
+/* PM Support */
+#ifdef CONFIG_PM
+static int ma35_nand_suspend(struct platform_device *pdev, pm_message_t pm)
+{
+ struct ma35_nand_info *nand = platform_get_drvdata(pdev);
+ unsigned long timeo = jiffies + HZ/2;
+
+ /* wait DMAC to ready */
+ while (1) {
+ if ((readl(nand->regs + MA35_NFI_REG_DMACTL) & DMA_BUSY) == 0)
+ break;
+ if (time_after(jiffies, timeo))
+ return -ETIMEDOUT;
+ }
+
+ clk_disable(nand->clk);
+
+ return 0;
+}
+
+static int ma35_nand_resume(struct platform_device *pdev)
+{
+ struct ma35_nand_info *nand = platform_get_drvdata(pdev);
+
+ clk_enable(nand->clk);
+ ma35_nand_hwecc_init(nand);
+ ma35_nand_dmac_init(nand);
+
+ return 0;
+}
+
+#else
+#define ma35_nand_suspend NULL
+#define ma35_nand_resume NULL
+#endif
+
+static const struct of_device_id ma35_nfi_of_match[] = {
+ { .compatible = "nuvoton,ma35d1-nand" },
+ {},
+};
+MODULE_DEVICE_TABLE(of, ma35_nfi_of_match);
+
+static struct platform_driver ma35_nand_driver = {
+ .driver = {
+ .name = "ma35d1-nand",
+ .of_match_table = ma35_nfi_of_match,
+ },
+ .probe = ma35_nand_probe,
+ .remove_new = ma35_nand_remove,
+ .suspend = ma35_nand_suspend,
+ .resume = ma35_nand_resume,
+};
+
+module_platform_driver(ma35_nand_driver);
+
+MODULE_DESCRIPTION("Nuvoton ma35 NAND driver");
+MODULE_AUTHOR("Hui-Ping Chen <hpchen0nvt at gmail.com>");
+MODULE_LICENSE("GPL");
--
2.25.1
More information about the dri-devel
mailing list