Function storage_write

Lib/storage.c:348–456

Write storage block data - Buffer to write from address - Starting address to write to size - Number of bytes to write into storage clear - Set 0 for normal write, Set 1 to indicate nothing of value in the block (empty block) storage_init() must be called first Returns 0 - Not enough space 1 - Success 2 - Failed to write successfully, but incremented counters (i.e. try again)

//  1 - Success
//  2 - Failed to write successfully, but incremented counters (i.e. try again)
uint8_t storage_write(uint8_t* data, uint16_t address, uint16_t size, uint8_t clear )
{
	// Flashing buffer
	uint8_t page_buffer[STORAGE_FLASH_PAGE_SIZE];

	// Make sure there is enough address space in the storage
	if ( size + address > STORAGE_SIZE )
	{
		return 0;
	}

	// Make sure this isn't the same data already set in flash
	// If so, just exit, no need to wear the flash any further
	if ( memcmp( storage_buffer, data, size ) == 0 )
	{
		return 1;
	}

	// Set internal buffer to all 0xffs
	// This way it's possible to do partial writes to the page
	for ( int i = 0; i < STORAGE_FLASH_PAGE_SIZE; i++ )
	{
		page_buffer[i] = 0xff;
	}

	// Erase flash, only erases if erase_flag has been set
	storage_erase_flash();

	// Check which type of block we are writing
	uint8_t block_type = 0x00; // Normal block
	if ( clear )
	{
		// Cleared page, update status to indicate this page should be ignored
		block_type = 0x02;
		cleared_block = 1;
	}
	else
	{
		// Valid block
		cleared_block = 0;
	}

	// Clear empty page flag
	page_buffer[(current_storage_index * (STORAGE_SIZE + 1))] = block_type;

	// Prepare flashing and in-memory buffers so we can write to flash
	for ( int i = 0; i < size; i++ )
	{
		// Write to flashing buffer
		page_buffer[i + address + (current_storage_index * (STORAGE_SIZE + 1)) + 1] = data[i];

		// Write to in-memory storage
		storage_buffer[i + address] = data[i];
	}

	// Write flashing buffer to flash
	uint32_t status = flash_write(
		(STORAGE_FLASH_START + current_page * STORAGE_FLASH_PAGE_SIZE),