static int flash_page_program(uint32_t addr, const void *buf, size_t len)
{
int ret;
uint8_t *_buf = (uint8_t*)buf;
if (addr % FLASH_PAGE_SIZE + len > FLASH_PAGE_SIZE) {
return -1;
}
//workaround as library does not allow to flash single page in one go.
//if more than possible bytes to write, split in two.
flash_write_enable();
flash_spi_select();
ret = flash_cmd_w_addr(FLASH_PP, addr);
if (len > FLASH_MAX_MESSAGE) {
if (ret == 0) {
ret = flash_spi_send(buf, FLASH_MAX_MESSAGE);
}
if (ret == 0) {
ret = flash_spi_send(&(_buf[FLASH_MAX_MESSAGE]), len - FLASH_MAX_MESSAGE);
}
} else {
if (ret == 0) {
ret = flash_spi_send(buf, len);
}
}
flash_spi_unselect();
if (ret == 0) {
ret = flash_wait_until_done(FLASH_PAGE_PROGRAM_TIMEOUT_MS);
}
flash_write_disable();
return ret;
}
int flash_id_read(uint8_t *id)
{
int ret;
flash_spi_select();
ret = flash_cmd(FLASH_RDID);
if (ret == 0) {
ret = flash_spi_receive(id, 3);
}
flash_spi_unselect();
return ret;
}
static int flash_read_config(uint8_t *cr)
{
int ret;
uint8_t cmd = FLASH_RDCR;
flash_spi_select();
ret = flash_spi_send(&cmd, 1);
if (ret == 0) {
ret = flash_spi_receive(cr, 1);
}
flash_spi_unselect();
return ret;
}
static int flash_read_status2(uint8_t *sr)
{
int ret;
uint8_t cmd = FLASH_RDSR2;
flash_spi_select();
ret = flash_spi_send(&cmd, 1);
if (ret == 0) {
ret = flash_spi_receive(sr, 1);
}
flash_spi_unselect();
return ret;
}
int flash_chip_erase(void)
{
int ret;
flash_write_enable();
flash_spi_select();
ret = flash_cmd(FLASH_BE);
flash_spi_unselect();
if (ret == 0) {
ret = flash_wait_until_done(FLASH_CHIP_ERASE_TIMEOUT_MS);
}
flash_write_disable();
return ret;
}
static int flash_cmd_w_addr(uint8_t cmd, uint32_t addr)
{
if (addr >= (1<<24)) {
return -1;
}
uint8_t buf[4] = {cmd, (addr>>16) & 0xff, (addr>>8) & 0xff, addr & 0xff};
return flash_spi_send(buf, sizeof(buf));
}
static void flash_write_enable(void)
{
flash_spi_select();
flash_cmd(FLASH_WREN);
flash_spi_unselect();
}
//sector erase (4kB) only works for first 64kB
int flash_sector_erase(uint32_t addr)
{
int ret;
if (addr < FLASH_BLOCK_SIZE) {
flash_write_enable();
flash_spi_select();
ret = flash_cmd_w_addr(FLASH_P4E, addr);
flash_spi_unselect();
if (ret == 0) {
ret = flash_wait_until_done(FLASH_BLOCK_64KB_ERASE_TIMEOUT_MS);
}
flash_write_disable();
return ret;
}
return -1;
}
//Only valid if using 64kB block size
int flash_block_erase(uint32_t addr)
{
int ret;
flash_write_enable();
flash_spi_select();
ret = flash_cmd_w_addr(FLASH_SE, addr);
flash_spi_unselect();
if (ret == 0) {
if (addr < FLASH_BLOCK_SIZE) {
ret = flash_wait_until_done(FLASH_BLOCK1_64KB_ERASE_TIMEOUT_MS);
} else {
ret = flash_wait_until_done(FLASH_BLOCK_64KB_ERASE_TIMEOUT_MS);
}
}
flash_write_disable();
return ret;
}
//TODO: works with mavlink_log, should test it for standards log.
int flash_read(uint32_t addr, void *buf, size_t len)
{
int ret = 0;
size_t pos = 0;
uint8_t *p_buf = (uint8_t*)buf;
//read is consecutive and independent of page
size_t align = len < FLASH_MAX_MESSAGE ? len : FLASH_MAX_MESSAGE;
flash_spi_select();
ret = flash_cmd_w_addr(FLASH_READ, addr);
while (pos < len && ret == 0) {
ret = flash_spi_receive(&p_buf[pos], align);
pos += align;
align = len - pos < FLASH_MAX_MESSAGE ? len - pos : FLASH_MAX_MESSAGE;
}
flash_spi_unselect();
return ret;
}
int flash_write_registers(uint8_t *sr1, uint8_t *cr, uint8_t *sr2)
{
int ret;
int ret2;
uint8_t cmd = FLASH_WRR;
flash_write_enable();
flash_spi_select();
ret = flash_spi_send(&cmd, 1);
//write one config register after the other, null pointer stops process
if (ret == 0 && sr1) {
ret = flash_spi_send(sr1, 1);
if (ret == 0 && cr) {
ret = flash_spi_send(cr, 1);
if (ret == 0 && sr2) {
ret = flash_spi_send(sr2, 1);
}
}
}
//this is required to start the procedure to write the registers.
flash_spi_unselect();
ret2 = flash_wait_until_done(FLASH_REGISTER_PROGRAM_TIMEOUT_MS);
flash_write_disable();
return ret == 0 ? ret2 : ret;
}
static void flash_write_disable(void)
{
flash_spi_select();
flash_cmd(FLASH_WRDI);
flash_spi_unselect();
}
// Starts a command operation.
static void start_command(uint8_t command) {
flash_spi_select();
spi_tx(command);
}
