[PATCH linux dev-4.13 v1 2/2] mtd: npcm: add NPCM7xx spi driver
Tomer Maimon
tmaimon77 at gmail.com
Wed Dec 27 23:10:37 AEDT 2017
Add Nuvoton BMC NPCM7xx serial Peripheral interface (SPI)
Flash interface unit (FIU) driver
Nuvoton NPCM7xx have two SPI nor modules,
first module support 2 chip select
second module support 4 chip select
---
drivers/mtd/spi-nor/Kconfig | 7 +
drivers/mtd/spi-nor/Makefile | 3 +-
drivers/mtd/spi-nor/npcm-spi.c | 1203 ++++++++++++++++++++++++++++++++++++++++
3 files changed, 1212 insertions(+), 1 deletion(-)
create mode 100644 drivers/mtd/spi-nor/npcm-spi.c
diff --git a/drivers/mtd/spi-nor/Kconfig b/drivers/mtd/spi-nor/Kconfig
index 293c8a4d1e49..f23a6a77d466 100644
--- a/drivers/mtd/spi-nor/Kconfig
+++ b/drivers/mtd/spi-nor/Kconfig
@@ -113,4 +113,11 @@ config SPI_STM32_QUADSPI
This enables support for the STM32 Quad SPI controller.
We only connect the NOR to this controller.
+config SPI_NPCM
+ tristate "NPCM SPI controller"
+ depends on ARCH_NPCM || COMPILE_TEST
+ help
+ This enables support for the SPI controller in master mode.
+ We only connect the NOR to this controller now.
+
endif # MTD_SPI_NOR
diff --git a/drivers/mtd/spi-nor/Makefile b/drivers/mtd/spi-nor/Makefile
index 285aab86c7ca..728de1e3d478 100644
--- a/drivers/mtd/spi-nor/Makefile
+++ b/drivers/mtd/spi-nor/Makefile
@@ -8,4 +8,5 @@ obj-$(CONFIG_MTD_MT81xx_NOR) += mtk-quadspi.o
obj-$(CONFIG_SPI_NXP_SPIFI) += nxp-spifi.o
obj-$(CONFIG_SPI_INTEL_SPI) += intel-spi.o
obj-$(CONFIG_SPI_INTEL_SPI_PLATFORM) += intel-spi-platform.o
-obj-$(CONFIG_SPI_STM32_QUADSPI) += stm32-quadspi.o
\ No newline at end of file
+obj-$(CONFIG_SPI_STM32_QUADSPI) += stm32-quadspi.o
+obj-$(CONFIG_SPI_NPCM) += npcm-spi.o
diff --git a/drivers/mtd/spi-nor/npcm-spi.c b/drivers/mtd/spi-nor/npcm-spi.c
new file mode 100644
index 000000000000..ed0979101d44
--- /dev/null
+++ b/drivers/mtd/spi-nor/npcm-spi.c
@@ -0,0 +1,1203 @@
+/*
+ * Copyright (c) 2014-2017 Nuvoton Technology corporation.
+ *
+ * Released under the GPLv2 only.
+ * SPDX-License-Identifier: GPL-2.0
+ */
+
+#include <linux/slab.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/device.h>
+#include <linux/dma-mapping.h>
+#include <linux/module.h>
+#include <linux/ioport.h>
+#include <linux/clk.h>
+#include <linux/platform_device.h>
+#include <linux/of_irq.h>
+#include <linux/uaccess.h>
+#include <linux/io.h>
+#include <linux/mtd/mtd.h>
+#include <linux/mtd/partitions.h>
+#include <linux/mtd/spi-nor.h>
+#include <linux/vmalloc.h>
+
+#include <asm/sizes.h>
+#include <mtd/mtd-abi.h>
+
+typedef enum {
+ FIU_MODULE_0 = 0,
+ FIU_MODULE_3 = 1,
+ FIU_MODULE_X = 2,
+ FIU_MAX_MODULE_NUM = 3
+} FIU_MODULE_T;
+
+typedef struct bit_field {
+ u8 offset;
+ u8 size;
+} bit_field_t;
+
+/*
+ * Flash Interface Unit (FIU) Registers
+ */
+
+/*
+ * FIU Direct Read Configuration Register
+ */
+#define FIU_DRD_CFG(n) (fiu_base[n] + 0x00)
+static const bit_field_t FIU_DRD_CFG_R_BURST = { 24, 2 };
+static const bit_field_t FIU_DRD_CFG_ADDSIZ = { 16, 2 };
+static const bit_field_t FIU_DRD_CFG_DBW = { 12, 2 };
+static const bit_field_t FIU_DRD_CFG_ACCTYPE = { 8, 2 };
+static const bit_field_t FIU_DRD_CFG_RDCMD = { 0, 8 };
+
+/*
+ * FIU Direct Write Configuration Register
+ */
+#define FIU_DWR_CFG(n) (fiu_base[n] + 0x04)
+static const bit_field_t FIU_DWR_CFG_LCK = { 31, 1 };
+static const bit_field_t FIU_DWR_CFG_W_BURST = { 24, 2 };
+static const bit_field_t FIU_DWR_CFG_ADDSIZ = { 16, 2 };
+static const bit_field_t FIU_DWR_CFG_ABPCK = { 10, 2 };
+static const bit_field_t FIU_DWR_CFG_DBPCK = { 8, 2 };
+static const bit_field_t FIU_DWR_CFG_WRCMD = { 0, 8 };
+
+/*
+ * FIU UMA Configuration Register
+ */
+#define FIU_UMA_CFG(n) (fiu_base[n] + 0x08)
+static const bit_field_t FIU_UMA_CFG_LCK = { 31, 1 };
+static const bit_field_t FIU_UMA_CFG_CMMLCK = { 30, 1 };
+static const bit_field_t FIU_UMA_CFG_RDATSIZ = { 24, 5 };
+static const bit_field_t FIU_UMA_CFG_DBSIZ = { 21, 3 };
+static const bit_field_t FIU_UMA_CFG_WDATSIZ = { 16, 5 };
+static const bit_field_t FIU_UMA_CFG_ADDSIZ = { 11, 3 };
+static const bit_field_t FIU_UMA_CFG_CMDSIZ = { 10, 1 };
+static const bit_field_t FIU_UMA_CFG_RDBPCK = { 8, 2 };
+static const bit_field_t FIU_UMA_CFG_DBPCK = { 6, 2 };
+static const bit_field_t FIU_UMA_CFG_WDBPCK = { 4, 2 };
+static const bit_field_t FIU_UMA_CFG_ADBPCK = { 2, 2 };
+static const bit_field_t FIU_UMA_CFG_CMBPCK = { 0, 2 };
+
+/*
+ * FIU UMA Control and Status Register
+ */
+#define FIU_UMA_CTS(n) (fiu_base[n] + 0x0C)
+static const bit_field_t FIU_UMA_CTS_RDYIE = { 25, 1};
+static const bit_field_t FIU_UMA_CTS_RDYST = { 24, 1};
+static const bit_field_t FIU_UMA_CTS_SW_CS = { 16, 1};
+static const bit_field_t FIU_UMA_CTS_DEV_NUM = { 8, 2 };
+static const bit_field_t FIU_UMA_CTS_EXEC_DONE = { 0, 1 };
+
+/*
+ * FIU UMA Command Register
+ */
+#define FIU_UMA_CMD(n) (fiu_base[n] + 0x10)
+static const bit_field_t FIU_UMA_CMD_DUM3 = { 24, 8};
+static const bit_field_t FIU_UMA_CMD_DUM2 = { 16, 8};
+static const bit_field_t FIU_UMA_CMD_DUM1 = { 8, 8 };
+static const bit_field_t FIU_UMA_CMD_CMD = { 0, 8 };
+
+/*
+ * FIU UMA Address Register
+ */
+#define FIU_UMA_ADDR(n) (fiu_base[n] + 0x14)
+static const bit_field_t FIU_UMA_ADDR_UMA_ADDR = { 0, 32};
+static const bit_field_t FIU_UMA_ADDR_AB3 = { 24, 8};
+static const bit_field_t FIU_UMA_ADDR_AB2 = { 16, 8};
+static const bit_field_t FIU_UMA_ADDR_AB1 = { 8, 8 };
+static const bit_field_t FIU_UMA_ADDR_AB0 = { 0, 8 };
+
+/*
+ * FIU UMA Write Data Bytes 0-3 Register
+ */
+#define FIU_UMA_DW0(n) (fiu_base[n] + 0x20)
+static const bit_field_t FIU_UMA_DW0_WB3 = { 24, 8};
+static const bit_field_t FIU_UMA_DW0_WB2 = { 16, 8};
+static const bit_field_t FIU_UMA_DW0_WB1 = { 8, 8 };
+static const bit_field_t FIU_UMA_DW0_WB0 = { 0, 8 };
+
+/*
+ * FIU UMA Write Data Bytes 4-7 Register
+ */
+#define FIU_UMA_DW1(n) (fiu_base[n] + 0x24)
+static const bit_field_t FIU_UMA_DW1_WB7 = { 24, 8};
+static const bit_field_t FIU_UMA_DW1_WB6 = { 16, 8};
+static const bit_field_t FIU_UMA_DW1_WB5 = { 8, 8 };
+static const bit_field_t FIU_UMA_DW1_WB4 = { 0, 8 };
+
+/*
+ * FIU UMA Write Data Bytes 8-11 Register
+ */
+#define FIU_UMA_DW2(n) (fiu_base[n] + 0x28)
+static const bit_field_t FIU_UMA_DW2_WB11 = { 24, 8};
+static const bit_field_t FIU_UMA_DW2_WB10 = { 16, 8};
+static const bit_field_t FIU_UMA_DW2_WB9 = { 8, 8 };
+static const bit_field_t FIU_UMA_DW2_WB8 = { 0, 8 };
+
+/*
+ * FIU UMA Write Data Bytes 12-15 Register
+ */
+#define FIU_UMA_DW3(n) (fiu_base[n] + 0x2C)
+static const bit_field_t FIU_UMA_DW3_WB15 = { 24, 8};
+static const bit_field_t FIU_UMA_DW3_WB14 = { 16, 8};
+static const bit_field_t FIU_UMA_DW3_WB13 = { 8, 8 };
+static const bit_field_t FIU_UMA_DW3_WB12 = { 0, 8 };
+
+/*
+ * FIU UMA Read Data Bytes 0-3 Register
+ */
+#define FIU_UMA_DR0(n) (fiu_base[n] + 0x30)
+static const bit_field_t FIU_UMA_DR0_RB3 = { 24, 8};
+static const bit_field_t FIU_UMA_DR0_RB2 = { 16, 8};
+static const bit_field_t FIU_UMA_DR0_RB1 = { 8, 8 };
+static const bit_field_t FIU_UMA_DR0_RB0 = { 0, 8 };
+
+/*
+ * FIU UMA Read Data Bytes 4-7 Register
+ */
+#define FIU_UMA_DR1(n) (fiu_base[n] + 0x34)
+static const bit_field_t FIU_UMA_DR1_RB15 = { 24, 8};
+static const bit_field_t FIU_UMA_DR1_RB14 = { 16, 8};
+static const bit_field_t FIU_UMA_DR1_RB13 = { 8, 8 };
+static const bit_field_t FIU_UMA_DR1_RB12 = { 0, 8 };
+
+/*
+ * FIU UMA Read Data Bytes 8-11 Register
+ */
+#define FIU_UMA_DR2(n) (fiu_base[n] + 0x38)
+static const bit_field_t FIU_UMA_DR2_RB15 = { 24, 8};
+static const bit_field_t FIU_UMA_DR2_RB14 = { 16, 8};
+static const bit_field_t FIU_UMA_DR2_RB13 = { 8, 8 };
+static const bit_field_t FIU_UMA_DR2_RB12 = { 0, 8 };
+
+/*
+ * FIU UMA Read Data Bytes 12-15 Register
+ */
+#define FIU_UMA_DR3(n) (fiu_base[n] + 0x3C)
+static const bit_field_t FIU_UMA_DR3_RB15 = { 24, 8};
+static const bit_field_t FIU_UMA_DR3_RB14 = { 16, 8};
+static const bit_field_t FIU_UMA_DR3_RB13 = { 8, 8 };
+static const bit_field_t FIU_UMA_DR3_RB12 = { 0, 8 };
+
+/*
+ * FIU Protection Configuration Register
+ */
+#define FIU_PRT_CFG(n) (fiu_base[n] + 0x18)
+static const bit_field_t FIU_PRT_CFG_LCK = { 31, 1};
+static const bit_field_t FIU_PRT_CFG_PEN = { 30, 1};
+static const bit_field_t FIU_PRT_CFG_DEVSIZ = { 8, 3 };
+static const bit_field_t FIU_PRT_CFG_OCALWD = { 4, 1 };
+static const bit_field_t FIU_PRT_CFG_PRTASIZ = { 0, 2 };
+
+/*
+ * FIU Protection Command Register
+ */
+#define FIU_PRT_CMD0(n) (fiu_base[n] + 0x40)
+#define FIU_PRT_CMD1(n) (fiu_base[n] + 0x44)
+#define FIU_PRT_CMD2(n) (fiu_base[n] + 0x48)
+#define FIU_PRT_CMD3(n) (fiu_base[n] + 0x4C)
+#define FIU_PRT_CMD4(n) (fiu_base[n] + 0x50)
+#define FIU_PRT_CMD5(n) (fiu_base[n] + 0x54)
+#define FIU_PRT_CMD6(n) (fiu_base[n] + 0x58)
+#define FIU_PRT_CMD7(n) (fiu_base[n] + 0x5C)
+#define FIU_PRT_CMD8(n) (fiu_base[n] + 0x60)
+#define FIU_PRT_CMD9(n) (fiu_base[n] + 0x64)
+static const bit_field_t FIU_PRT_CMD9_ADBPCKB = { 29, 2};
+static const bit_field_t FIU_PRT_CMD9_CMBPCKB = { 27, 2};
+static const bit_field_t FIU_PRT_CMD9_ADDSZB = { 26, 1};
+static const bit_field_t FIU_PRT_CMD9_FRBDCB = { 24, 2};
+static const bit_field_t FIU_PRT_CMD9_CMDB = { 16, 8};
+static const bit_field_t FIU_PRT_CMD9_ADBPCKA = { 13, 2};
+static const bit_field_t FIU_PRT_CMD9_CMBPCKA = { 11, 2};
+static const bit_field_t FIU_PRT_CMD9_ADDSZA = { 10, 1};
+static const bit_field_t FIU_PRT_CMD9_FRBDCA = { 8, 2 };
+static const bit_field_t FIU_PRT_CMD9_CMDA = { 0, 8 };
+
+/*
+ * FIU Status Polling Configuration Register
+ */
+#define FIU_STPL_CFG(n) (fiu_base[n] + 0x1C)
+static const bit_field_t FIU_STPL_CFG_LCK = { 31, 1 };
+static const bit_field_t FIU_STPL_CFG_BUST = { 30, 1 };
+static const bit_field_t FIU_STPL_CFG_RDYIE = { 29, 1 };
+static const bit_field_t FIU_STPL_CFG_RDY = { 28, 1 };
+static const bit_field_t FIU_STPL_CFG_SPDWR = { 27, 1 };
+static const bit_field_t FIU_STPL_CFG_POLLPER = { 16, 11};
+static const bit_field_t FIU_STPL_CFG_ENPOL = { 12, 1 };
+static const bit_field_t FIU_STPL_CFG_BUSYPOL = { 11, 1 };
+static const bit_field_t FIU_STPL_CFG_BUSYBS = { 8, 3 };
+static const bit_field_t FIU_STPL_CFG_CMD = { 0, 8 };
+
+/*
+ * FIU Configuration Register
+ */
+#define FIU_CFG(n) (fiu_base[n] + 0x78)
+static const bit_field_t FIU_CFG_SPI_CS_INACT = { 1, 3};
+static const bit_field_t FIU_CFG_INCRSING = { 0, 1};
+
+/*
+ * FIU Version Register (FIU_VER) updated
+ */
+#define FIU_VER(n) (fiu_base[n] + 0x7C)
+static const bit_field_t FIU_VER_FIU_VER = { 0, 8};
+
+/*
+ * Defines
+ */
+#define FIU_CAPABILITY_QUAD_READ
+#define FIU_CAPABILITY_CHIP_SELECT
+
+#define WIN_LIMIT_4K_SHIFT 12
+#define BITS_7_0 0xFF
+#define BITS_15_8 0xFF00
+#define BITS_23_16 0xFF0000
+
+
+/*
+ * Typedef Definitions
+ */
+typedef enum _spi_w_burst_t {
+ FIU_W_BURST_ONE_BYTE = 0,
+ FIU_W_BURST_FOUR_BYTE = 2,
+ FIU_W_BURST_SIXTEEN_BYTE = 3
+} SPI_w_burst_t;
+
+typedef enum _spi_r_burst_t {
+ FIU_R_BURST_ONE_BYTE = 0,
+ FIU_R_BURST_FOUR_BYTE = 2,
+ FIU_R_BURST_SIXTEEN_BYTE = 3
+} SPI_r_burst_t;
+
+typedef enum _spi_w_protect_int_t {
+ SPI_W_PROTECT_INT_DISABLE = 0,
+ SPI_W_PROTECT_INT_ENABLE = 1
+} SPI_w_protect_int_t;
+
+typedef enum _spi_incorect_access_int_t {
+ SPI_INCORECT_ACCESS_INT_DISABLE = 0,
+ SPI_INCORECT_ACCESS_INT_ENABLE = 1
+} SPI_incorect_access_int_t;
+
+/*
+ * FIU Read Mode
+ */
+typedef enum _spi_read_mode_t {
+ FIU_NORMAL_READ = 0,
+ FIU_FAST_READ = 1,
+ FIU_FAST_READ_DUAL_OUTPUT = 2,
+ FIU_FAST_READ_DUAL_IO = 3,
+ FIU_FAST_READ_QUAD_IO = 4,
+ FIU_FAST_READ_SPI_X = 5,
+ FIU_READ_MODE_NUM
+} SPI_read_mode_t;
+
+/*
+ * FIU UMA data size
+ */
+typedef enum _spi_uma_data_size_t {
+ FIU_UMA_DATA_SIZE_0 = 0,
+ FIU_UMA_DATA_SIZE_1 = 1,
+ FIU_UMA_DATA_SIZE_2 = 2,
+ FIU_UMA_DATA_SIZE_3 = 3,
+ FIU_UMA_DATA_SIZE_4 = 4,
+ FIU_UMA_DATA_SIZE_5 = 5,
+ FIU_UMA_DATA_SIZE_6 = 6,
+ FIU_UMA_DATA_SIZE_7 = 7,
+ FIU_UMA_DATA_SIZE_8 = 8,
+ FIU_UMA_DATA_SIZE_9 = 9,
+ FIU_UMA_DATA_SIZE_10 = 10,
+ FIU_UMA_DATA_SIZE_11 = 11,
+ FIU_UMA_DATA_SIZE_12 = 12,
+ FIU_UMA_DATA_SIZE_13 = 13,
+ FIU_UMA_DATA_SIZE_14 = 14,
+ FIU_UMA_DATA_SIZE_15 = 15,
+ FIU_UMA_DATA_SIZE_16 = 16
+} SPI_uma_data_size_t;
+
+/*
+ * FIU Field value enumeration
+ */
+typedef enum _spi_drd_cfg_addsiz_t {
+ FIU_DRD_CFG_ADDSIZE_24BIT = 0,
+ FIU_DRD_CFG_ADDSIZE_32BIT = 1
+} SPI_drd_cfg_addsiz_t;
+
+typedef enum _spi_trans_status_t {
+ FIU_TRANS_STATUS_DONE = 0,
+ FIU_TRANS_STATUS_IN_PROG = 1
+} SPI_trans_status_t;
+
+/*
+ * SPI commands
+ */
+#define NPCM_SPI_RD_STATUS_3_REG_CMD 0x15
+#define NPCM_SPI_EN_RST_CMD 0x66
+#define NPCM_SPI_RST_DEVICE_CMD 0x99
+#define NPCM_SPI_WR_EXT_ADDR_REG_CMD 0xC5
+
+#ifdef REG_READ
+#undef REG_READ
+#endif
+static inline u32 REG_READ(unsigned int __iomem *mem)
+{
+ return ioread32(mem);
+}
+
+#ifdef REG_WRITE
+#undef REG_WRITE
+#endif
+static inline void REG_WRITE(unsigned int __iomem *mem, u32 val)
+{
+ iowrite32(val, mem);
+}
+
+#ifdef SET_REG_FIELD
+#undef SET_REG_FIELD
+#endif
+/*
+ * Set field of a register / variable according to the field offset and size
+ */
+static inline void SET_REG_FIELD(unsigned int __iomem *mem,
+ bit_field_t bit_field, u32 val)
+{
+ u32 tmp = ioread32(mem);
+
+ tmp &= ~(((1 << bit_field.size) - 1) << bit_field.offset);
+ tmp |= val << bit_field.offset;
+ iowrite32(tmp, mem);
+}
+
+#ifdef SET_VAR_FIELD
+#undef SET_VAR_FIELD
+#endif
+#define SET_VAR_FIELD(var, bit_field, value) { \
+ typeof(var) tmp = var; \
+ tmp &= ~(((1 << bit_field.size) - 1) << bit_field.offset); \
+ tmp |= value << bit_field.offset; \
+ var = tmp; \
+}
+
+#ifdef READ_REG_FIELD
+#undef READ_REG_FIELD
+#endif
+/*
+ * Get field of a register / variable according to the field offset and size
+ */
+static inline u8 READ_REG_FIELD(unsigned int __iomem *mem,
+ bit_field_t bit_field)
+{
+ u8 tmp = ioread32(mem);
+
+ tmp = tmp >> bit_field.offset;
+ tmp &= (1 << bit_field.size) - 1;
+ return tmp;
+}
+
+#ifdef READ_VAR_FIELD
+#undef READ_VAR_FIELD
+#endif
+#define READ_VAR_FIELD(var, bit_field) ({ \
+ typeof(var) tmp = var; \
+ tmp = tmp >> bit_field.offset; \
+ tmp &= (1 << bit_field.size) - 1; \
+ tmp; \
+})
+
+#ifdef MASK_FIELD
+#undef MASK_FIELD
+#endif
+/*
+ * Build a mask of a register / variable field
+ */
+#define MASK_FIELD(bit_field) (((1 << bit_field.size) - 1) << bit_field.offset)
+
+#ifdef BUILD_FIELD_VAL
+#undef BUILD_FIELD_VAL
+#endif
+/*
+ * Expand the value of the given field into its correct position
+ */
+#define BUILD_FIELD_VAL(bit_field, value) \
+ ((((1 << bit_field.size) - 1) & (value)) << bit_field.offset)
+
+
+#ifdef SET_REG_MASK
+#undef SET_REG_MASK
+#endif
+/*
+ * Set field of a register / variable according to the field offset and size
+ */
+static inline void SET_REG_MASK(unsigned int __iomem *mem, u32 val)
+{
+ iowrite32(ioread32(mem) | val, mem);
+}
+
+#define DRIVER_NAME "npcm7xx_spinor"
+
+#define SIZE_16MB 0x1000000
+#define MAX_READY_WAIT_COUNT 1000000
+
+#define WRITE_TRANSFER_16_BYTES
+
+#ifdef WRITE_TRANSFER_16_BYTES
+#define CHUNK_SIZE 16
+#endif
+
+#ifdef WRITE_TRANSFER_17_BYTES
+#define CHUNK_SIZE 17
+#endif
+
+struct npcm7xx_spi_bus;
+
+struct npcm7xx_chip {
+ u32 fiu_num;
+ u32 clkrate;
+ u32 chipselect;
+ struct spi_nor nor;
+ struct npcm7xx_spi_bus *host;
+};
+
+#define NPCM7XX_MAX_CHIP_NUM 4
+
+struct npcm7xx_spi_bus {
+ struct device *dev;
+ struct mutex lock;
+
+ void __iomem *regbase;
+ struct resource *res_mem;
+ u32 MaxChipAddMap;
+ resource_size_t iosize;
+ struct clk *clk;
+ u32 fiu_num;
+ bool Direct_Read;
+
+ struct npcm7xx_chip *chip[NPCM7XX_MAX_CHIP_NUM];
+};
+
+void __iomem *fiu_base[FIU_MAX_MODULE_NUM];
+
+/* #define NPCMX50_MTD_SPINOR_DEBUG */
+#ifdef NPCMX50_MTD_SPINOR_DEBUG
+ #define DEBUG_FLASH(format, args...) printk(format, ##args)
+ #define DUMP_MSG(format, args...) dump_msg(format, ## args)
+#else
+ #define DEBUG_FLASH(format, args...)
+ #define DUMP_MSG(format, args...)
+#endif
+
+
+/*
+ * MTD static functions:
+ */
+#ifdef NPCMX50_MTD_SPINOR_DEBUG
+static void dump_msg(const char *label, const unsigned char *buf,
+ unsigned int length);
+#endif
+//static void npcm7xx_spi_flash_unlock_protection(struct spi_nor *nor);
+
+/*
+ * FIU Functions
+ */
+static int npcm7xx_fiu_uma_read(struct spi_nor *nor, u8 transaction_code,
+ u32 address, bool is_address_size, u8 *data,
+ u32 data_size)
+{
+ u32 data_reg[4];
+ u32 uma_cfg = 0x0;
+ int ret = 0;
+ u32 address_size = 0;
+
+ struct npcm7xx_chip *chip = nor->priv;
+ struct npcm7xx_spi_bus *host = chip->host;
+
+ switch (chip->chipselect) {
+ case 0:
+ case 1:
+ case 2:
+ case 3:
+ SET_REG_FIELD(FIU_UMA_CTS(host->fiu_num),
+ FIU_UMA_CTS_DEV_NUM, (u32)chip->chipselect);
+ break;
+ default:
+ return -ENODEV;
+ }
+
+ SET_REG_FIELD(FIU_UMA_CMD(host->fiu_num), FIU_UMA_CMD_CMD,
+ transaction_code);
+ SET_VAR_FIELD(uma_cfg, FIU_UMA_CFG_CMDSIZ, 1);
+
+ if (is_address_size)
+ address_size = nor->addr_width;
+
+ SET_VAR_FIELD(uma_cfg, FIU_UMA_CFG_ADDSIZ, address_size);
+
+ REG_WRITE(FIU_UMA_ADDR(host->fiu_num), address);
+ SET_VAR_FIELD(uma_cfg, FIU_UMA_CFG_RDATSIZ, data_size);
+ SET_VAR_FIELD(uma_cfg, FIU_UMA_CFG_WDATSIZ, 0);
+
+ REG_WRITE(FIU_UMA_CFG(host->fiu_num), uma_cfg);
+ SET_REG_FIELD(FIU_UMA_CTS(host->fiu_num), FIU_UMA_CTS_EXEC_DONE, 1);
+
+ /*
+ * wait for indication that transaction has terminated
+ */
+ while (READ_REG_FIELD(FIU_UMA_CTS(host->fiu_num), FIU_UMA_CTS_EXEC_DONE)
+ == FIU_TRANS_STATUS_IN_PROG){
+ }
+
+ if (data_size >= FIU_UMA_DATA_SIZE_1)
+ data_reg[0] = REG_READ(FIU_UMA_DR0(host->fiu_num));
+ if (data_size >= FIU_UMA_DATA_SIZE_5)
+ data_reg[1] = REG_READ(FIU_UMA_DR1(host->fiu_num));
+ if (data_size >= FIU_UMA_DATA_SIZE_9)
+ data_reg[2] = REG_READ(FIU_UMA_DR2(host->fiu_num));
+ if (data_size >= FIU_UMA_DATA_SIZE_13)
+ data_reg[3] = REG_READ(FIU_UMA_DR3(host->fiu_num));
+
+ memcpy(data, data_reg, data_size);
+
+ return ret;
+}
+
+
+static int npcm7xx_fiu_uma_write(struct spi_nor *nor, u8 transaction_code,
+ u32 address, bool is_address_size, u8 *data,
+ u32 data_size)
+{
+ u32 data_reg[4] = {0};
+ u32 uma_reg = 0x0;
+ int ret = 0;
+ u32 address_size = 0;
+
+ struct npcm7xx_chip *chip = nor->priv;
+ struct npcm7xx_spi_bus *host = chip->host;
+
+ switch (chip->chipselect) {
+ case 0:
+ case 1:
+ case 2:
+ case 3:
+ SET_REG_FIELD(FIU_UMA_CTS(host->fiu_num),
+ FIU_UMA_CTS_DEV_NUM, (u32)chip->chipselect);
+ break;
+ default:
+ return -ENODEV;
+ }
+
+ SET_REG_FIELD(FIU_UMA_CMD(host->fiu_num),
+ FIU_UMA_CMD_CMD, transaction_code);
+ SET_VAR_FIELD(uma_reg, FIU_UMA_CFG_CMDSIZ, 1);
+
+ if (is_address_size)
+ address_size = nor->addr_width;
+
+ SET_VAR_FIELD(uma_reg, FIU_UMA_CFG_ADDSIZ, address_size);
+ REG_WRITE(FIU_UMA_ADDR(host->fiu_num), address);
+
+ memcpy(data_reg, data, data_size);
+
+ if (data_size >= FIU_UMA_DATA_SIZE_1)
+ REG_WRITE(FIU_UMA_DW0(host->fiu_num), data_reg[0]);
+ if (data_size >= FIU_UMA_DATA_SIZE_5)
+ REG_WRITE(FIU_UMA_DW1(host->fiu_num), data_reg[1]);
+ if (data_size >= FIU_UMA_DATA_SIZE_9)
+ REG_WRITE(FIU_UMA_DW2(host->fiu_num), data_reg[2]);
+ if (data_size >= FIU_UMA_DATA_SIZE_13)
+ REG_WRITE(FIU_UMA_DW3(host->fiu_num), data_reg[3]);
+
+ SET_VAR_FIELD(uma_reg, FIU_UMA_CFG_WDATSIZ, data_size);
+ SET_VAR_FIELD(uma_reg, FIU_UMA_CFG_RDATSIZ, 0);
+
+ REG_WRITE(FIU_UMA_CFG(host->fiu_num), uma_reg);
+ SET_REG_FIELD(FIU_UMA_CTS(host->fiu_num), FIU_UMA_CTS_EXEC_DONE, 1);
+
+ /*
+ * wait for indication that transaction has terminated
+ */
+ while (READ_REG_FIELD(FIU_UMA_CTS(host->fiu_num), FIU_UMA_CTS_EXEC_DONE)
+ == FIU_TRANS_STATUS_IN_PROG) {
+ }
+
+ return ret;
+}
+
+
+static int npcm7xx_fiu_manualwrite(struct spi_nor *nor, u8 transaction_code,
+ u32 address, u8 *data, u32 data_size)
+{
+ u8 uma_cfg = 0x0;
+ u32 num_data_chunks;
+ u32 remain_data;
+ u32 idx = 0;
+
+ struct npcm7xx_chip *chip = nor->priv;
+ struct npcm7xx_spi_bus *host = chip->host;
+
+ SET_VAR_FIELD(uma_cfg, FIU_UMA_CFG_WDATSIZ, 16);
+
+ num_data_chunks = data_size / CHUNK_SIZE;
+ remain_data = data_size % CHUNK_SIZE;
+
+ SET_REG_FIELD(FIU_UMA_CTS(host->fiu_num), FIU_UMA_CTS_DEV_NUM,
+ (u32)chip->chipselect);
+ SET_REG_FIELD(FIU_UMA_CTS(host->fiu_num), FIU_UMA_CTS_SW_CS, 0);
+
+ npcm7xx_fiu_uma_write(nor, transaction_code, address, true, NULL, 0);
+/*
+ * Starting the data writing loop in multiples of 8
+ */
+ for (idx = 0; idx < num_data_chunks; ++idx) {
+ npcm7xx_fiu_uma_write(nor, data[0], (u32)NULL, false, &data[1],
+ CHUNK_SIZE-1);
+ data += CHUNK_SIZE;
+ }
+
+/*
+ * Handling chunk remains
+ */
+ if (remain_data > 0)
+ npcm7xx_fiu_uma_write(nor, data[0], (u32)NULL, false, &data[1],
+ remain_data-1);
+
+ SET_REG_FIELD(FIU_UMA_CTS(host->fiu_num), FIU_UMA_CTS_SW_CS, 1);
+
+ return 0;
+}
+
+/*
+ * SPI Functions
+ */
+static void npcm7xx_spi_flash_high_addr_wr(struct spi_nor *nor, u8 HighAddr)
+{
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WREN, 0, false, NULL, 0);
+ npcm7xx_fiu_uma_write(nor, NPCM_SPI_WR_EXT_ADDR_REG_CMD, 0, false,
+ &HighAddr, sizeof(u8));
+}
+
+static void npcm7xx_spi_flash_common_getstatus(struct spi_nor *nor, u8 *status)
+{
+ npcm7xx_fiu_uma_read(nor, SPINOR_OP_RDSR, 0, 0, status, 1);
+}
+
+static void npcm7xx_spi_flash_common_waittillready(struct spi_nor *nor)
+{
+ u8 busy = 1;
+
+ do {
+ npcm7xx_spi_flash_common_getstatus(nor, &busy);
+ /* Keep only "busy" bit 0 */
+ busy &= 0x01;
+ } while (busy);
+}
+
+static void npcm7xx_spi_flash_common_write(struct spi_nor *nor, u32 destAddr,
+ u8 *data, u32 size)
+{
+ if ((destAddr >> 24) && (nor->addr_width == 3)) {
+ npcm7xx_spi_flash_high_addr_wr(nor, destAddr >> 24);
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WREN, 0, false, NULL, 0);
+ npcm7xx_fiu_manualwrite(nor, SPINOR_OP_PP,
+ (destAddr & 0xFFFFFF), data, size);
+ npcm7xx_spi_flash_common_waittillready(nor);
+ npcm7xx_spi_flash_high_addr_wr(nor, 0);
+ } else {
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WREN, 0, false, NULL, 0);
+ npcm7xx_fiu_manualwrite(nor, SPINOR_OP_PP, destAddr, data,
+ size);
+ npcm7xx_spi_flash_common_waittillready(nor);
+ }
+}
+
+static void npcm7xx_spi_flash_unlock_protection(struct spi_nor *nor)
+{
+ u8 status_reg_val = 0;
+
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WREN, 0, false, NULL, 0);
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WRSR, 0, false,
+ &status_reg_val, sizeof(u8));
+ npcm7xx_spi_flash_common_waittillready(nor);
+}
+
+static ssize_t npcm7xx_spi_write(struct spi_nor *nor, loff_t to,
+ size_t len, const u_char *write_buf)
+{
+ u32 local_addr = (u32) to;
+ u32 cnt = (u32) len;
+ u32 actual_size = 0;
+ struct mtd_info *mtd;
+
+ mtd = &nor->mtd;
+
+ DEBUG_FLASH("mtd_spinor: %s %s 0x%08x, len %zd\n", __func__,
+ "to", (u32)to, len);
+
+ /* sanity checks */
+ if (!len)
+ return(0);
+
+ if (to + len > mtd->size)
+ return -EINVAL;
+
+ if (cnt != 0) {
+ while (cnt) {
+ actual_size = ((((local_addr)/mtd->writesize) + 1)
+ *mtd->writesize) - (local_addr);
+ if (actual_size > cnt)
+ actual_size = cnt;
+
+ npcm7xx_spi_flash_common_write(nor, local_addr,
+ (u_char *)write_buf,
+ actual_size);
+
+ write_buf += actual_size;
+ local_addr += actual_size;
+ cnt -= actual_size;
+ }
+ }
+
+ return (len - cnt);
+}
+
+static ssize_t npcm7xx_spi_read(struct spi_nor *nor, loff_t from,
+ size_t len, u_char *read_buf)
+{
+ struct npcm7xx_chip *chip = nor->priv;
+ struct npcm7xx_spi_bus *host = chip->host;
+ void __iomem *flash_region_mapped_ptr = NULL;
+ struct mtd_info *mtd;
+ int i, readlen, currlen;
+ u32 addr;
+ u8 *buf_ptr;
+ u32 retlen = 0;
+
+ mtd = &nor->mtd;
+
+ DEBUG_FLASH("mtd_spinor: %s %s 0x%08x, len %zd\n", __func__, "from",
+ (u32)from, len);
+
+ if (!len)
+ return 0;
+
+ if (from + len > (u32)mtd->size)
+ return -EINVAL;
+
+ DEBUG_FLASH("mtd_spinor: %s , mtd->size 0x%08x %p\n", __func__,
+ (u32) mtd->size, read_buf);
+
+
+ if (host->Direct_Read) {
+ if (!request_mem_region((host->res_mem->start +
+ (host->MaxChipAddMap *
+ chip->chipselect)) + from,
+ len, mtd->name))
+ return -EBUSY;
+
+ flash_region_mapped_ptr = (u32 *)ioremap_nocache(
+ (host->res_mem->start +
+ (host->MaxChipAddMap * chip->chipselect)) + from, len);
+
+ if (!flash_region_mapped_ptr) {
+ pr_err(": Failed to ioremap window!\n");
+ release_mem_region((host->res_mem->start +
+ (host->MaxChipAddMap *
+ chip->chipselect)) + from, len);
+ return -ENOMEM;
+ }
+
+ if (mtd->size > SIZE_16MB) {
+ if (nor->addr_width == 3)
+ SET_REG_FIELD(FIU_DRD_CFG(host->fiu_num),
+ FIU_DRD_CFG_RDCMD,
+ SPINOR_OP_READ_1_2_2_4B);
+
+ else
+ SET_REG_FIELD(FIU_DRD_CFG(host->fiu_num),
+ FIU_DRD_CFG_RDCMD,
+ SPINOR_OP_WRSR);
+ SET_REG_FIELD(FIU_DRD_CFG(host->fiu_num),
+ FIU_DRD_CFG_ADDSIZ, 0x1);
+ } else {
+ SET_REG_FIELD(FIU_DRD_CFG(host->fiu_num),
+ FIU_DRD_CFG_RDCMD, SPINOR_OP_READ_1_2_2);
+ SET_REG_FIELD(FIU_DRD_CFG(host->fiu_num),
+ FIU_DRD_CFG_ADDSIZ, 0x0);
+ }
+
+ memcpy(read_buf, flash_region_mapped_ptr, len);
+ wmb();
+
+ npcm7xx_spi_flash_high_addr_wr(nor, 0);
+
+ if (flash_region_mapped_ptr)
+ iounmap((void __iomem *)flash_region_mapped_ptr);
+
+ release_mem_region((host->res_mem->start +
+ (host->MaxChipAddMap * chip->chipselect))
+ + from, len);
+
+ retlen = len;
+ } else {
+ /* NOTE: OPCODE_FAST_READ (if available) is faster... */
+ i = 0;
+ currlen = (int) len;
+
+ do {
+ addr = ((u32) from + i);
+ if (currlen < 4)
+ readlen = currlen;
+ else
+ readlen = 4;
+
+ DEBUG_FLASH("mtd_spinor: ori_addr=0x%x, addr=0x%x\n",
+ ((u32) from + i), addr);
+
+ buf_ptr = read_buf + i;
+
+ if ((addr >> 24) && (nor->addr_width == 3))
+ npcm7xx_spi_flash_high_addr_wr(nor, addr >> 24);
+
+ npcm7xx_fiu_uma_read(nor, SPINOR_OP_READ,
+ (addr&0xFFFFFF), true, buf_ptr,
+ readlen);
+
+ if ((addr >> 24) && (nor->addr_width == 3))
+ npcm7xx_spi_flash_high_addr_wr(nor, 0);
+
+ DEBUG_FLASH("mtd_spinor: buf_ptr=0x%x buf_val=0x%x "
+ "i=%d readlen =%d\n", (u32)buf_ptr,
+ *((u32 *)buf_ptr), i, readlen);
+
+ i += readlen;
+ currlen -= 4;
+ } while (currlen > 0);
+
+ retlen = i;
+ }
+
+ DUMP_MSG("MTD_READ", read_buf, i);
+ return retlen;
+}
+
+static int npcm7xx_spi_erase(struct spi_nor *nor, loff_t offs)
+{
+ u32 addr = (u32)offs;
+
+ if ((addr >> 24) && (nor->addr_width == 3)) {
+ npcm7xx_spi_flash_high_addr_wr(nor, addr >> 24);
+
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WREN, 0, false, NULL,
+ 0);
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WRSR,
+ (addr & 0xFFFFFF), true, NULL, 0);
+ npcm7xx_spi_flash_common_waittillready(nor);
+ npcm7xx_spi_flash_high_addr_wr(nor, 0);
+ } else {
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WREN, 0, false, NULL,
+ 0);
+ npcm7xx_fiu_uma_write(nor, SPINOR_OP_WRSR, addr, true, NULL, 0);
+ npcm7xx_spi_flash_common_waittillready(nor);
+ }
+
+ return 0;
+}
+
+static int npcm7xx_spi_read_reg(struct spi_nor *nor, u8 opcode, u8 *buf,
+ int len)
+{
+ return npcm7xx_fiu_uma_read(nor, opcode, 0, 0, buf, len);
+}
+
+static int npcm7xx_spi_write_reg(struct spi_nor *nor, u8 opcode, u8 *buf,
+ int len)
+{
+ return npcm7xx_fiu_uma_write(nor, opcode, (u32)NULL, false, buf, len);
+}
+
+static int npcm7xx_spi_nor_prep(struct spi_nor *nor, enum spi_nor_ops ops)
+{
+ struct npcm7xx_chip *chip = nor->priv;
+ struct npcm7xx_spi_bus *host = chip->host;
+
+ mutex_lock(&host->lock);
+
+ return 0;
+}
+
+static void npcm7xx_spi_nor_unprep(struct spi_nor *nor, enum spi_nor_ops ops)
+{
+ struct npcm7xx_chip *chip = nor->priv;
+ struct npcm7xx_spi_bus *host = chip->host;
+
+ mutex_unlock(&host->lock);
+}
+
+#ifdef NPCMX50_MTD_SPINOR_DEBUG
+static void dump_msg(const char *label, const unsigned char *buf,
+ unsigned int length)
+{
+ unsigned int start, num, i;
+ char line[52], *p;
+
+ if (length > 32)
+ length = 32;
+
+ DEBUG_FLASH("MTD_SPI: %s, length %u:\n", label, length);
+
+ start = 0;
+ while (length > 0) {
+ num = min(length, 16u);
+ p = line;
+ for (i = 0; i < num; ++i) {
+ if (i == 8)
+ *p++ = ' ';
+ sprintf(p, " %02x", buf[i]);
+ p += 3;
+ }
+ *p = 0;
+ pr_info("%6x: %s\n", start, line);
+ buf += num;
+ start += num;
+ length -= num;
+ }
+}
+#endif
+
+/*
+ * Get spi flash device information and register it as a mtd device.
+ */
+static int npcm7xx_spi_nor_register(struct device_node *np,
+ struct npcm7xx_spi_bus *host)
+{
+ struct device *dev = host->dev;
+ struct spi_nor *nor;
+ struct npcm7xx_chip *chip;
+ struct mtd_info *mtd;
+ u32 chipselect;
+ int ret;
+ u8 status_reg_val;
+ const struct spi_nor_hwcaps hwcaps = {
+ .mask = SNOR_HWCAPS_READ |
+ SNOR_HWCAPS_READ_FAST |
+ SNOR_HWCAPS_READ_1_1_2 |
+ SNOR_HWCAPS_READ_1_2_2 |
+ SNOR_HWCAPS_READ_2_2_2 |
+ SNOR_HWCAPS_READ_1_1_4 |
+ SNOR_HWCAPS_READ_1_4_4 |
+ SNOR_HWCAPS_READ_4_4_4 |
+ SNOR_HWCAPS_PP |
+ SNOR_HWCAPS_PP_1_1_4 |
+ SNOR_HWCAPS_PP_1_4_4 |
+ SNOR_HWCAPS_PP_4_4_4,
+ };
+
+ /* This driver does not support NAND or NOR flash devices. */
+ if (!of_device_is_compatible(np, "jedec,spi-nor")) {
+ dev_err(dev, "The device is no compatible to jedec,spi-nor\n");
+ return -ENOMEM;
+ }
+
+ ret = of_property_read_u32(np, "reg", &chipselect);
+ if (ret) {
+ dev_err(dev, "There's no reg property for %s\n", np->full_name);
+ return ret;
+ }
+
+ if (chipselect >= NPCM7XX_MAX_CHIP_NUM) {
+ dev_warn(dev, "Flash device number exceeds the maximum "
+ "chipselect number\n");
+ return -ENOMEM;
+ }
+
+ chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
+ if (!chip)
+ return -ENOMEM;
+
+ chip->host = host;
+ chip->chipselect = chipselect;
+
+ nor = &chip->nor;
+ mtd = &nor->mtd;
+
+ nor->dev = dev;
+ nor->priv = chip;
+
+ spi_nor_set_flash_node(nor, np);
+
+/* ret = of_property_read_u32(np, "spi-max-frequency",
+ * &chip->clkrate);
+ * if (ret) {
+ * dev_err(dev, "There's no spi-max-frequency property for %s\n",
+ * np->full_name);
+ * return ret;
+ * }
+ */
+ nor->prepare = npcm7xx_spi_nor_prep;
+ nor->unprepare = npcm7xx_spi_nor_unprep;
+
+ nor->read_reg = npcm7xx_spi_read_reg;
+ nor->write_reg = npcm7xx_spi_write_reg;
+ nor->read = npcm7xx_spi_read;
+ nor->write = npcm7xx_spi_write;
+ nor->erase = npcm7xx_spi_erase;
+
+ ret = spi_nor_scan(nor, NULL, &hwcaps);
+ if (ret)
+ return ret;
+
+ if (mtd->size > SIZE_16MB) {
+ npcm7xx_fiu_uma_read(nor, NPCM_SPI_RD_STATUS_3_REG_CMD, 0,
+ false, &status_reg_val, sizeof(u8));
+ if (status_reg_val & 0x1) {
+ npcm7xx_spi_flash_common_waittillready(nor);
+ npcm7xx_fiu_uma_write(nor, NPCM_SPI_EN_RST_CMD, 0,
+ false, NULL, 0);
+ npcm7xx_fiu_uma_write(nor, NPCM_SPI_RST_DEVICE_CMD, 0,
+ false, NULL, 0);
+ npcm7xx_spi_flash_common_waittillready(nor);
+ }
+
+ npcm7xx_fiu_uma_read(nor, NPCM_SPI_RD_STATUS_3_REG_CMD, 0,
+ false, &status_reg_val, sizeof(u8));
+ if ((status_reg_val & 0x1) == 0x0)
+ nor->addr_width = 3;
+ }
+
+ npcm7xx_spi_flash_unlock_protection(nor);
+
+ //mtd->name = np->name;
+ ret = mtd_device_register(mtd, NULL, 0);
+ if (ret)
+ return ret;
+
+ host->chip[chip->chipselect] = chip;
+ return 0;
+}
+
+static void npcm7xx_spi_nor_unregister_all(struct npcm7xx_spi_bus *host)
+{
+ struct npcm7xx_chip *chip;
+ int n;
+
+ for (n = 0; n < NPCM7XX_MAX_CHIP_NUM; n++) {
+ chip = host->chip[n];
+ if (chip)
+ mtd_device_unregister(&chip->nor.mtd);
+ }
+}
+
+static int npcm7xx_spi_nor_register_all(struct npcm7xx_spi_bus *host)
+{
+ struct device *dev = host->dev;
+ struct device_node *np;
+ int ret;
+
+ for_each_available_child_of_node(dev->of_node, np) {
+ ret = npcm7xx_spi_nor_register(np, host);
+ if (ret)
+ goto fail;
+ }
+
+ return 0;
+
+fail:
+ npcm7xx_spi_nor_unregister_all(host);
+ return ret;
+}
+
+static int npcm7xx_spi_probe(struct platform_device *pdev)
+{
+ struct device *dev = &pdev->dev;
+ struct resource *res;
+ struct npcm7xx_spi_bus *host;
+ static u32 fiu_num;
+ struct device_node *np = pdev->dev.of_node;
+ int ret;
+
+ host = devm_kzalloc(dev, sizeof(*host), GFP_KERNEL);
+ if (!host)
+ return -ENOMEM;
+
+ platform_set_drvdata(pdev, host);
+ host->dev = dev;
+
+ res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "control");
+ host->regbase = devm_ioremap_resource(dev, res);
+ if (IS_ERR(host->regbase))
+ return PTR_ERR(host->regbase);
+
+ host->res_mem = platform_get_resource_byname(pdev, IORESOURCE_MEM,
+ "memory");
+ if (host->res_mem)
+ host->Direct_Read = true;
+ else
+ host->Direct_Read = false;
+
+ host->clk = devm_clk_get(dev, NULL);
+ if (IS_ERR(host->clk))
+ return PTR_ERR(host->clk);
+
+ if (of_device_is_compatible(np, "nuvoton,npcm750-spi"))
+ host->MaxChipAddMap = 0x8000000;
+ else {
+ ret = of_property_read_u32(dev->of_node, "chip-max-address-map",
+ &host->MaxChipAddMap);
+ if (ret) {
+ pr_info("There's no chip-max-address-map property "
+ "for %s adjust 128Mb\n",
+ dev->of_node->full_name);
+ host->MaxChipAddMap = 0x8000000;
+ }
+ }
+
+ mutex_init(&host->lock);
+ //clk_prepare_enable(host->clk);
+ fiu_base[fiu_num] = host->regbase;
+ host->fiu_num = fiu_num;
+
+ ret = npcm7xx_spi_nor_register_all(host);
+ if (ret) {
+ mutex_destroy(&host->lock);
+ //clk_disable_unprepare(host->clk);
+ pr_info("npcm7xx_spi_nor_register_all failed\n");
+ }
+
+ fiu_num++;
+
+ DEBUG_FLASH("mtd_spinor: %s() date=%s time=%s\n\n", __func, __date__,
+ __time__);
+
+ return ret;
+}
+
+static int npcm7xx_spi_remove(struct platform_device *pdev)
+{
+ struct npcm7xx_spi_bus *host = platform_get_drvdata(pdev);
+
+ npcm7xx_spi_nor_unregister_all(host);
+ mutex_destroy(&host->lock);
+ clk_disable_unprepare(host->clk);
+ return 0;
+}
+
+static const struct of_device_id npcm7xx_spi_dt_ids[] = {
+ { .compatible = "nuvoton,npcm750-spi" },
+ { /* sentinel */ }
+};
+
+MODULE_DEVICE_TABLE(of, npcm7xx_spi_dt_ids);
+
+static struct platform_driver npcm7xx_spi_driver = {
+ .driver = {
+ .name = "npcm7xx-spi",
+ .bus = &platform_bus_type,
+ .of_match_table = npcm7xx_spi_dt_ids,
+ },
+ .probe = npcm7xx_spi_probe,
+ .remove = npcm7xx_spi_remove,
+};
+module_platform_driver(npcm7xx_spi_driver);
+
+MODULE_DESCRIPTION("Nuvoton SPI Controller Driver");
+MODULE_AUTHOR("Tomer Maimon <tomer.maimon at nuvoton.com>");
+MODULE_LICENSE("GPL v2");
--
2.14.1
More information about the openbmc
mailing list