aboutsummaryrefslogtreecommitdiff
path: root/nuttx/drivers
diff options
context:
space:
mode:
authorpx4dev <px4@purgatory.org>2012-09-16 16:42:10 -0700
committerpx4dev <px4@purgatory.org>2012-09-16 16:42:10 -0700
commit2b82c733a9c3b55ac8508d27d70281f7193d7760 (patch)
treecf1e58b11332dabc9ad10d996486d107b19a19f4 /nuttx/drivers
parentf7949a904b996eccdf3d6d124833cba5d42be997 (diff)
parentcdaf7270614ab2294b6654bffbd7b6bc88c73389 (diff)
downloadpx4-firmware-2b82c733a9c3b55ac8508d27d70281f7193d7760.tar.gz
px4-firmware-2b82c733a9c3b55ac8508d27d70281f7193d7760.tar.bz2
px4-firmware-2b82c733a9c3b55ac8508d27d70281f7193d7760.zip
Merge branch 'NuttX/master'
git-svn-id: https://nuttx.svn.sourceforge.net/svnroot/nuttx/trunk@5163 7fd9a85b-ad96-42d3-883c-3090e2eb8679
Diffstat (limited to 'nuttx/drivers')
-rw-r--r--nuttx/drivers/mtd/Kconfig73
-rw-r--r--nuttx/drivers/mtd/Make.defs4
-rw-r--r--nuttx/drivers/mtd/w25.c1188
-rw-r--r--nuttx/drivers/net/Kconfig9
-rw-r--r--nuttx/drivers/net/enc28j60.c218
-rw-r--r--nuttx/drivers/net/enc28j60.h8
6 files changed, 1439 insertions, 61 deletions
diff --git a/nuttx/drivers/mtd/Kconfig b/nuttx/drivers/mtd/Kconfig
index bda5afa84..ae656c474 100644
--- a/nuttx/drivers/mtd/Kconfig
+++ b/nuttx/drivers/mtd/Kconfig
@@ -36,19 +36,19 @@ config AT45DB_PWRSAVE
bool "enables power save"
default n
depends on MTD_AT45DB
-
+
config MTD_MP25P
- bool "SPI-based M25P1 falsh"
+ bool "SPI-based M25P FLASH"
default n
select SPI
config MP25P_SPIMODE
- int "mp25p spi mode"
+ int "MP25P SPI mode"
default 0
depends on MTD_MP25P
config MP25P_MANUFACTURER
- hex "mp25p manufacturers ID"
+ hex "MP25P manufacturers ID"
default 0x20
depends on MTD_MP25P
---help---
@@ -66,3 +66,68 @@ config MTD_RAMTRON
config MTD_RAM
bool "Memory bus ram"
default n
+
+config MTD_SST25
+ bool "SPI-based SST25 FLASH"
+ default n
+ select SPI
+
+config SST25_SPIMODE
+ int "SST25 SPI Mode"
+ default 0
+ depends on MTD_SST25
+
+config SST25_SPIFREQUENCY
+ int "SST25 SPI Frequency"
+ default 20000000
+ depends on MTD_SST25
+
+config SST25_READONLY
+ bool "SST25 Read-Only FLASH"
+ default n
+ depends on MTD_SST25
+
+config SST25_SECTOR512
+ bool "Simulate 512 byte Erase Blocks"
+ default n
+ depends on MTD_SST25
+
+config SST25_SLOWWRITE
+ bool
+ default y
+ depends on MTD_SST25
+
+config SST25_SLOWREAD
+ bool
+ default n
+ depends on MTD_SST25
+
+config MTD_W25
+ bool "SPI-based W25 FLASH"
+ default n
+ select SPI
+
+config W25_SPIMODE
+ int "W25 SPI Mode"
+ default 0
+ depends on MTD_W25
+
+config W25_SPIFREQUENCY
+ int "W25 SPI Frequency"
+ default 20000000
+ depends on MTD_W25
+
+config W25_READONLY
+ bool "W25 Read-Only FLASH"
+ default n
+ depends on MTD_W25
+
+config W25_SECTOR512
+ bool "Simulate 512 byte Erase Blocks"
+ default n
+ depends on MTD_W25
+
+config W25_SLOWREAD
+ bool
+ default n
+ depends on MTD_W25
diff --git a/nuttx/drivers/mtd/Make.defs b/nuttx/drivers/mtd/Make.defs
index 866d7c713..258e77ec9 100644
--- a/nuttx/drivers/mtd/Make.defs
+++ b/nuttx/drivers/mtd/Make.defs
@@ -47,6 +47,10 @@ ifeq ($(CONFIG_MTD_SST25),y)
CSRCS += sst25.c
endif
+ifeq ($(CONFIG_MTD_W25),y)
+CSRCS += w25.c
+endif
+
# Include MTD driver support
DEPPATH += --dep-path mtd
diff --git a/nuttx/drivers/mtd/w25.c b/nuttx/drivers/mtd/w25.c
new file mode 100644
index 000000000..0d7028fec
--- /dev/null
+++ b/nuttx/drivers/mtd/w25.c
@@ -0,0 +1,1188 @@
+/************************************************************************************
+ * drivers/mtd/w25.c
+ * Driver for SPI-based W25x16, x32, and x64 and W25q16, q32, q64, and q128 FLASH
+ *
+ * Copyright (C) 2012 Gregory Nutt. All rights reserved.
+ * Author: Gregory Nutt <gnutt@nuttx.org>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in
+ * the documentation and/or other materials provided with the
+ * distribution.
+ * 3. Neither the name NuttX nor the names of its contributors may be
+ * used to endorse or promote products derived from this software
+ * without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ *
+ ************************************************************************************/
+
+/************************************************************************************
+ * Included Files
+ ************************************************************************************/
+
+#include <nuttx/config.h>
+
+#include <sys/types.h>
+
+#include <stdint.h>
+#include <stdbool.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <string.h>
+#include <assert.h>
+#include <errno.h>
+#include <debug.h>
+
+#include <nuttx/kmalloc.h>
+#include <nuttx/fs/ioctl.h>
+#include <nuttx/spi.h>
+#include <nuttx/mtd.h>
+
+/************************************************************************************
+ * Pre-processor Definitions
+ ************************************************************************************/
+/* Configuration ********************************************************************/
+/* Per the data sheet, the W25 parts can be driven with either SPI mode 0 (CPOL=0
+ * and CPHA=0) or mode 3 (CPOL=1 and CPHA=1). But I have heard that other devices
+ * can operate in mode 0 or 1. So you may need to specify CONFIG_W25_SPIMODE to
+ * select the best mode for your device. If CONFIG_W25_SPIMODE is not defined,
+ * mode 0 will be used.
+ */
+
+#ifndef CONFIG_W25_SPIMODE
+# define CONFIG_W25_SPIMODE SPIDEV_MODE0
+#endif
+
+/* SPI Frequency. May be up to 25MHz. */
+
+#ifndef CONFIG_W25_SPIFREQUENCY
+# define CONFIG_W25_SPIFREQUENCY 20000000
+#endif
+
+/* W25 Instructions *****************************************************************/
+/* Command Value Description */
+/* */
+#define W25_WREN 0x06 /* Write enable */
+#define W25_WRDI 0x04 /* Write Disable */
+#define W25_RDSR 0x05 /* Read status register */
+#define W25_WRSR 0x01 /* Write Status Register */
+#define W25_RDDATA 0x03 /* Read data bytes */
+#define W25_FRD 0x0b /* Higher speed read */
+#define W25_FRDD 0x3b /* Fast read, dual output */
+#define W25_PP 0x02 /* Program page */
+#define W25_BE 0xd8 /* Block Erase (64KB) */
+#define W25_SE 0x20 /* Sector erase (4KB) */
+#define W25_CE 0xc7 /* Chip erase */
+#define W25_PD 0xb9 /* Power down */
+#define W25_PURDID 0xab /* Release PD, Device ID */
+#define W25_RDMFID 0x90 /* Read Manufacturer / Device */
+#define W25_JEDEC_ID 0x9f /* JEDEC ID read */
+
+/* W25 Registers ********************************************************************/
+/* Read ID (RDID) register values */
+
+#define W25_MANUFACTURER 0xef /* Winbond Serial Flash */
+#define W25X16_DEVID 0x14 /* W25X16 device ID (0xab, 0x90) */
+#define W25X32_DEVID 0x15 /* W25X16 device ID (0xab, 0x90) */
+#define W25X64_DEVID 0x16 /* W25X16 device ID (0xab, 0x90) */
+
+/* JEDEC Read ID register values */
+
+#define W25_JEDEC_MANUFACTURER 0xef /* SST manufacturer ID */
+#define W25X_JEDEC_MEMORY_TYPE 0x30 /* W25X memory type */
+#define W25Q_JEDEC_MEMORY_TYPE_A 0x40 /* W25Q memory type */
+#define W25Q_JEDEC_MEMORY_TYPE_B 0x60 /* W25Q memory type */
+
+#define W25_JEDEC_CAPACITY_16MBIT 0x15 /* 512x4096 = 16Mbit memory capacity */
+#define W25_JEDEC_CAPACITY_32MBIT 0x16 /* 1024x4096 = 32Mbit memory capacity */
+#define W25_JEDEC_CAPACITY_64MBIT 0x17 /* 2048x4096 = 64Mbit memory capacity */
+#define W25_JEDEC_CAPACITY_128MBIT 0x18 /* 4096x4096 = 128Mbit memory capacity */
+
+#define NSECTORS_16MBIT 512 /* 512 sectors x 4096 bytes/sector = 2Mb */
+#define NSECTORS_32MBIT 1024 /* 1024 sectors x 4096 bytes/sector = 4Mb */
+#define NSECTORS_64MBIT 2048 /* 2048 sectors x 4096 bytes/sector = 8Mb */
+#define NSECTORS_128MBIT 4096 /* 4096 sectors x 4096 bytes/sector = 16Mb */
+
+/* Status register bit definitions */
+
+#define W25_SR_BUSY (1 << 0) /* Bit 0: Write in progress */
+#define W25_SR_WEL (1 << 1) /* Bit 1: Write enable latch bit */
+#define W25_SR_BP_SHIFT (2) /* Bits 2-5: Block protect bits */
+#define W25_SR_BP_MASK (15 << W25_SR_BP_SHIFT)
+# define W25X16_SR_BP_NONE (0 << W25_SR_BP_SHIFT) /* Unprotected */
+# define W25X16_SR_BP_UPPER32nd (1 << W25_SR_BP_SHIFT) /* Upper 32nd */
+# define W25X16_SR_BP_UPPER16th (2 << W25_SR_BP_SHIFT) /* Upper 16th */
+# define W25X16_SR_BP_UPPER8th (3 << W25_SR_BP_SHIFT) /* Upper 8th */
+# define W25X16_SR_BP_UPPERQTR (4 << W25_SR_BP_SHIFT) /* Upper quarter */
+# define W25X16_SR_BP_UPPERHALF (5 << W25_SR_BP_SHIFT) /* Upper half */
+# define W25X16_SR_BP_ALL (6 << W25_SR_BP_SHIFT) /* All sectors */
+# define W25X16_SR_BP_LOWER32nd (9 << W25_SR_BP_SHIFT) /* Lower 32nd */
+# define W25X16_SR_BP_LOWER16th (10 << W25_SR_BP_SHIFT) /* Lower 16th */
+# define W25X16_SR_BP_LOWER8th (11 << W25_SR_BP_SHIFT) /* Lower 8th */
+# define W25X16_SR_BP_LOWERQTR (12 << W25_SR_BP_SHIFT) /* Lower quarter */
+# define W25X16_SR_BP_LOWERHALF (13 << W25_SR_BP_SHIFT) /* Lower half */
+
+# define W25X32_SR_BP_NONE (0 << W25_SR_BP_SHIFT) /* Unprotected */
+# define W25X32_SR_BP_UPPER64th (1 << W25_SR_BP_SHIFT) /* Upper 64th */
+# define W25X32_SR_BP_UPPER32nd (2 << W25_SR_BP_SHIFT) /* Upper 32nd */
+# define W25X32_SR_BP_UPPER16th (3 << W25_SR_BP_SHIFT) /* Upper 16th */
+# define W25X32_SR_BP_UPPER8th (4 << W25_SR_BP_SHIFT) /* Upper 8th */
+# define W25X32_SR_BP_UPPERQTR (5 << W25_SR_BP_SHIFT) /* Upper quarter */
+# define W25X32_SR_BP_UPPERHALF (6 << W25_SR_BP_SHIFT) /* Upper half */
+# define W25X32_SR_BP_ALL (7 << W25_SR_BP_SHIFT) /* All sectors */
+# define W25X32_SR_BP_LOWER64th (9 << W25_SR_BP_SHIFT) /* Lower 64th */
+# define W25X32_SR_BP_LOWER32nd (10 << W25_SR_BP_SHIFT) /* Lower 32nd */
+# define W25X32_SR_BP_LOWER16th (11 << W25_SR_BP_SHIFT) /* Lower 16th */
+# define W25X32_SR_BP_LOWER8th (12 << W25_SR_BP_SHIFT) /* Lower 8th */
+# define W25X32_SR_BP_LOWERQTR (13 << W25_SR_BP_SHIFT) /* Lower quarter */
+# define W25X32_SR_BP_LOWERHALF (14 << W25_SR_BP_SHIFT) /* Lower half */
+
+# define W25X64_SR_BP_NONE (0 << W25_SR_BP_SHIFT) /* Unprotected */
+# define W25X64_SR_BP_UPPER64th (1 << W25_SR_BP_SHIFT) /* Upper 64th */
+# define W25X64_SR_BP_UPPER32nd (2 << W25_SR_BP_SHIFT) /* Upper 32nd */
+# define W25X64_SR_BP_UPPER16th (3 << W25_SR_BP_SHIFT) /* Upper 16th */
+# define W25X64_SR_BP_UPPER8th (4 << W25_SR_BP_SHIFT) /* Upper 8th */
+# define W25X64_SR_BP_UPPERQTR (5 << W25_SR_BP_SHIFT) /* Upper quarter */
+# define W25X64_SR_BP_UPPERHALF (6 << W25_SR_BP_SHIFT) /* Upper half */
+# define W25X46_SR_BP_ALL (7 << W25_SR_BP_SHIFT) /* All sectors */
+# define W25X64_SR_BP_LOWER64th (9 << W25_SR_BP_SHIFT) /* Lower 64th */
+# define W25X64_SR_BP_LOWER32nd (10 << W25_SR_BP_SHIFT) /* Lower 32nd */
+# define W25X64_SR_BP_LOWER16th (11 << W25_SR_BP_SHIFT) /* Lower 16th */
+# define W25X64_SR_BP_LOWER8th (12 << W25_SR_BP_SHIFT) /* Lower 8th */
+# define W25X64_SR_BP_LOWERQTR (13 << W25_SR_BP_SHIFT) /* Lower quarter */
+# define W25X64_SR_BP_LOWERHALF (14 << W25_SR_BP_SHIFT) /* Lower half */
+ /* Bit 6: Reserved */
+#define W25_SR_SRP (1 << 7) /* Bit 7: Status register write protect */
+
+#define W25_DUMMY 0xa5
+
+/* Chip Geometries ******************************************************************/
+/* All members of the family support uniform 4K-byte sectors and 256 byte pages */
+
+#define W25_SECTOR_SHIFT 12 /* Sector size 1 << 12 = 4Kb */
+#define W25_SECTOR_SIZE (1 << 12) /* Sector size 1 << 12 = 4Kb */
+#define W25_PAGE_SHIFT 8 /* Sector size 1 << 8 = 256b */
+#define W25_PAGE_SIZE (1 << 8) /* Sector size 1 << 8 = 256b */
+
+#ifdef CONFIG_W25_SECTOR512 /* Simulate a 512 byte sector */
+# define W25_SECTOR512_SHIFT 9 /* Sector size 1 << 9 = 512 bytes */
+# define W25_SECTOR512_SIZE (1 << 9) /* Sector size 1 << 9 = 512 bytes */
+#endif
+
+#define W25_ERASED_STATE 0xff /* State of FLASH when erased */
+
+/* Cache flags */
+
+#define W25_CACHE_VALID (1 << 0) /* 1=Cache has valid data */
+#define W25_CACHE_DIRTY (1 << 1) /* 1=Cache is dirty */
+#define W25_CACHE_ERASED (1 << 2) /* 1=Backing FLASH is erased */
+
+#define IS_VALID(p) ((((p)->flags) & W25_CACHE_VALID) != 0)
+#define IS_DIRTY(p) ((((p)->flags) & W25_CACHE_DIRTY) != 0)
+#define IS_ERASED(p) ((((p)->flags) & W25_CACHE_DIRTY) != 0)
+
+#define SET_VALID(p) do { (p)->flags |= W25_CACHE_VALID; } while (0)
+#define SET_DIRTY(p) do { (p)->flags |= W25_CACHE_DIRTY; } while (0)
+#define SET_ERASED(p) do { (p)->flags |= W25_CACHE_DIRTY; } while (0)
+
+#define CLR_VALID(p) do { (p)->flags &= ~W25_CACHE_VALID; } while (0)
+#define CLR_DIRTY(p) do { (p)->flags &= ~W25_CACHE_DIRTY; } while (0)
+#define CLR_ERASED(p) do { (p)->flags &= ~W25_CACHE_DIRTY; } while (0)
+
+/************************************************************************************
+ * Private Types
+ ************************************************************************************/
+
+/* This type represents the state of the MTD device. The struct mtd_dev_s must
+ * appear at the beginning of the definition so that you can freely cast between
+ * pointers to struct mtd_dev_s and struct w25_dev_s.
+ */
+
+struct w25_dev_s
+{
+ struct mtd_dev_s mtd; /* MTD interface */
+ FAR struct spi_dev_s *spi; /* Saved SPI interface instance */
+ uint16_t nsectors; /* Number of erase sectors */
+
+#if defined(CONFIG_W25_SECTOR512) && !defined(CONFIG_W25_READONLY)
+ uint8_t flags; /* Buffered sector flags */
+ uint16_t esectno; /* Erase sector number in the cache*/
+ FAR uint8_t *sector; /* Allocated sector data */
+#endif
+};
+
+/************************************************************************************
+ * Private Function Prototypes
+ ************************************************************************************/
+
+/* Helpers */
+
+static void w25_lock(FAR struct spi_dev_s *spi);
+static inline void w25_unlock(FAR struct spi_dev_s *spi);
+static inline int w25_readid(FAR struct w25_dev_s *priv);
+#ifndef CONFIG_W25_READONLY
+static void w25_unprotect(FAR struct w25_dev_s *priv);
+#endif
+static uint8_t w25_waitwritecomplete(FAR struct w25_dev_s *priv);
+static inline void w25_wren(FAR struct w25_dev_s *priv);
+static inline void w25_wrdi(FAR struct w25_dev_s *priv);
+static void w25_sectorerase(FAR struct w25_dev_s *priv, off_t offset);
+static inline int w25_chiperase(FAR struct w25_dev_s *priv);
+static void w25_byteread(FAR struct w25_dev_s *priv, FAR uint8_t *buffer,
+ off_t address, size_t nbytes);
+#ifndef CONFIG_W25_READONLY
+static void w25_pagewrite(FAR struct w25_dev_s *priv, FAR const uint8_t *buffer,
+ off_t address, size_t nbytes);
+#endif
+#ifdef CONFIG_W25_SECTOR512
+static void w25_cacheflush(struct w25_dev_s *priv);
+static FAR uint8_t *w25_cacheread(struct w25_dev_s *priv, off_t sector);
+static void w25_cacheerase(struct w25_dev_s *priv, off_t sector);
+static void w25_cachewrite(FAR struct w25_dev_s *priv, FAR const uint8_t *buffer,
+ off_t sector, size_t nsectors);
+#endif
+
+/* MTD driver methods */
+
+static int w25_erase(FAR struct mtd_dev_s *dev, off_t startblock, size_t nblocks);
+static ssize_t w25_bread(FAR struct mtd_dev_s *dev, off_t startblock,
+ size_t nblocks, FAR uint8_t *buf);
+static ssize_t w25_bwrite(FAR struct mtd_dev_s *dev, off_t startblock,
+ size_t nblocks, FAR const uint8_t *buf);
+static ssize_t w25_read(FAR struct mtd_dev_s *dev, off_t offset, size_t nbytes,
+ FAR uint8_t *buffer);
+static int w25_ioctl(FAR struct mtd_dev_s *dev, int cmd, unsigned long arg);
+
+/************************************************************************************
+ * Private Data
+ ************************************************************************************/
+
+/************************************************************************************
+ * Private Functions
+ ************************************************************************************/
+
+/************************************************************************************
+ * Name: w25_lock
+ ************************************************************************************/
+
+static void w25_lock(FAR struct spi_dev_s *spi)
+{
+ /* On SPI busses where there are multiple devices, it will be necessary to
+ * lock SPI to have exclusive access to the busses for a sequence of
+ * transfers. The bus should be locked before the chip is selected.
+ *
+ * This is a blocking call and will not return until we have exclusiv access to
+ * the SPI buss. We will retain that exclusive access until the bus is unlocked.
+ */
+
+ (void)SPI_LOCK(spi, true);
+
+ /* After locking the SPI bus, the we also need call the setfrequency, setbits, and
+ * setmode methods to make sure that the SPI is properly configured for the device.
+ * If the SPI buss is being shared, then it may have been left in an incompatible
+ * state.
+ */
+
+ SPI_SETMODE(spi, CONFIG_W25_SPIMODE);
+ SPI_SETBITS(spi, 8);
+ (void)SPI_SETFREQUENCY(spi, CONFIG_W25_SPIFREQUENCY);
+}
+
+/************************************************************************************
+ * Name: w25_unlock
+ ************************************************************************************/
+
+static inline void w25_unlock(FAR struct spi_dev_s *spi)
+{
+ (void)SPI_LOCK(spi, false);
+}
+
+/************************************************************************************
+ * Name: w25_readid
+ ************************************************************************************/
+
+static inline int w25_readid(struct w25_dev_s *priv)
+{
+ uint16_t manufacturer;
+ uint16_t memory;
+ uint16_t capacity;
+
+ fvdbg("priv: %p\n", priv);
+
+ /* Lock the SPI bus, configure the bus, and select this FLASH part. */
+
+ w25_lock(priv->spi);
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send the "Read ID (RDID)" command and read the first three ID bytes */
+
+ (void)SPI_SEND(priv->spi, W25_JEDEC_ID);
+ manufacturer = SPI_SEND(priv->spi, W25_DUMMY);
+ memory = SPI_SEND(priv->spi, W25_DUMMY);
+ capacity = SPI_SEND(priv->spi, W25_DUMMY);
+
+ /* Deselect the FLASH and unlock the bus */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+ w25_unlock(priv->spi);
+
+ fvdbg("manufacturer: %02x memory: %02x capacity: %02x\n",
+ manufacturer, memory, capacity);
+
+ /* Check for a valid manufacturer and memory type */
+
+ if (manufacturer == W25_JEDEC_MANUFACTURER &&
+ (memory == W25X_JEDEC_MEMORY_TYPE ||
+ memory == W25Q_JEDEC_MEMORY_TYPE_A ||
+ memory == W25Q_JEDEC_MEMORY_TYPE_B))
+ {
+ /* Okay.. is it a FLASH capacity that we understand? If so, save
+ * the FLASH capacity.
+ */
+
+ /* 16M-bit / 2M-byte (2,097,152)
+ *
+ * W24X16, W25Q16BV, W25Q16CL, W25Q16CV, W25Q16DW
+ */
+
+ if (capacity == W25_JEDEC_CAPACITY_16MBIT)
+ {
+ priv->nsectors = NSECTORS_16MBIT;
+ }
+
+ /* 32M-bit / M-byte (4,194,304)
+ *
+ * W25X32, W25Q32BV, W25Q32DW
+ */
+
+ else if (capacity == W25_JEDEC_CAPACITY_32MBIT)
+ {
+ priv->nsectors = NSECTORS_32MBIT;
+ }
+
+ /* 64M-bit / 8M-byte (8,388,608)
+ *
+ * W25X64, W25Q64BV, W25Q64CV, W25Q64DW
+ */
+
+ else if (capacity == W25_JEDEC_CAPACITY_64MBIT)
+ {
+ priv->nsectors = NSECTORS_64MBIT;
+ }
+
+ /* 128M-bit / 16M-byte (16,777,216)
+ *
+ * W25Q128BV
+ */
+
+ else if (capacity == W25_JEDEC_CAPACITY_128MBIT)
+ {
+ priv->nsectors = NSECTORS_128MBIT;
+ }
+ else
+ {
+ /* Nope.. we don't understand this capacity. */
+
+ return -ENODEV;
+ }
+
+ return OK;
+ }
+
+ /* We don't understand the manufacturer or the memory type */
+
+ return -ENODEV;
+}
+
+/************************************************************************************
+ * Name: w25_unprotect
+ ************************************************************************************/
+
+#ifndef CONFIG_W25_READONLY
+static void w25_unprotect(FAR struct w25_dev_s *priv)
+{
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send "Write enable (WREN)" */
+
+ w25_wren(priv);
+
+ /* Re-select this FLASH part (This might not be necessary... but is it shown in
+ * the SST25 timing diagrams from which this code was leveraged.)
+ */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send "Write enable status (EWSR)" */
+
+ SPI_SEND(priv->spi, W25_WRSR);
+
+ /* Following by the new status value */
+
+ SPI_SEND(priv->spi, 0);
+ SPI_SEND(priv->spi, 0);
+}
+#endif
+
+/************************************************************************************
+ * Name: w25_waitwritecomplete
+ ************************************************************************************/
+
+static uint8_t w25_waitwritecomplete(struct w25_dev_s *priv)
+{
+ uint8_t status;
+
+ /* Are we the only device on the bus? */
+
+#ifdef CONFIG_SPI_OWNBUS
+
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send "Read Status Register (RDSR)" command */
+
+ (void)SPI_SEND(priv->spi, W25_RDSR);
+
+ /* Loop as long as the memory is busy with a write cycle */
+
+ do
+ {
+ /* Send a dummy byte to generate the clock needed to shift out the status */
+
+ status = SPI_SEND(priv->spi, W25_DUMMY);
+ }
+ while ((status & W25_SR_BUSY) != 0);
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+
+#else
+
+ /* Loop as long as the memory is busy with a write cycle */
+
+ do
+ {
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send "Read Status Register (RDSR)" command */
+
+ (void)SPI_SEND(priv->spi, W25_RDSR);
+
+ /* Send a dummy byte to generate the clock needed to shift out the status */
+
+ status = SPI_SEND(priv->spi, W25_DUMMY);
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+
+ /* Given that writing could take up to few tens of milliseconds, and erasing
+ * could take more. The following short delay in the "busy" case will allow
+ * other peripherals to access the SPI bus.
+ */
+
+#if 0 /* Makes writes too slow */
+ if ((status & W25_SR_BUSY) != 0)
+ {
+ w25_unlock(priv->spi);
+ usleep(1000);
+ w25_lock(priv->spi);
+ }
+#endif
+ }
+ while ((status & W25_SR_BUSY) != 0);
+#endif
+
+ return status;
+}
+
+/************************************************************************************
+ * Name: w25_wren
+ ************************************************************************************/
+
+static inline void w25_wren(struct w25_dev_s *priv)
+{
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send "Write Enable (WREN)" command */
+
+ (void)SPI_SEND(priv->spi, W25_WREN);
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+}
+
+/************************************************************************************
+ * Name: w25_wrdi
+ ************************************************************************************/
+
+static inline void w25_wrdi(struct w25_dev_s *priv)
+{
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send "Write Disable (WRDI)" command */
+
+ (void)SPI_SEND(priv->spi, W25_WRDI);
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+}
+
+/************************************************************************************
+ * Name: w25_sectorerase
+ ************************************************************************************/
+
+static void w25_sectorerase(struct w25_dev_s *priv, off_t sector)
+{
+ off_t address = sector << W25_SECTOR_SHIFT;
+
+ fvdbg("sector: %08lx\n", (long)sector);
+
+ /* Wait for any preceding write or erase operation to complete. */
+
+ (void)w25_waitwritecomplete(priv);
+
+ /* Send write enable instruction */
+
+ w25_wren(priv);
+
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send the "Sector Erase (SE)" instruction */
+
+ (void)SPI_SEND(priv->spi, W25_SE);
+
+ /* Send the sector address high byte first. Only the most significant bits (those
+ * corresponding to the sector) have any meaning.
+ */
+
+ (void)SPI_SEND(priv->spi, (address >> 16) & 0xff);
+ (void)SPI_SEND(priv->spi, (address >> 8) & 0xff);
+ (void)SPI_SEND(priv->spi, address & 0xff);
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+}
+
+/************************************************************************************
+ * Name: w25_chiperase
+ ************************************************************************************/
+
+static inline int w25_chiperase(struct w25_dev_s *priv)
+{
+ fvdbg("priv: %p\n", priv);
+
+ /* Wait for any preceding write or erase operation to complete. */
+
+ (void)w25_waitwritecomplete(priv);
+
+ /* Send write enable instruction */
+
+ w25_wren(priv);
+
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send the "Chip Erase (CE)" instruction */
+
+ (void)SPI_SEND(priv->spi, W25_CE);
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+ fvdbg("Return: OK\n");
+ return OK;
+}
+
+/************************************************************************************
+ * Name: w25_byteread
+ ************************************************************************************/
+
+static void w25_byteread(FAR struct w25_dev_s *priv, FAR uint8_t *buffer,
+ off_t address, size_t nbytes)
+{
+ uint8_t status;
+
+ fvdbg("address: %08lx nbytes: %d\n", (long)address, (int)nbytes);
+
+ /* Wait for any preceding write or erase operation to complete. */
+
+ status = w25_waitwritecomplete(priv);
+ DEBUGASSERT((status & (W25_SR_WEL|W25_SR_BP_MASK)) == 0);
+
+ /* Make sure that writing is disabled */
+
+ w25_wrdi(priv);
+
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send "Read from Memory " instruction */
+
+#ifdef CONFIG_W25_SLOWREAD
+ (void)SPI_SEND(priv->spi, W25_RDDATA);
+#else
+ (void)SPI_SEND(priv->spi, W25_FRD);
+#endif
+
+ /* Send the address high byte first. */
+
+ (void)SPI_SEND(priv->spi, (address >> 16) & 0xff);
+ (void)SPI_SEND(priv->spi, (address >> 8) & 0xff);
+ (void)SPI_SEND(priv->spi, address & 0xff);
+
+ /* Send a dummy byte */
+
+#ifndef CONFIG_W25_SLOWREAD
+ (void)SPI_SEND(priv->spi, W25_DUMMY);
+#endif
+
+ /* Then read all of the requested bytes */
+
+ SPI_RECVBLOCK(priv->spi, buffer, nbytes);
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+}
+
+/************************************************************************************
+ * Name: w25_pagewrite
+ ************************************************************************************/
+
+#ifndef CONFIG_W25_READONLY
+static void w25_pagewrite(struct w25_dev_s *priv, FAR const uint8_t *buffer,
+ off_t address, size_t nbytes)
+{
+ uint8_t status;
+
+ fvdbg("address: %08lx nwords: %d\n", (long)address, (int)nbytes);
+ DEBUGASSERT(priv && buffer && ((uintptr_t)buffer & 0xff) == 0 &&
+ (nbytes & 0xff) == 0);
+
+ for (; nbytes > 0; nbytes -= W25_PAGE_SIZE)
+ {
+ /* Wait for any preceding write or erase operation to complete. */
+
+ status = w25_waitwritecomplete(priv);
+ DEBUGASSERT((status & (W25_SR_WEL|W25_SR_BP_MASK)) == 0);
+
+ /* Enable write access to the FLASH */
+
+ w25_wren(priv);
+
+ /* Select this FLASH part */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, true);
+
+ /* Send the "Page Program (W25_PP)" Command */
+
+ SPI_SEND(priv->spi, W25_PP);
+
+ /* Send the address high byte first. */
+
+ (void)SPI_SEND(priv->spi, (address >> 16) & 0xff);
+ (void)SPI_SEND(priv->spi, (address >> 8) & 0xff);
+ (void)SPI_SEND(priv->spi, address & 0xff);
+
+ /* Then send the page of data */
+
+ SPI_SNDBLOCK(priv->spi, buffer, W25_PAGE_SIZE);
+
+ /* Deselect the FLASH and setup for the next pass through the loop */
+
+ SPI_SELECT(priv->spi, SPIDEV_FLASH, false);
+
+ /* Update addresses */
+
+ address += W25_PAGE_SIZE;
+ buffer += W25_PAGE_SIZE;
+ }
+
+ /* Disable writing */
+
+ w25_wrdi(priv);
+}
+#endif
+
+/************************************************************************************
+ * Name: w25_cacheflush
+ ************************************************************************************/
+
+#if defined(CONFIG_W25_SECTOR512) && !defined(CONFIG_W25_READONLY)
+static void w25_cacheflush(struct w25_dev_s *priv)
+{
+ /* If the cached is dirty (meaning that it no longer matches the old FLASH contents)
+ * or was erased (with the cache containing the correct FLASH contents), then write
+ * the cached erase block to FLASH.
+ */
+
+ if (IS_DIRTY(priv) || IS_ERASED(priv))
+ {
+ /* Write entire erase block to FLASH */
+
+ w25_pagewrite(priv, priv->sector, (off_t)priv->esectno << W25_SECTOR_SHIFT,
+ W25_SECTOR_SIZE);
+
+ /* The case is no long dirty and the FLASH is no longer erased */
+
+ CLR_DIRTY(priv);
+ CLR_ERASED(priv);
+ }
+}
+#endif
+
+/************************************************************************************
+ * Name: w25_cacheread
+ ************************************************************************************/
+
+#if defined(CONFIG_W25_SECTOR512) && !defined(CONFIG_W25_READONLY)
+static FAR uint8_t *w25_cacheread(struct w25_dev_s *priv, off_t sector)
+{
+ off_t esectno;
+ int shift;
+ int index;
+
+ /* Convert from the 512 byte sector to the erase sector size of the device. For
+ * exmample, if the actual erase sector size if 4Kb (1 << 12), then we first
+ * shift to the right by 3 to get the sector number in 4096 increments.
+ */
+
+ shift = W25_SECTOR_SHIFT - W25_SECTOR512_SHIFT;
+ esectno = sector >> shift;
+ fvdbg("sector: %ld esectno: %d shift=%d\n", sector, esectno, shift);
+
+ /* Check if the requested erase block is already in the cache */
+
+ if (!IS_VALID(priv) || esectno != priv->esectno)
+ {
+ /* No.. Flush any dirty erase block currently in the cache */
+
+ w25_cacheflush(priv);
+
+ /* Read the erase block into the cache */
+
+ w25_byteread(priv, priv->sector, (esectno << W25_SECTOR_SHIFT), W25_SECTOR_SIZE);
+
+ /* Mark the sector as cached */
+
+ priv->esectno = esectno;
+
+ SET_VALID(priv); /* The data in the cache is valid */
+ CLR_DIRTY(priv); /* It should match the FLASH contents */
+ CLR_ERASED(priv); /* The underlying FLASH has not been erased */
+ }
+
+ /* Get the index to the 512 sector in the erase block that holds the argument */
+
+ index = sector & ((1 << shift) - 1);
+
+ /* Return the address in the cache that holds this sector */
+
+ return &priv->sector[index << W25_SECTOR512_SHIFT];
+}
+#endif
+
+/************************************************************************************
+ * Name: w25_cacheerase
+ ************************************************************************************/
+
+#if defined(CONFIG_W25_SECTOR512) && !defined(CONFIG_W25_READONLY)
+static void w25_cacheerase(struct w25_dev_s *priv, off_t sector)
+{
+ FAR uint8_t *dest;
+
+ /* First, make sure that the erase block containing the 512 byte sector is in
+ * the cache.
+ */
+
+ dest = w25_cacheread(priv, sector);
+
+ /* Erase the block containing this sector if it is not already erased.
+ * The erased indicated will be cleared when the data from the erase sector
+ * is read into the cache and set here when we erase the block.
+ */
+
+ if (!IS_ERASED(priv))
+ {
+ off_t esectno = sector >> (W25_SECTOR_SHIFT - W25_SECTOR512_SHIFT);
+ fvdbg("sector: %ld esectno: %d\n", sector, esectno);
+
+ w25_sectorerase(priv, esectno);
+ SET_ERASED(priv);
+ }
+
+ /* Put the cached sector data into the erase state and mart the cache as dirty
+ * (but don't update the FLASH yet. The caller will do that at a more optimal
+ * time).
+ */
+
+ memset(dest, W25_ERASED_STATE, W25_SECTOR512_SIZE);
+ SET_DIRTY(priv);
+}
+#endif
+
+/************************************************************************************
+ * Name: w25_cachewrite
+ ************************************************************************************/
+
+#if defined(CONFIG_W25_SECTOR512) && !defined(CONFIG_W25_READONLY)
+static void w25_cachewrite(FAR struct w25_dev_s *priv, FAR const uint8_t *buffer,
+ off_t sector, size_t nsectors)
+{
+ FAR uint8_t *dest;
+
+ for (; nsectors > 0; nsectors--)
+ {
+ /* First, make sure that the erase block containing 512 byte sector is in
+ * memory.
+ */
+
+ dest = w25_cacheread(priv, sector);
+
+ /* Erase the block containing this sector if it is not already erased.
+ * The erased indicated will be cleared when the data from the erase sector
+ * is read into the cache and set here when we erase the sector.
+ */
+
+ if (!IS_ERASED(priv))
+ {
+ off_t esectno = sector >> (W25_SECTOR_SHIFT - W25_SECTOR512_SHIFT);
+ fvdbg("sector: %ld esectno: %d\n", sector, esectno);
+
+ w25_sectorerase(priv, esectno);
+ SET_ERASED(priv);
+ }
+
+ /* Copy the new sector data into cached erase block */
+
+ memcpy(dest, buffer, W25_SECTOR512_SIZE);
+ SET_DIRTY(priv);
+
+ /* Set up for the next 512 byte sector */
+
+ buffer += W25_SECTOR512_SIZE;
+ sector++;
+ }
+
+ /* Flush the last erase block left in the cache */
+
+ w25_cacheflush(priv);
+}
+#endif
+
+/************************************************************************************
+ * Name: w25_erase
+ ************************************************************************************/
+
+static int w25_erase(FAR struct mtd_dev_s *dev, off_t startblock, size_t nblocks)
+{
+#ifdef CONFIG_W25_READONLY
+ return -EACESS
+#else
+ FAR struct w25_dev_s *priv = (FAR struct w25_dev_s *)dev;
+ size_t blocksleft = nblocks;
+
+ fvdbg("startblock: %08lx nblocks: %d\n", (long)startblock, (int)nblocks);
+
+ /* Lock access to the SPI bus until we complete the erase */
+
+ w25_lock(priv->spi);
+
+ while (blocksleft-- > 0)
+ {
+ /* Erase each sector */
+
+#ifdef CONFIG_W25_SECTOR512
+ w25_cacheerase(priv, startblock);
+#else
+ w25_sectorerase(priv, startblock);
+#endif
+ startblock++;
+ }
+
+#ifdef CONFIG_W25_SECTOR512
+ /* Flush the last erase block left in the cache */
+
+ w25_cacheflush(priv);
+#endif
+
+ w25_unlock(priv->spi);
+ return (int)nblocks;
+#endif
+}
+
+/************************************************************************************
+ * Name: w25_bread
+ ************************************************************************************/
+
+static ssize_t w25_bread(FAR struct mtd_dev_s *dev, off_t startblock, size_t nblocks,
+ FAR uint8_t *buffer)
+{
+#ifdef CONFIG_W25_SECTOR512
+ ssize_t nbytes;
+
+ fvdbg("startblock: %08lx nblocks: %d\n", (long)startblock, (int)nblocks);
+
+ /* On this device, we can handle the block read just like the byte-oriented read */
+
+ nbytes = w25_read(dev, startblock << W25_SECTOR512_SHIFT, nblocks << W25_SECTOR512_SHIFT, buffer);
+ if (nbytes > 0)
+ {
+ return nbytes >> W25_SECTOR512_SHIFT;
+ }
+
+ return (int)nbytes;
+#else
+ FAR struct w25_dev_s *priv = (FAR struct w25_dev_s *)dev;
+ ssize_t nbytes;
+
+ fvdbg("startblock: %08lx nblocks: %d\n", (long)startblock, (int)nblocks);
+
+ /* On this device, we can handle the block read just like the byte-oriented read */
+
+ nbytes = w25_read(dev, startblock << W25_SECTOR_SHIFT, nblocks << W25_SECTOR_SHIFT, buffer);
+ if (nbytes > 0)
+ {
+ return nbytes >> W25_SECTOR_SHIFT;
+ }
+
+ return (int)nbytes;
+#endif
+}
+
+/************************************************************************************
+ * Name: w25_bwrite
+ ************************************************************************************/
+
+static ssize_t w25_bwrite(FAR struct mtd_dev_s *dev, off_t startblock, size_t nblocks,
+ FAR const uint8_t *buffer)
+{
+#ifdef CONFIG_W25_READONLY
+ return -EACCESS;
+#else
+ FAR struct w25_dev_s *priv = (FAR struct w25_dev_s *)dev;
+
+ fvdbg("startblock: %08lx nblocks: %d\n", (long)startblock, (int)nblocks);
+
+ /* Lock the SPI bus and write all of the pages to FLASH */
+
+ w25_lock(priv->spi);
+
+#if defined(CONFIG_W25_SECTOR512)
+ w25_cachewrite(priv, buffer, startblock, nblocks);
+#else
+ w25_pagewrite(priv, buffer, startblock << W25_SECTOR_SHIFT,
+ nblocks << W25_SECTOR_SHIFT);
+#endif
+ w25_unlock(priv->spi);
+
+ return nblocks;
+#endif
+}
+
+/************************************************************************************
+ * Name: w25_read
+ ************************************************************************************/
+
+static ssize_t w25_read(FAR struct mtd_dev_s *dev, off_t offset, size_t nbytes,
+ FAR uint8_t *buffer)
+{
+ FAR struct w25_dev_s *priv = (FAR struct w25_dev_s *)dev;
+
+ fvdbg("offset: %08lx nbytes: %d\n", (long)offset, (int)nbytes);
+
+ /* Lock the SPI bus and select this FLASH part */
+
+ w25_lock(priv->spi);
+ w25_byteread(priv, buffer, offset, nbytes);
+ w25_unlock(priv->spi);
+
+ fvdbg("return nbytes: %d\n", (int)nbytes);
+ return nbytes;
+}
+
+/************************************************************************************
+ * Name: w25_ioctl
+ ************************************************************************************/
+
+static int w25_ioctl(FAR struct mtd_dev_s *dev, int cmd, unsigned long arg)
+{
+ FAR struct w25_dev_s *priv = (FAR struct w25_dev_s *)dev;
+ int ret = -EINVAL; /* Assume good command with bad parameters */
+
+ fvdbg("cmd: %d \n", cmd);
+
+ switch (cmd)
+ {
+ case MTDIOC_GEOMETRY:
+ {
+ FAR struct mtd_geometry_s *geo = (FAR struct mtd_geometry_s *)((uintptr_t)arg);
+ if (geo)
+ {
+ /* Populate the geometry structure with information need to know
+ * the capacity and how to access the device.
+ *
+ * NOTE: that the device is treated as though it where just an array
+ * of fixed size blocks. That is most likely not true, but the client
+ * will expect the device logic to do whatever is necessary to make it
+ * appear so.
+ */
+
+#ifdef CONFIG_W25_SECTOR512
+ geo->blocksize = (1 << W25_SECTOR512_SHIFT);
+ geo->erasesize = (1 << W25_SECTOR512_SHIFT);
+ geo->neraseblocks = priv->nsectors << (W25_SECTOR_SHIFT - W25_SECTOR512_SHIFT);
+#else
+ geo->blocksize = W25_SECTOR_SIZE;
+ geo->erasesize = W25_SECTOR_SIZE;
+ geo->neraseblocks = priv->nsectors;
+#endif
+ ret = OK;
+
+ fvdbg("blocksize: %d erasesize: %d neraseblocks: %d\n",
+ geo->blocksize, geo->erasesize, geo->neraseblocks);
+ }
+ }
+ break;
+
+ case MTDIOC_BULKERASE:
+ {
+ /* Erase the entire device */
+
+ w25_lock(priv->spi);
+ ret = w25_chiperase(priv);
+ w25_unlock(priv->spi);
+ }
+ break;
+
+ case MTDIOC_XIPBASE:
+ default:
+ ret = -ENOTTY; /* Bad command */
+ break;
+ }
+
+ fvdbg("return %d\n", ret);
+ return ret;
+}
+
+/************************************************************************************
+ * Public Functions
+ ************************************************************************************/
+
+/************************************************************************************
+ * Name: w25_initialize
+ *
+ * Description:
+ * Create an initialize MTD device instance. MTD devices are not registered
+ * in the file system, but are created as instances that can be bound to
+ * other functions (such as a block or character driver front end).
+ *
+ ************************************************************************************/
+
+FAR struct mtd_dev_s *w25_initialize(FAR struct spi_dev_s *spi)
+{
+ FAR struct w25_dev_s *priv;
+ int ret;
+
+ fvdbg("spi: %p\n", spi);
+
+ /* Allocate a state structure (we allocate the structure instead of using
+ * a fixed, static allocation so that we can handle multiple FLASH devices.
+ * The current implementation would handle only one FLASH part per SPI
+ * device (only because of the SPIDEV_FLASH definition) and so would have
+ * to be extended to handle multiple FLASH parts on the same SPI bus.
+ */
+
+ priv = (FAR struct w25_dev_s *)kzalloc(sizeof(struct w25_dev_s));
+ if (priv)
+ {
+ /* Initialize the allocated structure */
+
+ priv->mtd.erase = w25_erase;
+ priv->mtd.bread = w25_bread;
+ priv->mtd.bwrite = w25_bwrite;
+ priv->mtd.read = w25_read;
+ priv->mtd.ioctl = w25_ioctl;
+ priv->spi = spi;
+
+ /* Deselect the FLASH */
+
+ SPI_SELECT(spi, SPIDEV_FLASH, false);
+
+ /* Identify the FLASH chip and get its capacity */
+
+ ret = w25_readid(priv);
+ if (ret != OK)
+ {
+ /* Unrecognized! Discard all of that work we just did and return NULL */
+
+ fdbg("Unrecognized\n");
+ kfree(priv);
+ priv = NULL;
+ }
+ else
+ {
+ /* Make sure the the FLASH is unprotected so that we can write into it */
+
+#ifndef CONFIG_W25_READONLY
+ w25_unprotect(priv);
+#endif
+
+#ifdef CONFIG_W25_SECTOR512 /* Simulate a 512 byte sector */
+ /* Allocate a buffer for the erase block cache */
+
+ priv->sector = (FAR uint8_t *)kmalloc(W25_SECTOR_SIZE);
+ if (!priv->sector)
+ {
+ /* Allocation failed! Discard all of that work we just did and return NULL */
+
+ fdbg("Allocation failed\n");
+ kfree(priv);
+ priv = NULL;
+ }
+#endif
+ }
+ }
+
+ /* Return the implementation-specific state structure as the MTD device */
+
+ fvdbg("Return %p\n", priv);
+ return (FAR struct mtd_dev_s *)priv;
+}
diff --git a/nuttx/drivers/net/Kconfig b/nuttx/drivers/net/Kconfig
index b5c09bf01..a42d35fea 100644
--- a/nuttx/drivers/net/Kconfig
+++ b/nuttx/drivers/net/Kconfig
@@ -25,6 +25,7 @@ config ENC28J60
References:
ENC28J60 Data Sheet, Stand-Alone Ethernet Controller with SPI Interface,
DS39662C, 2008 Microchip Technology Inc.
+
if ENC28J60
config ENC28J60_NINTERFACES
int "Number of physical ENC28J60"
@@ -61,6 +62,14 @@ config ENC28J60_HALFDUPPLEX
default n
---help---
Default is full duplex
+
+config ENC28J60_DUMPPACKET
+ bool "Dump Packets"
+ default n
+ ---help---
+ If selected, the ENC28J60 driver will dump the contents of each
+ packet to the console.
+
endif
config NET_E1000
diff --git a/nuttx/drivers/net/enc28j60.c b/nuttx/drivers/net/enc28j60.c
index 47a84ec9f..bb79910b3 100644
--- a/nuttx/drivers/net/enc28j60.c
+++ b/nuttx/drivers/net/enc28j60.c
@@ -110,7 +110,7 @@
/* We need to have the work queue to handle SPI interrupts */
-#if !defined(CONFIG_SCHED_WORKQUEUE) && !defined(CONFIG_SPI_OWNBUS)
+#ifndef CONFIG_SCHED_WORKQUEUE
# error "Worker thread support is required (CONFIG_SCHED_WORKQUEUE)"
#endif
@@ -122,6 +122,12 @@
# define enc_dumppacket(m,a,n)
#endif
+/* The ENC28J60 will not do interrupt level processing */
+
+#ifndef CONFIG_NET_NOINTS
+# warrning "CONFIG_NET_NOINTS should be set"
+#endif
+
/* Timing *******************************************************************/
/* TX poll deley = 1 seconds. CLK_TCK is the number of clock ticks per second */
@@ -144,7 +150,7 @@
#define ALIGNED_BUFSIZE ((CONFIG_NET_BUFSIZE + 255) & ~255)
#define PKTMEM_TX_START 0x0000 /* Start TX buffer at 0 */
-#define PKTMEM_TX_ENDP1 ALIGNED_BUFSIZE /* Allow TX buffer for one frame + */
+#define PKTMEM_TX_ENDP1 ALIGNED_BUFSIZE /* Allow TX buffer for one frame */
#define PKTMEM_RX_START PKTMEM_TX_ENDP1 /* Followed by RX buffer */
#define PKTMEM_RX_END PKTMEM_END /* RX buffer goes to the end of SRAM */
@@ -171,7 +177,7 @@
enum enc_state_e
{
- ENCSTATE_UNIT = 0, /* The interface is in an unknown state */
+ ENCSTATE_UNINIT = 0, /* The interface is in an uninitialized state */
ENCSTATE_DOWN, /* The interface is down */
ENCSTATE_UP /* The interface is up */
};
@@ -200,10 +206,10 @@ struct enc_driver_s
/* If we don't own the SPI bus, then we cannot do SPI accesses from the
* interrupt handler.
*/
-
-#ifndef CONFIG_SPI_OWNBUS
- struct work_s work; /* Work queue support */
-#endif
+
+ struct work_s irqwork; /* Interrupt continuation work queue support */
+ struct work_s towork; /* Tx timeout work queue support */
+ struct work_s pollwork; /* Poll timeout work queue support */
/* This is the contained SPI driver intstance */
@@ -279,15 +285,17 @@ static void enc_txif(FAR struct enc_driver_s *priv);
static void enc_txerif(FAR struct enc_driver_s *priv);
static void enc_txerif(FAR struct enc_driver_s *priv);
static void enc_rxerif(FAR struct enc_driver_s *priv);
-static void enc_rxdispath(FAR struct enc_driver_s *priv);
+static void enc_rxdispatch(FAR struct enc_driver_s *priv);
static void enc_pktif(FAR struct enc_driver_s *priv);
-static void enc_worker(FAR void *arg);
+static void enc_irqworker(FAR void *arg);
static int enc_interrupt(int irq, FAR void *context);
/* Watchdog timer expirations */
-static void enc_polltimer(int argc, uint32_t arg, ...);
+static void enc_toworker(FAR void *arg);
static void enc_txtimeout(int argc, uint32_t arg, ...);
+static void enc_pollworker(FAR void *arg);
+static void enc_polltimer(int argc, uint32_t arg, ...);
/* NuttX callback functions */
@@ -1026,6 +1034,7 @@ static int enc_transmit(FAR struct enc_driver_s *priv)
* OK on success; a negated errno on failure
*
* Assumptions:
+ * Interrupts are enabled but the caller holds the uIP lock.
*
****************************************************************************/
@@ -1095,6 +1104,7 @@ static void enc_linkstatus(FAR struct enc_driver_s *priv)
* None
*
* Assumptions:
+ * Interrupts are enabled but the caller holds the uIP lock.
*
****************************************************************************/
@@ -1195,7 +1205,7 @@ static void enc_rxerif(FAR struct enc_driver_s *priv)
}
/****************************************************************************
- * Function: enc_rxdispath
+ * Function: enc_rxdispatch
*
* Description:
* Give the newly received packet to uIP.
@@ -1207,10 +1217,11 @@ static void enc_rxerif(FAR struct enc_driver_s *priv)
* None
*
* Assumptions:
+ * Interrupts are enabled but the caller holds the uIP lock.
*
****************************************************************************/
-static void enc_rxdispath(FAR struct enc_driver_s *priv)
+static void enc_rxdispatch(FAR struct enc_driver_s *priv)
{
/* We only accept IP packets of the configured type and ARP packets */
@@ -1267,6 +1278,7 @@ static void enc_rxdispath(FAR struct enc_driver_s *priv)
* None
*
* Assumptions:
+ * Interrupts are enabled but the caller holds the uIP lock.
*
****************************************************************************/
@@ -1326,7 +1338,7 @@ static void enc_pktif(FAR struct enc_driver_s *priv)
nlldbg("Bad packet size dropped (%d)\n", pktlen);
#ifdef CONFIG_ENC28J60_STATS
priv->stats.rxpktlen++;
-#endif
+#endif
}
/* Otherwise, read and process the packet */
@@ -1340,11 +1352,11 @@ static void enc_pktif(FAR struct enc_driver_s *priv)
/* Copy the data data from the receive buffer to priv->dev.d_buf */
enc_rdbuffer(priv, priv->dev.d_buf, priv->dev.d_len);
- enc_dumppacket("Received Packet", priv->ld_dev.d_buf, priv->ld_dev.d_len);
+ enc_dumppacket("Received Packet", priv->dev.d_buf, priv->dev.d_len);
/* Dispatch the packet to uIP */
- enc_rxdispath(priv);
+ enc_rxdispatch(priv);
}
/* Move the RX read pointer to the start of the next received packet.
@@ -1360,7 +1372,7 @@ static void enc_pktif(FAR struct enc_driver_s *priv)
}
/****************************************************************************
- * Function: enc_worker
+ * Function: enc_irqworker
*
* Description:
* Perform interrupt handling logic outside of the interrupt handler (on
@@ -1376,13 +1388,18 @@ static void enc_pktif(FAR struct enc_driver_s *priv)
*
****************************************************************************/
-static void enc_worker(FAR void *arg)
+static void enc_irqworker(FAR void *arg)
{
FAR struct enc_driver_s *priv = (FAR struct enc_driver_s *)arg;
+ uip_lock_t lock;
uint8_t eir;
DEBUGASSERT(priv);
+ /* Get exclusive access to uIP. */
+
+ lock = uip_lock();
+
/* Disable further interrupts by clearing the global interrupt enable bit.
* "After an interrupt occurs, the host controller should clear the global
* enable bit for the interrupt pin before servicing the interrupt. Clearing
@@ -1402,9 +1419,12 @@ static void enc_worker(FAR void *arg)
while ((eir = enc_rdgreg(priv, ENC_EIR) & EIR_ALLINTS) != 0)
{
/* Handle interrupts according to interrupt register register bit
- * settings
- *
- * DMAIF: The DMA interrupt indicates that the DMA module has completed
+ * settings.
+ */
+
+ nllvdbg("EIR: %02x\n", eir);
+
+ /* DMAIF: The DMA interrupt indicates that the DMA module has completed
* its memory copy or checksum calculation. Additionally, this interrupt
* will be caused if the host controller cancels a DMA operation by
* manually clearing the DMAST bit. Once set, DMAIF can only be cleared
@@ -1521,6 +1541,8 @@ static void enc_worker(FAR void *arg)
uint8_t pktcnt = enc_rdbreg(priv, ENC_EPKTCNT);
if (pktcnt > 0)
{
+ nllvdbg("EPKTCNT: %02x\n", pktcnt);
+
#ifdef CONFIG_ENC28J60_STATS
if (pktcnt > priv->stats.maxpktcnt)
{
@@ -1560,15 +1582,17 @@ static void enc_worker(FAR void *arg)
}
}
+ /* Release lock on uIP */
+
+ uip_unlock(lock);
+
/* Enable Ethernet interrupts */
enc_bfsgreg(priv, ENC_EIE, EIE_INTIE);
- /* Enable GPIO interrupts if they were disbled in enc_interrupt */
+ /* Enable GPIO interrupts */
-#ifndef CONFIG_SPI_OWNBUS
priv->lower->enable(priv->lower);
-#endif
}
/****************************************************************************
@@ -1592,15 +1616,6 @@ static int enc_interrupt(int irq, FAR void *context)
{
register FAR struct enc_driver_s *priv = &g_enc28j60[0];
-#ifdef CONFIG_SPI_OWNBUS
- /* In very simple environments, we own the SPI and can do data transfers
- * from the interrupt handler. That is actually a very bad idea in any
- * case because it keeps interrupts disabled for a long time.
- */
-
- enc_worker((FAR void*)priv);
- return OK;
-#else
/* In complex environments, we cannot do SPI transfers from the interrupt
* handler because semaphores are probably used to lock the SPI bus. In
* this case, we will defer processing to the worker thread. This is also
@@ -1608,28 +1623,26 @@ static int enc_interrupt(int irq, FAR void *context)
* a good thing to do in any event.
*/
- DEBUGASSERT(work_available(&priv->work));
+ DEBUGASSERT(work_available(&priv->irqwork));
/* Notice that further GPIO interrupts are disabled until the work is
* actually performed. This is to prevent overrun of the worker thread.
- * Interrupts are re-enabled in enc_worker() when the work is completed.
+ * Interrupts are re-enabled in enc_irqworker() when the work is completed.
*/
priv->lower->disable(priv->lower);
- return work_queue(HPWORK, &priv->work, enc_worker, (FAR void *)priv, 0);
-#endif
+ return work_queue(HPWORK, &priv->irqwork, enc_irqworker, (FAR void *)priv, 0);
}
/****************************************************************************
- * Function: enc_txtimeout
+ * Function: enc_toworker
*
* Description:
- * Our TX watchdog timed out. Called from the timer interrupt handler.
- * The last TX never completed. Reset the hardware and start again.
+ * Our TX watchdog timed out. This is the worker thread continuation of
+ * the watchdog timer interrupt. Reset the hardware and start again.
*
* Parameters:
- * argc - The number of available arguments
- * arg - The first argument
+ * arg - The reference to the driver structure (case to void*)
*
* Returned Value:
* None
@@ -1638,14 +1651,21 @@ static int enc_interrupt(int irq, FAR void *context)
*
****************************************************************************/
-static void enc_txtimeout(int argc, uint32_t arg, ...)
+static void enc_toworker(FAR void *arg)
{
FAR struct enc_driver_s *priv = (FAR struct enc_driver_s *)arg;
+ uip_lock_t lock;
int ret;
+ nlldbg("Tx timeout\n");
+ DEBUGASSERT(priv);
+
+ /* Get exclusive access to uIP. */
+
+ lock = uip_lock();
+
/* Increment statistics and dump debug info */
- nlldbg("Tx timeout\n");
#ifdef CONFIG_ENC28J60_STATS
priv->stats.txtimeouts++;
#endif
@@ -1662,13 +1682,18 @@ static void enc_txtimeout(int argc, uint32_t arg, ...)
/* Then poll uIP for new XMIT data */
(void)uip_poll(&priv->dev, enc_uiptxpoll);
+
+ /* Release lock on uIP */
+
+ uip_unlock(lock);
}
/****************************************************************************
- * Function: enc_polltimer
+ * Function: enc_txtimeout
*
* Description:
- * Periodic timer handler. Called from the timer interrupt handler.
+ * Our TX watchdog timed out. Called from the timer interrupt handler.
+ * The last TX never completed. Perform work on the worker thread.
*
* Parameters:
* argc - The number of available arguments
@@ -1681,9 +1706,55 @@ static void enc_txtimeout(int argc, uint32_t arg, ...)
*
****************************************************************************/
-static void enc_polltimer(int argc, uint32_t arg, ...)
+static void enc_txtimeout(int argc, uint32_t arg, ...)
{
FAR struct enc_driver_s *priv = (FAR struct enc_driver_s *)arg;
+ int ret;
+
+ /* In complex environments, we cannot do SPI transfers from the timout
+ * handler because semaphores are probably used to lock the SPI bus. In
+ * this case, we will defer processing to the worker thread. This is also
+ * much kinder in the use of system resources and is, therefore, probably
+ * a good thing to do in any event.
+ */
+
+ DEBUGASSERT(priv && work_available(&priv->towork));
+
+ /* Notice that Tx timeout watchdog is not active so further Tx timeouts
+ * can occur until we restart the Tx timeout watchdog.
+ */
+
+ ret = work_queue(HPWORK, &priv->towork, enc_toworker, (FAR void *)priv, 0);
+ DEBUGASSERT(ret == OK);
+}
+
+/****************************************************************************
+ * Function: enc_pollworker
+ *
+ * Description:
+ * Periodic timer handler continuation.
+ *
+ * Parameters:
+ * argc - The number of available arguments
+ * arg - The first argument
+ *
+ * Returned Value:
+ * None
+ *
+ * Assumptions:
+ *
+ ****************************************************************************/
+
+static void enc_pollworker(FAR void *arg)
+{
+ FAR struct enc_driver_s *priv = (FAR struct enc_driver_s *)arg;
+ uip_lock_t lock;
+
+ DEBUGASSERT(priv);
+
+ /* Get exclusive access to uIP. */
+
+ lock = uip_lock();
/* Verify that the hardware is ready to send another packet. The driver
* start a transmission process by setting ECON1.TXRTS. When the packet is
@@ -1701,12 +1772,55 @@ static void enc_polltimer(int argc, uint32_t arg, ...)
(void)uip_timer(&priv->dev, enc_uiptxpoll, ENC_POLLHSEC);
}
+ /* Release lock on uIP */
+
+ uip_unlock(lock);
+
/* Setup the watchdog poll timer again */
(void)wd_start(priv->txpoll, ENC_WDDELAY, enc_polltimer, 1, arg);
}
/****************************************************************************
+ * Function: enc_polltimer
+ *
+ * Description:
+ * Periodic timer handler. Called from the timer interrupt handler.
+ *
+ * Parameters:
+ * argc - The number of available arguments
+ * arg - The first argument
+ *
+ * Returned Value:
+ * None
+ *
+ * Assumptions:
+ *
+ ****************************************************************************/
+
+static void enc_polltimer(int argc, uint32_t arg, ...)
+{
+ FAR struct enc_driver_s *priv = (FAR struct enc_driver_s *)arg;
+ int ret;
+
+ /* In complex environments, we cannot do SPI transfers from the timout
+ * handler because semaphores are probably used to lock the SPI bus. In
+ * this case, we will defer processing to the worker thread. This is also
+ * much kinder in the use of system resources and is, therefore, probably
+ * a good thing to do in any event.
+ */
+
+ DEBUGASSERT(priv && work_available(&priv->pollwork));
+
+ /* Notice that poll watchdog is not active so further poll timeouts can
+ * occur until we restart the poll timeout watchdog.
+ */
+
+ ret = work_queue(HPWORK, &priv->pollwork, enc_pollworker, (FAR void *)priv, 0);
+ DEBUGASSERT(ret == OK);
+}
+
+/****************************************************************************
* Function: enc_ifup
*
* Description:
@@ -1747,11 +1861,9 @@ static int enc_ifup(struct uip_driver_s *dev)
*/
enc_wrphy(priv, ENC_PHIE, PHIE_PGEIE | PHIE_PLNKIE);
- enc_bfsgreg(priv, ENC_EIE, EIE_INTIE | EIE_PKTIE);
- enc_bfsgreg(priv, ENC_EIR, EIR_DMAIF | EIR_LINKIF | EIR_TXIF |
- EIR_TXERIF | EIR_RXERIF | EIR_PKTIF);
- enc_wrgreg(priv, ENC_EIE, EIE_INTIE | EIE_PKTIE | EIE_LINKIE |
- EIE_TXIE | EIE_TXERIE | EIE_RXERIE);
+ enc_bfcgreg(priv, ENC_EIR, EIR_ALLINTS);
+ enc_wrgreg(priv, ENC_EIE, EIE_INTIE | EIE_PKTIE | EIE_LINKIE |
+ EIE_TXIE | EIE_TXERIE | EIE_RXERIE);
/* Enable the receiver */
@@ -2180,7 +2292,7 @@ static int enc_reset(FAR struct enc_driver_s *priv)
enc_wrbreg(priv, ENC_MAIPGL, 0x12);
- /* Set ack-to-Back Inter-Packet Gap */
+ /* Set Back-to-Back Inter-Packet Gap */
enc_wrbreg(priv, ENC_MABBIPG, 0x15);
#endif
@@ -2265,7 +2377,7 @@ int enc_initialize(FAR struct spi_dev_s *spi,
* bringing the interface up.
*/
- priv->ifstate = ENCSTATE_UNIT;
+ priv->ifstate = ENCSTATE_UNINIT;
/* Attach the interrupt to the driver (but don't enable it yet) */
diff --git a/nuttx/drivers/net/enc28j60.h b/nuttx/drivers/net/enc28j60.h
index 3c787c533..dab9cc5cf 100644
--- a/nuttx/drivers/net/enc28j60.h
+++ b/nuttx/drivers/net/enc28j60.h
@@ -131,10 +131,10 @@
#define ECON1_BSEL_SHIFT (0) /* Bits 0-1: Bank select */
#define ECON1_BSEL_MASK (3 << ECON1_BSEL_SHIFT)
-# define ECON1_BSEL_BANK0 (0 << 0) /* Bank 0 */
-# define ECON1_BSEL_BANK1 (1 << 1) /* Bank 1 */
-# define ECON1_BSEL_BANK2 (2 << 0) /* Bank 2 */
-# define ECON1_BSEL_BANK3 (3 << 0) /* Bank 3 */
+# define ECON1_BSEL_BANK0 (0 << ECON1_BSEL_SHIFT) /* Bank 0 */
+# define ECON1_BSEL_BANK1 (1 << ECON1_BSEL_SHIFT) /* Bank 1 */
+# define ECON1_BSEL_BANK2 (2 << ECON1_BSEL_SHIFT) /* Bank 2 */
+# define ECON1_BSEL_BANK3 (3 << ECON1_BSEL_SHIFT) /* Bank 3 */
#define ECON1_RXEN (1 << 2) /* Bit 2: Receive Enable */
#define ECON1_TXRTS (1 << 3) /* Bit 3: Transmit Request to Send */
#define ECON1_CSUMEN (1 << 4) /* Bit 4: DMA Checksum Enable */