mirror of https://github.com/ARMmbed/mbed-os.git
Initial QSPIF delivery to mbed-os
parent
a24cecfc94
commit
9920e63d98
File diff suppressed because it is too large
Load Diff
|
@ -0,0 +1,309 @@
|
|||
/* mbed Microcontroller Library
|
||||
* Copyright (c) 2018 ARM Limited
|
||||
*
|
||||
* Licensed under the Apache License, Version 2.0 (the "License");
|
||||
* you may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*/
|
||||
#ifndef MBED_QSPIF_BLOCK_DEVICE_H
|
||||
#define MBED_QSPIF_BLOCK_DEVICE_H
|
||||
|
||||
#include "QSPI.h"
|
||||
#include "BlockDevice.h"
|
||||
|
||||
|
||||
namespace mbed {
|
||||
|
||||
/** Enum qspif standard error codes
|
||||
*
|
||||
* @enum qspif_bd_error
|
||||
*/
|
||||
enum qspif_bd_error {
|
||||
QSPIF_BD_ERROR_OK = 0, /*!< no error */
|
||||
QSPIF_BD_ERROR_DEVICE_ERROR = BD_ERROR_DEVICE_ERROR, /*!< device specific error -4001 */
|
||||
QSPIF_BD_ERROR_PARSING_FAILED = -4002, /* SFDP Parsing failed */
|
||||
QSPIF_BD_ERROR_READY_FAILED = -4003, /* Wait for Mem Ready failed */
|
||||
QSPIF_BD_ERROR_WREN_FAILED = -4004, /* Write Enable Failed */
|
||||
QSPIF_BD_ERROR_DEVICE_NOT_UNIQE = -4005, /* Only one instance per csel is allowed */
|
||||
QSPIF_BD_ERROR_DEVICE_MAX_EXCEED = -4006 /* Max active QSPIF devices exceeded */
|
||||
};
|
||||
|
||||
/** Enum qspif polarity mode
|
||||
*
|
||||
* @enum qspif_polarity_mode
|
||||
*/
|
||||
enum qspif_polarity_mode {
|
||||
QSPIF_POLARITY_MODE_0 = 0, /* CPOL=0, CPHA=0 */
|
||||
QSPIF_POLARITY_MODE_1 /* CPOL=1, CPHA=1 */
|
||||
};
|
||||
|
||||
#define QSPIF_MAX_REGIONS 10
|
||||
#define MAX_NUM_OF_ERASE_TYPES 4
|
||||
#define QSPIF_MAX_ACTIVE_FLASH_DEVICES 10
|
||||
|
||||
class QSPIFBlockDevice : public BlockDevice {
|
||||
public:
|
||||
/** Create QSPIFBlockDevice - An SFDP based Flash Block Device over QSPI bus
|
||||
*
|
||||
* @param io0 1st IO pin used for sending/receiving data during data phase of a transaction
|
||||
* @param io1 2nd IO pin used for sending/receiving data during data phase of a transaction
|
||||
* @param io2 3rd IO pin used for sending/receiving data during data phase of a transaction
|
||||
* @param io3 4th IO pin used for sending/receiving data during data phase of a transaction
|
||||
* @param sclk QSPI Clock pin
|
||||
* @param csel QSPI chip select pin
|
||||
* @param clock_mode specifies the QSPI Clock Polarity mode (QSPIF_POLARITY_MODE_0/QSPIF_POLARITY_MODE_1)
|
||||
* default value = 0
|
||||
* @param freq Clock frequency of the QSPI bus (defaults to 40MHz)
|
||||
*
|
||||
*/
|
||||
QSPIFBlockDevice(PinName io0, PinName io1, PinName io2, PinName io3, PinName sclk, PinName csel,
|
||||
qspif_polarity_mode clock_mode,
|
||||
int freq = 40000000);
|
||||
|
||||
|
||||
/** Initialize a block device
|
||||
*
|
||||
* @return QSPIF_BD_ERROR_OK(0) - success
|
||||
* QSPIF_BD_ERROR_DEVICE_ERROR - device driver transaction failed
|
||||
* QSPIF_BD_ERROR_READY_FAILED - Waiting for Memory ready failed or timedout
|
||||
* QSPIF_BD_ERROR_PARSING_FAILED - unexpected format or values in one of the SFDP tables
|
||||
*/
|
||||
virtual int init();
|
||||
|
||||
/** Deinitialize a block device
|
||||
*
|
||||
* @return QSPIF_BD_ERROR_OK(0) - success
|
||||
* QSPIF_BD_ERROR_DEVICE_ERROR - device driver transaction failed
|
||||
*/
|
||||
virtual int deinit();
|
||||
|
||||
/** Desctruct QSPIFBlockDevie
|
||||
*/
|
||||
~QSPIFBlockDevice() {deinit();}
|
||||
|
||||
/** Read blocks from a block device
|
||||
*
|
||||
* @param buffer Buffer to write blocks to
|
||||
* @param addr Address of block to begin reading from
|
||||
* @param size Size to read in bytes, must be a multiple of read block size
|
||||
* @return QSPIF_BD_ERROR_OK(0) - success
|
||||
* QSPIF_BD_ERROR_DEVICE_ERROR - device driver transaction failed
|
||||
*/
|
||||
virtual int read(void *buffer, bd_addr_t addr, bd_size_t size);
|
||||
|
||||
/** Program blocks to a block device
|
||||
*
|
||||
* The blocks must have been erased prior to being programmed
|
||||
*
|
||||
* @param buffer Buffer of data to write to blocks
|
||||
* @param addr Address of block to begin writing to
|
||||
* @param size Size to write in bytes, must be a multiple of program block size
|
||||
* @return QSPIF_BD_ERROR_OK(0) - success
|
||||
* QSPIF_BD_ERROR_DEVICE_ERROR - device driver transaction failed
|
||||
* QSPIF_BD_ERROR_READY_FAILED - Waiting for Memory ready failed or timed out
|
||||
* QSPIF_BD_ERROR_WREN_FAILED - Write Enable failed
|
||||
* QSPIF_BD_ERROR_PARSING_FAILED - unexpected format or values in one of the SFDP tables
|
||||
*/
|
||||
virtual int program(const void *buffer, bd_addr_t addr, bd_size_t size);
|
||||
|
||||
/** Erase blocks on a block device
|
||||
*
|
||||
* The state of an erased block is undefined until it has been programmed
|
||||
*
|
||||
* @param addr Address of block to begin erasing
|
||||
* @param size Size to erase in bytes, must be a multiple of erase block size
|
||||
* @return QSPIF_BD_ERROR_OK(0) - success
|
||||
* QSPIF_BD_ERROR_DEVICE_ERROR - device driver transaction failed
|
||||
* QSPIF_BD_ERROR_READY_FAILED - Waiting for Memory ready failed or timed out
|
||||
* QSPIF_BD_ERROR_WREN_FAILED - Write Enable failed
|
||||
* QSPIF_BD_ERROR_PARSING_FAILED - unexpected format or values in one of the SFDP tables
|
||||
*/
|
||||
virtual int erase(bd_addr_t addr, bd_size_t size);
|
||||
|
||||
/** Get the size of a readable block
|
||||
*
|
||||
* @return Size of a readable block in bytes
|
||||
*/
|
||||
virtual bd_size_t get_read_size() const;
|
||||
|
||||
/** Get the size of a programable block
|
||||
*
|
||||
* @return Size of a program block size in bytes
|
||||
* @note Must be a multiple of the read size
|
||||
*/
|
||||
virtual bd_size_t get_program_size() const;
|
||||
|
||||
/** Get the size of a eraseable block
|
||||
*
|
||||
* @return Size of a minimal erase block, common to all regions, in bytes
|
||||
* @note Must be a multiple of the program size
|
||||
*/
|
||||
virtual bd_size_t get_erase_size() const;
|
||||
|
||||
/** Get the size of minimal eraseable sector size of given address
|
||||
*
|
||||
* @param addr Any address within block queried for erase sector size (can be any address within flash size offset)
|
||||
* @return Size of minimal erase sector size, in given address region, in bytes
|
||||
* @note Must be a multiple of the program size
|
||||
*/
|
||||
virtual bd_size_t get_erase_size(bd_addr_t addr);
|
||||
|
||||
/** Get the total size of the underlying device
|
||||
*
|
||||
* @return Size of the underlying device in bytes
|
||||
*/
|
||||
virtual bd_size_t size() const;
|
||||
|
||||
private:
|
||||
// Internal functions
|
||||
|
||||
|
||||
/********************************/
|
||||
/* Different Device Csel Mgmt */
|
||||
/********************************/
|
||||
// Add a new QSPI device CS to existing devices list.
|
||||
// Only one QSPIFBlockDevice instance per CS is allowed
|
||||
int add_new_csel_instance(PinName csel);
|
||||
|
||||
// Remove device CS from existing device list upon destroying object (last deinit is called)
|
||||
int remove_csel_instance(PinName csel);
|
||||
|
||||
/********************************/
|
||||
/* Calls to QSPI Driver APIs */
|
||||
/********************************/
|
||||
// Send Program => Write command to Driver
|
||||
qspi_status_t _qspi_send_program_command(unsigned int prog_instruction, const void *buffer, bd_addr_t addr,
|
||||
bd_size_t *size);
|
||||
|
||||
// Send Read command to Driver
|
||||
qspi_status_t _qspi_send_read_command(unsigned int read_instruction, void *buffer, bd_addr_t addr, bd_size_t size);
|
||||
|
||||
// Send Erase Instruction using command_transfer command to Driver
|
||||
qspi_status_t _qspi_send_erase_command(unsigned int erase_instruction, bd_addr_t addr, bd_size_t size);
|
||||
|
||||
// Send Generic command_transfer command to Driver
|
||||
qspi_status_t _qspi_send_general_command(unsigned int instruction_int, bd_addr_t addr, const char *tx_buffer,
|
||||
size_t tx_length, const char *rx_buffer, size_t rx_length);
|
||||
|
||||
// Send Bus configure_format command to Driver
|
||||
qspi_status_t _qspi_configure_format(qspi_bus_width_t inst_width, qspi_bus_width_t address_width,
|
||||
qspi_address_size_t address_size, qspi_bus_width_t alt_width, qspi_alt_size_t alt_size, qspi_bus_width_t data_width,
|
||||
int dummy_cycles);
|
||||
|
||||
// Send set_frequency command to Driver
|
||||
qspi_status_t _qspi_set_frequency(int freq);
|
||||
/********************************/
|
||||
|
||||
|
||||
// Soft Reset Flash Memory
|
||||
int _reset_flash_mem();
|
||||
|
||||
// Configure Write Enable in Status Register
|
||||
int _set_write_enable();
|
||||
|
||||
// Wait on status register until write not-in-progress
|
||||
bool _is_mem_ready();
|
||||
|
||||
|
||||
/* SFDP Detection and Parsing Functions */
|
||||
/****************************************/
|
||||
// Parse SFDP Headers and retrieve Basic Param and Sector Map Tables (if exist)
|
||||
int _sfdp_parse_sfdp_headers(uint32_t& basic_table_addr, size_t& basic_table_size,
|
||||
uint32_t& sector_map_table_addr, size_t& sector_map_table_size);
|
||||
|
||||
// Parse and Detect required Basic Parameters from Table
|
||||
int _sfdp_parse_basic_param_table(uint32_t basic_table_addr, size_t basic_table_size);
|
||||
|
||||
// Parse and read information required by Regions Secotr Map
|
||||
int _sfdp_parse_sector_map_table(uint32_t sector_map_table_addr, size_t sector_map_table_size);
|
||||
|
||||
// Detect fastest read Bus mode supported by device
|
||||
int _sfdp_detect_best_bus_read_mode(uint8_t *basic_param_table_ptr, int basic_param_table_size, bool& set_quad_enable,
|
||||
bool& is_qpi_mode, unsigned int& read_inst);
|
||||
|
||||
// Enable Quad mode if supported (1-1-4, 1-4-4, 4-4-4 bus modes)
|
||||
int _sfdp_set_quad_enabled(uint8_t *basic_param_table_ptr);
|
||||
|
||||
// Enable QPI mode (4-4-4) is supported
|
||||
int _sfdp_set_qpi_enabled(uint8_t *basic_param_table_ptr);
|
||||
|
||||
// Set Page size for program
|
||||
int _sfdp_detect_page_size(uint8_t *basic_param_table_ptr, int basic_param_table_size);
|
||||
|
||||
// Detect all supported erase types
|
||||
int _sfdp_detect_erase_types_inst_and_size(uint8_t *basic_param_table_ptr, int basic_param_table_size,
|
||||
unsigned int& erase4k_inst,
|
||||
unsigned int *erase_type_inst_arr, unsigned int *erase_type_size_arr);
|
||||
|
||||
/* Utilities Functions */
|
||||
/***********************/
|
||||
// Find the region to which the given offset belong to
|
||||
int _utils_find_addr_region(bd_size_t offset);
|
||||
|
||||
// Iterate on all supported Erase Types of the Region to which the offset belong to.
|
||||
// Iterates from highest type to lowest
|
||||
int _utils_iterate_next_largest_erase_type(uint8_t& bitfield, int size, int offset, int boundry);
|
||||
|
||||
private:
|
||||
// Internal Members
|
||||
|
||||
// QSPI Driver Object
|
||||
QSPI _qspi;
|
||||
|
||||
// Static List of different QSPI based Flash devices csel that already exist
|
||||
// Each QSPI Flash device csel can have only 1 QSPIFBlockDevice instance
|
||||
// _devices_mutex is used to lock csel list - only one QSPIFBlockDevice instance per csel is allowed
|
||||
static SingletonPtr<PlatformMutex> _devices_mutex;
|
||||
static int _number_of_active_qspif_flash_csel;
|
||||
static PinName *_active_qspif_flash_csel_arr;
|
||||
|
||||
int _unique_device_status;
|
||||
PinName _csel;
|
||||
|
||||
// Mutex is used to protect Flash device for some QSPI Driver commands that must be done sequentially with no other commands in between
|
||||
// e.g. (1)Set Write Enable, (2)Program, (3)Wait Memory Ready
|
||||
PlatformMutex _mutex;
|
||||
|
||||
// Command Instructions
|
||||
unsigned int _read_instruction;
|
||||
unsigned int _prog_instruction;
|
||||
unsigned int _erase_instruction;
|
||||
unsigned int _erase4k_inst; // Legacy 4K erase instruction (default 0x20h)
|
||||
|
||||
// Up To 4 Erase Types are supported by SFDP (each with its own command Instruction and Size)
|
||||
unsigned int _erase_type_inst_arr[MAX_NUM_OF_ERASE_TYPES];
|
||||
unsigned int _erase_type_size_arr[MAX_NUM_OF_ERASE_TYPES];
|
||||
|
||||
// Sector Regions Map
|
||||
int _regions_count; //number of regions
|
||||
int _region_size_bytes[QSPIF_MAX_REGIONS]; //regions size in bytes
|
||||
bd_size_t _region_high_boundary[QSPIF_MAX_REGIONS]; //region high address offset boundary
|
||||
//Each Region can support a bit combination of any of the 4 Erase Types
|
||||
uint8_t _region_erase_types_bitfield[QSPIF_MAX_REGIONS];
|
||||
unsigned int _min_common_erase_size; // minimal common erase size for all regions (0 if none exists)
|
||||
|
||||
unsigned int _page_size_bytes; // Page size - 256 Bytes default
|
||||
int _freq;
|
||||
bd_size_t _device_size_bytes;
|
||||
|
||||
// Bus speed configuration
|
||||
qspi_bus_width_t _inst_width; //Bus width for Instruction phase
|
||||
qspi_bus_width_t _address_width; //Bus width for Address phase
|
||||
qspi_address_size_t _address_size; // number of bytes for address
|
||||
qspi_bus_width_t _data_width; //Bus width for Data phase
|
||||
int _dummy_and_mode_cycles; // Number of Dummy and Mode Bits required by Current Bus Mode
|
||||
|
||||
uint32_t _init_ref_count;
|
||||
bool _is_initialized;
|
||||
};
|
||||
|
||||
} //namespace mbed
|
||||
#endif
|
|
@ -0,0 +1,46 @@
|
|||
# Quad SPI (QSPI) Flash Block Device
|
||||
|
||||
Block device driver for NOR based QSPI flash devices that support SFDP.
|
||||
|
||||
NOR based QSPI flash supports up to 4bits per cycle of instruction, address and data.
|
||||
SFDP based QSPI Flash supports variable bus modes (single, dual, quad), several sector erase size types, multiple regions of sector size types and more.
|
||||
|
||||
SFDP JEDEC standard can be found in:
|
||||
https://www.jedec.org/system/files/docs/JESD216B.pdf
|
||||
|
||||
``` cpp
|
||||
// QSPI SFDP Flash - Block Device example
|
||||
#include "mbed.h"
|
||||
#include "QSPIFBlockDevice.h"
|
||||
|
||||
QSPIFBlockDevice block_device(MBED_CONF_QSPIF_QSPI_IO0,MBED_CONF_QSPIF_QSPI_IO1,MBED_CONF_QSPIF_QSPI_IO2,MBED_CONF_QSPIF_QSPI_IO3,
|
||||
MBED_CONF_QSPIF_QSPI_CLK,MBED_CONF_QSPIF_QSPI_CS,0,MBED_CONF_QSPIF_QSPI_FREQ);
|
||||
|
||||
|
||||
int main() {
|
||||
printf("QSPI SFDP Flash Block Device example\n");
|
||||
|
||||
// Initialize the SPI flash device and print the memory layout
|
||||
block_device.init();
|
||||
bd_size_t sector_size_at_address_0 = block_device.get_erase_size(0);
|
||||
|
||||
printf("QSPIF BD size: %llu\n", block_device.size());
|
||||
printf("QSPIF BD read size: %llu\n", block_device.get_read_size());
|
||||
printf("QSPIF BD program size: %llu\n", block_device.get_program_size());
|
||||
|
||||
printf("QSPIF BD erase size (at address 0): %llu\n", sector_size_at_address_0);
|
||||
|
||||
// Write "Hello World!" to the first block
|
||||
char *buffer = (char*) malloc(sector_size_at_address_0);
|
||||
sprintf(buffer, "Hello World!\n");
|
||||
block_device.erase(0, sector_size_at_address_0);
|
||||
block_device.program(buffer, 0, sector_size_at_address_0);
|
||||
|
||||
// Read back what was stored
|
||||
block_device.read(buffer, 0, sector_size_at_address_0);
|
||||
printf("%s", buffer);
|
||||
|
||||
// Deinitialize the device
|
||||
block_device.deinit();
|
||||
}
|
||||
```
|
|
@ -0,0 +1,302 @@
|
|||
/* mbed Microcontroller Library
|
||||
* Copyright (c) 2018 ARM Limited
|
||||
*
|
||||
* Licensed under the Apache License, Version 2.0 (the "License");
|
||||
* you may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*/
|
||||
#include "greentea-client/test_env.h"
|
||||
#include "unity.h"
|
||||
#include "utest.h"
|
||||
#include "QSPIFBlockDevice.h"
|
||||
#include "mbed_trace.h"
|
||||
#include <stdlib.h>
|
||||
|
||||
using namespace utest::v1;
|
||||
|
||||
#define TEST_BLOCK_COUNT 10
|
||||
#define TEST_ERROR_MASK 16
|
||||
#define QSPIF_TEST_NUM_OF_THREADS 5
|
||||
|
||||
const struct {
|
||||
const char *name;
|
||||
bd_size_t (BlockDevice::*method)() const;
|
||||
} ATTRS[] = {
|
||||
{"read size", &BlockDevice::get_read_size},
|
||||
{"program size", &BlockDevice::get_program_size},
|
||||
{"erase size", &BlockDevice::get_erase_size},
|
||||
{"total size", &BlockDevice::size},
|
||||
};
|
||||
|
||||
static SingletonPtr<PlatformMutex> _mutex;
|
||||
|
||||
|
||||
// Mutex is protecting rand() per srand for buffer writing and verification.
|
||||
// Mutex is also protecting printouts for clear logs.
|
||||
// Mutex is NOT protecting Block Device actions: erase/program/read - which is the purpose of the multithreaded test!
|
||||
void basic_erase_program_read_test(QSPIFBlockDevice& blockD, bd_size_t block_size, uint8_t *write_block,
|
||||
uint8_t *read_block, unsigned addrwidth)
|
||||
{
|
||||
int err = 0;
|
||||
_mutex->lock();
|
||||
// Find a random block
|
||||
bd_addr_t block = (rand() * block_size) % blockD.size();
|
||||
|
||||
// Use next random number as temporary seed to keep
|
||||
// the address progressing in the pseudorandom sequence
|
||||
unsigned seed = rand();
|
||||
|
||||
// Fill with random sequence
|
||||
srand(seed);
|
||||
for (bd_size_t i_ind = 0; i_ind < block_size; i_ind++) {
|
||||
write_block[i_ind] = 0xff & rand();
|
||||
}
|
||||
// Write, sync, and read the block
|
||||
utest_printf("\ntest %0*llx:%llu...", addrwidth, block, block_size);
|
||||
_mutex->unlock();
|
||||
|
||||
err = blockD.erase(block, block_size);
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
err = blockD.program(write_block, block, block_size);
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
err = blockD.read(read_block, block, block_size);
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
_mutex->lock();
|
||||
// Check that the data was unmodified
|
||||
srand(seed);
|
||||
int val_rand;
|
||||
for (bd_size_t i_ind = 0; i_ind < block_size; i_ind++) {
|
||||
val_rand = rand();
|
||||
if ( (0xff & val_rand) != read_block[i_ind] ) {
|
||||
utest_printf("\n Assert Failed Buf Read - block:size: %llx:%llu \n", block, block_size);
|
||||
utest_printf("\n pos: %llu, exp: %02x, act: %02x, wrt: %02x \n", i_ind, (0xff & val_rand), read_block[i_ind],
|
||||
write_block[i_ind] );
|
||||
}
|
||||
TEST_ASSERT_EQUAL(0xff & val_rand, read_block[i_ind]);
|
||||
}
|
||||
_mutex->unlock();
|
||||
}
|
||||
|
||||
void test_qspif_random_program_read_erase()
|
||||
{
|
||||
utest_printf("\nTest Random Program Read Erase Starts..\n");
|
||||
|
||||
QSPIFBlockDevice blockD(QSPI_FLASH1_IO0, QSPI_FLASH1_IO1, QSPI_FLASH1_IO2, QSPI_FLASH1_IO3,
|
||||
QSPI_FLASH1_SCK, QSPI_FLASH1_CSN, QSPIF_POLARITY_MODE_0, MBED_CONF_QSPIF_QSPI_FREQ);
|
||||
|
||||
int err = blockD.init();
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
for (unsigned atr = 0; atr < sizeof(ATTRS) / sizeof(ATTRS[0]); atr++) {
|
||||
static const char *prefixes[] = {"", "k", "M", "G"};
|
||||
for (int i_ind = 3; i_ind >= 0; i_ind--) {
|
||||
bd_size_t size = (blockD.*ATTRS[atr].method)();
|
||||
if (size >= (1ULL << 10 * i_ind)) {
|
||||
utest_printf("%s: %llu%sbytes (%llubytes)\n",
|
||||
ATTRS[atr].name, size >> 10 * i_ind, prefixes[i_ind], size);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
bd_size_t block_size = blockD.get_erase_size();
|
||||
unsigned addrwidth = ceil(log(float(blockD.size() - 1)) / log(float(16))) + 1;
|
||||
|
||||
uint8_t *write_block = new (std::nothrow) uint8_t[block_size];
|
||||
uint8_t *read_block = new (std::nothrow) uint8_t[block_size];
|
||||
if (!write_block || !read_block) {
|
||||
utest_printf("\n Not enough memory for test");
|
||||
goto end;
|
||||
}
|
||||
|
||||
for (int b = 0; b < TEST_BLOCK_COUNT; b++) {
|
||||
basic_erase_program_read_test(blockD, block_size, write_block, read_block, addrwidth);
|
||||
}
|
||||
|
||||
err = blockD.deinit();
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
end:
|
||||
delete[] write_block;
|
||||
delete[] read_block;
|
||||
}
|
||||
|
||||
void test_qspif_unaligned_program()
|
||||
{
|
||||
|
||||
utest_printf("\nTest Unaligned Program Starts..\n");
|
||||
|
||||
QSPIFBlockDevice blockD(QSPI_FLASH1_IO0, QSPI_FLASH1_IO1, QSPI_FLASH1_IO2, QSPI_FLASH1_IO3,
|
||||
QSPI_FLASH1_SCK, QSPI_FLASH1_CSN, QSPIF_POLARITY_MODE_0, MBED_CONF_QSPIF_QSPI_FREQ);
|
||||
|
||||
int err = blockD.init();
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
for (unsigned atr = 0; atr < sizeof(ATTRS) / sizeof(ATTRS[0]); atr++) {
|
||||
static const char *prefixes[] = {"", "k", "M", "G"};
|
||||
for (int i_ind = 3; i_ind >= 0; i_ind--) {
|
||||
bd_size_t size = (blockD.*ATTRS[atr].method)();
|
||||
if (size >= (1ULL << 10 * i_ind)) {
|
||||
utest_printf("%s: %llu%sbytes (%llubytes)\n",
|
||||
ATTRS[atr].name, size >> 10 * i_ind, prefixes[i_ind], size);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
bd_size_t block_size = blockD.get_erase_size();
|
||||
unsigned addrwidth = ceil(log(float(blockD.size() - 1)) / log(float(16))) + 1;
|
||||
|
||||
uint8_t *write_block = new (std::nothrow) uint8_t[block_size];
|
||||
uint8_t *read_block = new (std::nothrow) uint8_t[block_size];
|
||||
if (!write_block || !read_block ) {
|
||||
utest_printf("\n Not enough memory for test");
|
||||
goto end;
|
||||
}
|
||||
|
||||
{
|
||||
bd_addr_t block = (rand() * block_size) % blockD.size() + 15;
|
||||
|
||||
// Use next random number as temporary seed to keep
|
||||
// the address progressing in the pseudorandom sequence
|
||||
unsigned seed = rand();
|
||||
|
||||
// Fill with random sequence
|
||||
srand(seed);
|
||||
for (bd_size_t i_ind = 0; i_ind < block_size; i_ind++) {
|
||||
write_block[i_ind] = 0xff & rand();
|
||||
}
|
||||
|
||||
// Write, sync, and read the block
|
||||
utest_printf("\ntest %0*llx:%llu...", addrwidth, block, block_size);
|
||||
|
||||
err = blockD.erase(block, block_size);
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
err = blockD.program(write_block, block, block_size);
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
err = blockD.read(read_block, block, block_size);
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
// Check that the data was unmodified
|
||||
srand(seed);
|
||||
for (bd_size_t i_ind = 0; i_ind < block_size; i_ind++) {
|
||||
TEST_ASSERT_EQUAL(0xff & rand(), read_block[i_ind]);
|
||||
}
|
||||
|
||||
err = blockD.deinit();
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
}
|
||||
end:
|
||||
delete[] write_block;
|
||||
delete[] read_block;
|
||||
}
|
||||
|
||||
|
||||
|
||||
static void test_qspif_thread_job(void *vBlockD/*, int thread_num*/)
|
||||
{
|
||||
static int thread_num = 0;
|
||||
thread_num++;
|
||||
QSPIFBlockDevice *blockD = (QSPIFBlockDevice *)vBlockD;
|
||||
utest_printf("\n Thread %d Started \n", thread_num);
|
||||
|
||||
bd_size_t block_size = blockD->get_erase_size();
|
||||
unsigned addrwidth = ceil(log(float(blockD->size() - 1)) / log(float(16))) + 1;
|
||||
|
||||
uint8_t *write_block = new (std::nothrow) uint8_t[block_size];
|
||||
uint8_t *read_block = new (std::nothrow) uint8_t[block_size];
|
||||
if (!write_block || !read_block ) {
|
||||
utest_printf("\n Not enough memory for test");
|
||||
goto end;
|
||||
}
|
||||
|
||||
for (int b = 0; b < TEST_BLOCK_COUNT; b++) {
|
||||
basic_erase_program_read_test((*blockD), block_size, write_block, read_block, addrwidth);
|
||||
}
|
||||
|
||||
end:
|
||||
delete[] write_block;
|
||||
delete[] read_block;
|
||||
}
|
||||
|
||||
void test_qspif_multi_threads()
|
||||
{
|
||||
|
||||
utest_printf("\nTest Multi Threaded Erase/Program/Read Starts..\n");
|
||||
|
||||
QSPIFBlockDevice blockD(QSPI_FLASH1_IO0, QSPI_FLASH1_IO1, QSPI_FLASH1_IO2, QSPI_FLASH1_IO3,
|
||||
QSPI_FLASH1_SCK, QSPI_FLASH1_CSN, QSPIF_POLARITY_MODE_0, MBED_CONF_QSPIF_QSPI_FREQ);
|
||||
|
||||
int err = blockD.init();
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
|
||||
for (unsigned atr = 0; atr < sizeof(ATTRS) / sizeof(ATTRS[0]); atr++) {
|
||||
static const char *prefixes[] = {"", "k", "M", "G"};
|
||||
for (int i_ind = 3; i_ind >= 0; i_ind--) {
|
||||
bd_size_t size = (blockD.*ATTRS[atr].method)();
|
||||
if (size >= (1ULL << 10 * i_ind)) {
|
||||
utest_printf("%s: %llu%sbytes (%llubytes)\n",
|
||||
ATTRS[atr].name, size >> 10 * i_ind, prefixes[i_ind], size);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
rtos::Thread qspif_bd_thread[QSPIF_TEST_NUM_OF_THREADS];
|
||||
|
||||
osStatus threadStatus;
|
||||
int i_ind;
|
||||
|
||||
for (i_ind = 0; i_ind < QSPIF_TEST_NUM_OF_THREADS; i_ind++) {
|
||||
threadStatus = qspif_bd_thread[i_ind].start(test_qspif_thread_job, (void *)&blockD);
|
||||
if (threadStatus != 0) {
|
||||
utest_printf("\n Thread %d Start Failed!", i_ind + 1);
|
||||
}
|
||||
}
|
||||
|
||||
for (i_ind = 0; i_ind < QSPIF_TEST_NUM_OF_THREADS; i_ind++) {
|
||||
qspif_bd_thread[i_ind].join();
|
||||
}
|
||||
|
||||
err = blockD.deinit();
|
||||
TEST_ASSERT_EQUAL(0, err);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
// Test setup
|
||||
utest::v1::status_t test_setup(const size_t number_of_cases)
|
||||
{
|
||||
GREENTEA_SETUP(60, "default_auto");
|
||||
return verbose_test_setup_handler(number_of_cases);
|
||||
}
|
||||
|
||||
Case cases[] = {
|
||||
Case("Testing unaligned program blocks", test_qspif_unaligned_program),
|
||||
Case("Testing read write random blocks", test_qspif_random_program_read_erase),
|
||||
Case("Testing Multi Threads Erase Program Read", test_qspif_multi_threads)
|
||||
};
|
||||
|
||||
Specification specification(test_setup, cases);
|
||||
|
||||
|
||||
int main()
|
||||
{
|
||||
mbed_trace_init();
|
||||
utest_printf("MAIN STARTS\n");
|
||||
return !Harness::run(specification);
|
||||
}
|
|
@ -0,0 +1,20 @@
|
|||
{
|
||||
"name": "qspif",
|
||||
"config": {
|
||||
"QSPI_FREQ": "40000000"
|
||||
},
|
||||
"target_overrides": {
|
||||
"DISCO_F413ZH": {
|
||||
"QSPI_FREQ": "80000000"
|
||||
},
|
||||
"DISCO_L475VG": {
|
||||
"QSPI_FREQ": "8000000"
|
||||
},
|
||||
"DISCO_L476VG": {
|
||||
"QSPI_FREQ": "80000000"
|
||||
},
|
||||
"DISCO_F469NI": {
|
||||
"QSPI_FREQ": "80000000"
|
||||
}
|
||||
}
|
||||
}
|
Loading…
Reference in New Issue