diff options
author | Giovanni Di Sirio <gdisirio@gmail.com> | 2016-05-26 08:54:46 +0000 |
---|---|---|
committer | Giovanni Di Sirio <gdisirio@gmail.com> | 2016-05-26 08:54:46 +0000 |
commit | 96f3718cc7e228e4b365cb2cba3d15f6451a8e19 (patch) | |
tree | 52d1ef6f92edfcea4f6d0618805c54f753d03b23 /os/ex | |
parent | 249d014e0bc24c1341a09c9af4cf65b12161993e (diff) | |
download | ChibiOS-96f3718cc7e228e4b365cb2cba3d15f6451a8e19.tar.gz ChibiOS-96f3718cc7e228e4b365cb2cba3d15f6451a8e19.tar.bz2 ChibiOS-96f3718cc7e228e4b365cb2cba3d15f6451a8e19.zip |
Flashing driver over QSPI working but not complete, it needs more work.
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@9524 35acf78f-673a-0410-8e92-d51de3d6d3f4
Diffstat (limited to 'os/ex')
-rw-r--r-- | os/ex/Micron/m25q.c | 33 | ||||
-rw-r--r-- | os/ex/Micron/m25q.h | 14 |
2 files changed, 46 insertions, 1 deletions
diff --git a/os/ex/Micron/m25q.c b/os/ex/Micron/m25q.c index 9ae5958d8..c43fb7fe1 100644 --- a/os/ex/Micron/m25q.c +++ b/os/ex/Micron/m25q.c @@ -699,7 +699,9 @@ static flash_error_t start_erase_sector(void *instance, flash_sector_t sector) { static flash_error_t verify_erase(void *instance, flash_sector_t sector) { M25QDriver *devp = (M25QDriver *)instance; - unsigned i; + uint8_t cmpbuf[M25Q_COMPARE_BUFFER_SIZE]; + flash_address_t addr; + size_t n; osalDbgCheck(instance != NULL); osalDbgCheck(sector < descriptor.sectors_count); @@ -717,6 +719,35 @@ static flash_error_t verify_erase(void *instance, flash_sector_t sector) { devp->state = FLASH_READ; /* Read command.*/ + addr = (flash_address_t)(sector * SECTOR_SIZE); + n = SECTOR_SIZE; + while (n > 0U) { + uint8_t *p; + +#if M25Q_BUS_MODE != M25Q_BUS_MODE_SPI + flash_cmd_addr_dummy_receive(devp, M25Q_CMD_FAST_READ, + addr, M25Q_READ_DUMMY_CYCLES, + sizeof cmpbuf, cmpbuf); +#else + /* Normal read command in SPI mode.*/ +#endif + + /* Checking for erased state of current buffer.*/ + for (p = cmpbuf; p < &cmpbuf[M25Q_COMPARE_BUFFER_SIZE]; p++) { + if (*p != 0xFFU) { + /* Ready state again.*/ + devp->state = FLASH_READY; + + /* Bus released.*/ + flash_bus_release(devp); + + return FLASH_ERROR_VERIFY; + } + } + + addr += sizeof cmpbuf; + n -= sizeof cmpbuf; + } /* Ready state again.*/ devp->state = FLASH_READY; diff --git a/os/ex/Micron/m25q.h b/os/ex/Micron/m25q.h index 865cc32ea..c5a98eadf 100644 --- a/os/ex/Micron/m25q.h +++ b/os/ex/Micron/m25q.h @@ -175,6 +175,16 @@ #define M25Q_SUPPORTED_MEMORY_TYPE_IDS {0xBA, 0xBB} #endif +/** + * @brief Size of the compare buffer. + * @details This buffer is allocated in the stack frame of the function + * @p flashVerifyErase() and its size must be a power of two. + * Larger buffers lead to better verify performance but increase + * stack usage for that function. + */ +#if !defined(M25Q_COMPARE_BUFFER_SIZE) || defined(__DOXYGEN__) +#define M25Q_COMPARE_BUFFER_SIZE 32 +#endif /** @} */ /*===========================================================================*/ @@ -206,6 +216,10 @@ #error "invalid M25Q_READ_DUMMY_CYCLES value (1..15)" #endif +#if (M25Q_COMPARE_BUFFER_SIZE & (M25Q_COMPARE_BUFFER_SIZE - 1)) != 0 +#error "invalid M25Q_COMPARE_BUFFER_SIZE value" +#endif + /*===========================================================================*/ /* Driver data structures and types. */ /*===========================================================================*/ |