diff options
Diffstat (limited to 'os/ex/Micron/m25q.c')
-rw-r--r-- | os/ex/Micron/m25q.c | 181 |
1 files changed, 155 insertions, 26 deletions
diff --git a/os/ex/Micron/m25q.c b/os/ex/Micron/m25q.c index 9a170a17f..84a67f2cc 100644 --- a/os/ex/Micron/m25q.c +++ b/os/ex/Micron/m25q.c @@ -25,8 +25,9 @@ * @{ */ -#include "hal.h" +#include <string.h> +#include "hal.h" #include "m25q.h" /*===========================================================================*/ @@ -82,11 +83,7 @@ static flash_descriptor_t descriptor = { .attributes = FLASH_ATTR_ERASED_IS_ONE | FLASH_ATTR_REWRITABLE | FLASH_ATTR_SUSPEND_ERASE_CAPABLE, .page_size = 256U, -#if M25Q_USE_SUB_SECTORS == TRUE - .sectors_count = 4096U, -#else - .sectors_count = 256U, -#endif + .sectors_count = 0U, /* It is overwritten.*/ .sectors = NULL, .sectors_size = SECTOR_SIZE, .address = 0U @@ -209,9 +206,11 @@ static const uint8_t evconf_value[1] = {0xCF}; #elif M25Q_BUS_MODE == M25Q_BUS_MODE_QSPI2L static const uint8_t evconf_value[1] = {0x8F}; #else -static const uint8_t evconf_value[1] = {0xCF};//{0x4F}; +static const uint8_t evconf_value[1] = {0x4F}; #endif +static const uint8_t flash_status[1] = {(M25Q_READ_DUMMY_CYCLES << 4U) | 0x0FU}; + #endif /* M25Q_BUS_MODE != M25Q_BUS_MODE_SPI */ /*===========================================================================*/ @@ -314,6 +313,39 @@ static void flash_cmd_receive(M25QDriver *devp, #endif } +static void flash_cmd_send(M25QDriver *devp, + uint8_t cmd, + size_t n, + const uint8_t *p) { +#if M25Q_BUS_MODE != M25Q_BUS_MODE_SPI + qspi_command_t mode; + + mode.cfg = QSPI_CFG_CMD(cmd) | +#if M25Q_BUS_MODE == M25Q_BUS_MODE_QSPI1L + QSPI_CFG_CMD_MODE_ONE_LINE | + QSPI_CFG_DATA_MODE_ONE_LINE; +#elif M25Q_BUS_MODE == M25Q_BUS_MODE_QSPI2L + QSPI_CFG_CMD_MODE_TWO_LINES | + QSPI_CFG_DATA_MODE_TWO_LINES; +#else + QSPI_CFG_CMD_MODE_FOUR_LINES | + QSPI_CFG_DATA_MODE_FOUR_LINES; + +#endif + mode.addr = 0U; + mode.alt = 0U; + qspiSend(devp->config->qspip, &mode, n, p); +#else + uint8_t buf[1]; + + spiSelect(devp->config->spip); + buf[0] = cmd; + spiSend(devp->config->spip, 1, buf); + spiSend(devp->config->spip, n, p); + spiUnselect(devp->config->spip); +#endif +} + static void flash_cmd_addr(M25QDriver *devp, uint8_t cmd, flash_address_t addr) { @@ -437,6 +469,42 @@ static void flash_cmd_addr_receive(M25QDriver *devp, #endif } +#if (M25Q_BUS_MODE != M25Q_BUS_MODE_SPI) || defined(__DOXYGEN__) +static void flash_cmd_addr_dummy_receive(M25QDriver *devp, + uint8_t cmd, + flash_address_t addr, + uint8_t dummy, + size_t n, + uint8_t *p) { + qspi_command_t mode; + + mode.cfg = QSPI_CFG_CMD(cmd) | +#if M25Q_BUS_MODE == M25Q_BUS_MODE_QSPI1L + QSPI_CFG_CMD_MODE_ONE_LINE | + QSPI_CFG_ADDR_MODE_ONE_LINE | + QSPI_CFG_ADDR_SIZE_24 | + QSPI_CFG_DUMMY_CYCLES(dummy) | + QSPI_CFG_DATA_MODE_ONE_LINE; +#elif M25Q_BUS_MODE == M25Q_BUS_MODE_QSPI2L + QSPI_CFG_CMD_MODE_TWO_LINES | + QSPI_CFG_ADDR_MODE_TWO_LINES | + QSPI_CFG_ADDR_SIZE_24 | + QSPI_CFG_DUMMY_CYCLES(dummy) | + QSPI_CFG_DATA_MODE_TWO_LINES; +#else + QSPI_CFG_CMD_MODE_FOUR_LINES | + QSPI_CFG_ADDR_MODE_FOUR_LINES | + QSPI_CFG_ADDR_SIZE_24 | + QSPI_CFG_DUMMY_CYCLES(dummy) | + QSPI_CFG_DATA_MODE_FOUR_LINES; + +#endif + mode.addr = addr; + mode.alt = 0U; + qspiReceive(devp->config->qspip, &mode, n, p); +} +#endif /* M25Q_BUS_MODE != M25Q_BUS_MODE_SPI */ + static flash_error_t flash_poll_status(M25QDriver *devp) { return FLASH_NO_ERROR; @@ -454,6 +522,38 @@ static const flash_descriptor_t *get_descriptor(void *instance) { static flash_error_t read(void *instance, flash_address_t addr, uint8_t *rp, size_t n) { + M25QDriver *devp = (M25QDriver *)instance; + + osalDbgCheck((instance != NULL) && (rp != NULL) && (n > 0U)); + osalDbgCheck((size_t)addr + n <= (size_t)descriptor.sectors_count * + (size_t)descriptor.sectors_size); + osalDbgAssert((devp->state == FLASH_READY) || (devp->state == FLASH_ERASE), + "invalid state"); + + if (devp->state == FLASH_ERASE) { + return FLASH_BUSY_ERASING; + } + + /* Bus acquired.*/ + flash_bus_acquire(devp); + + /* FLASH_READY state while the operation is performed.*/ + devp->state = FLASH_READ; + +#if M25Q_BUS_MODE != M25Q_BUS_MODE_SPI + /* Fast read command in QSPI mode.*/ + flash_cmd_addr_dummy_receive(devp, M25Q_CMD_FAST_READ, + addr, M25Q_READ_DUMMY_CYCLES, + n, rp); +#else + /* Normal read command in SPI mode.*/ +#endif + + /* Ready state again.*/ + devp->state = FLASH_READY; + + /* Bus released.*/ + flash_bus_release(devp); return FLASH_NO_ERROR; } @@ -516,6 +616,18 @@ void m25qObjectInit(M25QDriver *devp) { #endif } +static const qspi_command_t cmd_test_reset_enable_4 = { + .cfg = QSPI_CFG_ALT_MODE_FOUR_LINES, + .addr = 0, + .alt = M25Q_CMD_RESET_ENABLE +}; + +static const qspi_command_t cmd_test_reset_memory_4 = { + .cfg = QSPI_CFG_ALT_MODE_FOUR_LINES, + .addr = 0, + .alt = M25Q_CMD_RESET_MEMORY +}; + /** * @brief Configures and activates N25Q128 driver. * @@ -532,7 +644,6 @@ void m25qStart(M25QDriver *devp, const M25QConfig *config) { devp->config = config; if (devp->state == FLASH_STOP) { - uint8_t id[3]; /* Bus acquisition.*/ flash_bus_acquire(devp); @@ -546,46 +657,62 @@ void m25qStart(M25QDriver *devp, const M25QConfig *config) { /* QSPI initialization.*/ qspiStart(devp->config->qspip, devp->config->qspicfg); + /* Reading device ID and unique ID.*/ + #if M25Q_SWITCH_WIDTH == TRUE - /* Attempting a device reset with decreasing bus widths, commands + /* Attempting a device reset with different bus widths, commands shorter than 8 bits are ignored.*/ - qspiCommand(devp->config->qspip, &cmd_reset_enable_4); - qspiCommand(devp->config->qspip, &cmd_reset_memory_4); - qspiCommand(devp->config->qspip, &cmd_reset_enable_2); - qspiCommand(devp->config->qspip, &cmd_reset_memory_2); qspiCommand(devp->config->qspip, &cmd_reset_enable_1); qspiCommand(devp->config->qspip, &cmd_reset_memory_1); + qspiCommand(devp->config->qspip, &cmd_reset_enable_2); + qspiCommand(devp->config->qspip, &cmd_reset_memory_2); + qspiCommand(devp->config->qspip, &cmd_reset_enable_4); + qspiCommand(devp->config->qspip, &cmd_reset_memory_4); #endif - /* Reading device ID.*/ - qspiReceive(devp->config->qspip, &cmd_read_id, 3, id); + /* Reading device ID and unique ID.*/ + qspiReceive(devp->config->qspip, &cmd_read_id, + sizeof devp->device_id, devp->device_id); #endif /* M25Q_BUS_MODE != M25Q_BUS_MODE_SPI */ /* Checking if the device is white listed.*/ - osalDbgAssert(find_id(manufacturer_ids, sizeof manufacturer_ids, id[0]), + osalDbgAssert(find_id(manufacturer_ids, + sizeof manufacturer_ids, + devp->device_id[0]), "invalid manufacturer id"); - osalDbgAssert(find_id(memory_type_ids, sizeof memory_type_ids, id[1]), + osalDbgAssert(find_id(memory_type_ids, + sizeof memory_type_ids, + devp->device_id[1]), "invalid memory type id"); #if (M25Q_BUS_MODE != M25Q_BUS_MODE_SPI) && (M25Q_SWITCH_WIDTH == TRUE) /* Setting up final bus width.*/ qspiCommand(devp->config->qspip, &cmd_write_enable); qspiSend(devp->config->qspip, &cmd_write_evconf, 1, evconf_value); -#endif - flash_cmd_receive(devp, M25Q_CMD_READ_ID, 3, id); + { + uint8_t id[3]; - flash_cmd_receive(devp, M25Q_CMD_READ_ID, 3, id); + /* Reading ID again for confirmation.*/ + flash_cmd_receive(devp, M25Q_CMD_MULTIPLE_IO_READ_ID, 3, id); - /* Reading device ID.*/ - qspiReceive(devp->config->qspip, &cmd_read_id, 3, id); + /* Checking if the device is white listed.*/ + osalDbgAssert(memcmp(id, devp->device_id, 3) == 0, + "id confirmation failed"); + } +#endif - /* Reset Enable command.*/ -// flash_short_cmd(devp, M25Q_CMD_RESET_ENABLE); + /* Setting up the device size.*/ + descriptor.sectors_count = (1U << (size_t)devp->device_id[2]) / SECTOR_SIZE; - /* Reset Memory command.*/ -// flash_short_cmd(devp, M25Q_CMD_RESET_MEMORY); +#if (M25Q_BUS_MODE != M25Q_BUS_MODE_SPI) + /* Setting up the dummy cycles to be used for rast read operations.*/ + flash_cmd(devp, M25Q_CMD_WRITE_ENABLE); + flash_cmd_send(devp, M25Q_CMD_WRITE_V_CONF_REGISTER, + 1, flash_status); +#endif + /* Driver in ready state.*/ devp->state = FLASH_READY; /* Bus release.*/ @@ -617,6 +744,8 @@ void m25qStop(M25QDriver *devp) { #endif devp->config = NULL; + + /* Driver stopped.*/ devp->state = FLASH_STOP; /* Bus release.*/ |