tbm-mcu/source/core/flash.c

#include <stdint.h>
#include <stdlib.h>
#include <string.h>

#include <flash.h>
#include <macros.h>

static int default_flash_is_val(struct flash_dev *dev, uint32_t addr, uint8_t val)
{
	uint8_t data[32];
	size_t i, nbytes, len = 1 << dev->log2_block_size;

	addr <<= dev->log2_block_size;

	while (len) {
		nbytes = min(32, len);

		if (flash_read(dev, addr, data, nbytes) == 0)
			return 0;

		for (i = 0; i < sizeof(data); ++i) {
			if (data[i] != val)
				return 0;
		}

		addr += nbytes;
		len -= nbytes;
	}

	return 1;
}

int default_flash_is_zero(struct flash_dev *dev, uint32_t addr)
{
	return default_flash_is_val(dev, addr, 0);
}

int default_flash_is_one(struct flash_dev *dev, uint32_t addr)
{
	return default_flash_is_val(dev, addr, 0xff);
}

size_t default_flash_copy(struct flash_dev *dev, uint32_t dst, uint32_t src,
	size_t len)
{
	uint8_t data[32];
	size_t nbytes, ret = 0;

	while (len) {
		nbytes = min(sizeof data, len);

		if (flash_read(dev, src, data, nbytes) == 0)
			return ret;

		if (flash_write(dev, dst, data, nbytes) == 0)
			return ret;

		dst += nbytes;
		src += nbytes;
		len -= nbytes;
		ret += nbytes;
	}

	return ret;
}

void flash_release(struct flash_dev *dev)
{
	if (!dev)
		return;

	dev->ops->release(dev);
}

size_t flash_get_jedec_id(struct flash_dev *dev, char *jedec_id, size_t len)
{
	if (!dev || !dev->ops->get_jedec_id)
		return 0;

	return dev->ops->get_jedec_id(dev, jedec_id, len);
}

size_t flash_get_size(struct flash_dev *dev)
{
	if (!dev)
		return 0;

	return dev->ops->get_size(dev);
}

size_t flash_get_capacity(struct flash_dev *dev)
{
	if (!dev)
		return 0;

	return dev->ops->get_capacity(dev);
}

#ifdef flash_read
#undef flash_read
#define flash_read __real_flash_read
#endif

size_t flash_read(struct flash_dev *dev, uint32_t addr, void *data, size_t len)
{
	if (!dev)
		return -1;

	return dev->ops->read(dev, addr, data, len);
}

#ifdef flash_read
#undef flash_read
#define flash_read __wrap_flash_read
#endif

#ifdef flash_write
#undef flash_write
#define flash_write __real_flash_write
#endif

size_t flash_write(struct flash_dev *dev, uint32_t addr, const void *data,
	size_t len)
{
	if (!dev)
		return -1;

	return dev->ops->write(dev, addr, data, len);
}

#ifdef flash_write
#undef flash_write
#define flash_write __wrap_flash_write
#endif

#ifdef flash_write0
#undef flash_write0
#define flash_write0 __real_flash_write0
#endif

size_t flash_write0(struct flash_dev *dev, uint32_t addr, size_t len)
{
	uint8_t data[32];
	size_t nbytes, ret = 0;

	memset(data, 0, 32);

	while (len) {
		nbytes = min(sizeof data, len);

		if (flash_write(dev, addr, data, nbytes) == 0)
			return ret;

		addr += nbytes;
		len -= nbytes;
		ret += nbytes;
	}

	return ret;
}

#ifdef flash_write0
#undef flash_write0
#define flash_write0 __wrap_flash_write0
#endif

#ifdef flash_copy
#undef flash_copy
#define flash_copy __real_flash_copy
#endif

size_t flash_copy(struct flash_dev *dev, uint32_t dst, uint32_t src, size_t len)
{
	if (!dev)
		return 0;

	return dev->ops->copy(dev, dst, src, len);
}

#ifdef flash_copy
#undef flash_copy
#define flash_copy __wrap_flash_copy
#endif

#ifdef flash_is_erased
#undef flash_is_erased
#define flash_is_erased __real_flash_is_erased
#endif

int flash_is_erased(struct flash_dev *dev, uint32_t addr, size_t len)
{
	if (!dev)
		return -1;

	while (len--) {
		if (!dev->ops->is_erased(dev, addr))
			return 0;

		++addr;
	}

	return 1;
}

#ifdef flash_is_erased
#undef flash_is_erased
#define flash_is_erased __wrap_flash_is_erased
#endif

int flash_erase(struct flash_dev *dev, uint32_t addr, size_t len)
{
	if (!dev)
		return -1;

	while (len--) {
		if (dev->ops->erase(dev, addr) < 0)
			return -1;

		++addr;
	}

	return 0;
}

int flash_sync(struct flash_dev *dev)
{
	if (!dev)
		return -1;

	if (!dev->ops->sync)
		return 0;

	return dev->ops->sync(dev);
}