mirror of
git://git.code.sf.net/p/openocd/code
synced 2025-07-19 13:02:18 +10:00
d8042fbb46
Replace the BSD-3-Clause boilerplate with the SPDX tag. Add the SPDX tag and the copyright to two makefiles that were added by TI with the other files in their respective folder. The SPDX tag on files *.c is incorrect, as it should use the C99 single line comment using '//'. But current checkpatch doesn't allow C99 comments, so keep using standard C comments, by now. Change-Id: I3ad1b2dbdb6054b74dcc26e394c9223ba0427caf Signed-off-by: Antonio Borneo <borneo.antonio@gmail.com> Reviewed-on: https://review.openocd.org/c/openocd/+/7158 Tested-by: jenkins
152 lines
4.1 KiB
C
152 lines
4.1 KiB
C
/* SPDX-License-Identifier: BSD-3-Clause */
|
|
|
|
/******************************************************************************
|
|
*
|
|
* Copyright (C) 2017-2018 Texas Instruments Incorporated - http://www.ti.com/
|
|
*
|
|
******************************************************************************/
|
|
|
|
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
#include "flashloader.h"
|
|
#include "flash.h"
|
|
|
|
/* Array holding erased state of the flash sectors. */
|
|
static bool g_is_erased[FLASH_MAX_SECTOR_COUNT];
|
|
|
|
extern uint8_t g_retain_buf[];
|
|
|
|
uint32_t flashloader_init(struct flash_params *params, uint8_t *buf1,
|
|
uint8_t *buf2)
|
|
{
|
|
/* Initialize params buffers */
|
|
memset((void *)params, 0, 2 * sizeof(struct flash_params));
|
|
params[0].buf_addr = (uint32_t)buf1;
|
|
params[1].buf_addr = (uint32_t)buf2;
|
|
|
|
/* Mark all sectors at "not erased" */
|
|
memset(g_is_erased, false, sizeof(g_is_erased));
|
|
|
|
return STATUS_OK;
|
|
}
|
|
|
|
uint32_t flashloader_erase_and_program(uint8_t *src, uint32_t address,
|
|
uint32_t byte_count)
|
|
{
|
|
if (byte_count > BUFFER_LEN)
|
|
return STATUS_FAILED_INVALID_ARGUMENTS;
|
|
|
|
/* Erase affected sectors */
|
|
uint32_t status = flashloader_erase_sectors(address, byte_count);
|
|
|
|
if (status != STATUS_OK)
|
|
return status;
|
|
|
|
/* Program data */
|
|
status = flashloader_program(src, address, byte_count);
|
|
|
|
return status;
|
|
}
|
|
|
|
uint32_t flashloader_program_with_retain(uint8_t *src, uint32_t address,
|
|
uint32_t byte_count)
|
|
{
|
|
#if (BUFFER_LEN > FLASH_ERASE_SIZE)
|
|
#error Buffer size cannot be larger than the flash sector size!
|
|
#endif
|
|
|
|
uint32_t first_sector_idx;
|
|
uint32_t last_sector_idx;
|
|
uint32_t status = STATUS_OK;
|
|
uint32_t i;
|
|
|
|
first_sector_idx = flashloader_address_to_sector(address);
|
|
last_sector_idx = flashloader_address_to_sector(address + byte_count - 1);
|
|
|
|
/* Mark all sectors as "not erased" before starting */
|
|
memset(g_is_erased, false, sizeof(g_is_erased));
|
|
|
|
uint32_t sec_offset = address % FLASH_ERASE_SIZE;
|
|
uint32_t curr_count;
|
|
uint32_t src_offset = 0;
|
|
|
|
for (i = first_sector_idx; i <= last_sector_idx; i++) {
|
|
|
|
/* Chop off at sector boundary if data goes into the next sector. */
|
|
curr_count = byte_count;
|
|
if ((address + byte_count) > ((i+1) * FLASH_ERASE_SIZE))
|
|
curr_count -= (address + byte_count) % FLASH_ERASE_SIZE;
|
|
|
|
/* Copy flash sector to retain buffer */
|
|
memcpy(g_retain_buf, (void *)(i * FLASH_ERASE_SIZE), FLASH_ERASE_SIZE);
|
|
|
|
/* Copy data buffer to retain buffer */
|
|
memcpy(&g_retain_buf[sec_offset], &src[src_offset], curr_count);
|
|
|
|
/* Erase and program from retain buffer */
|
|
status = flashloader_erase_and_program(g_retain_buf,
|
|
(i * FLASH_ERASE_SIZE), FLASH_ERASE_SIZE);
|
|
if (status != STATUS_OK)
|
|
return status;
|
|
|
|
address += curr_count;
|
|
sec_offset = address % FLASH_ERASE_SIZE;
|
|
byte_count -= curr_count;
|
|
src_offset += curr_count;
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
uint32_t flashloader_erase_all(void)
|
|
{
|
|
if (flash_bank_erase(true) != FAPI_STATUS_SUCCESS)
|
|
return STATUS_FAILED_ERASE_ALL;
|
|
|
|
memset(g_is_erased, true, sizeof(g_is_erased));
|
|
|
|
return STATUS_OK;
|
|
}
|
|
|
|
uint32_t flashloader_erase_sectors(uint32_t address, uint32_t byte_count)
|
|
{
|
|
uint32_t first_sector_idx;
|
|
uint32_t last_sector_idx;
|
|
uint32_t status;
|
|
uint32_t idx;
|
|
|
|
/* Floor address to the start of the sector and convert to sector number */
|
|
first_sector_idx = flashloader_address_to_sector(address);
|
|
last_sector_idx = flashloader_address_to_sector(address + byte_count - 1);
|
|
|
|
/* Erase given sector(s) */
|
|
for (idx = first_sector_idx; idx <= last_sector_idx; idx++) {
|
|
|
|
/* Only erase sectors that haven't already been erased */
|
|
if (g_is_erased[idx] == false) {
|
|
status = flash_sector_erase(idx * FLASH_ERASE_SIZE);
|
|
if (status != FAPI_STATUS_SUCCESS) {
|
|
status = (STATUS_FAILED_SECTOR_ERASE |
|
|
((idx << STATUS_EXT_INFO_S) & STATUS_EXT_INFO_M) |
|
|
((status << STATUS_ROM_CODE_S) & STATUS_ROM_CODE_M));
|
|
return status;
|
|
}
|
|
g_is_erased[idx] = true;
|
|
}
|
|
}
|
|
|
|
return STATUS_OK;
|
|
}
|
|
|
|
uint32_t flashloader_program(uint8_t *src, uint32_t address,
|
|
uint32_t byte_count)
|
|
{
|
|
uint32_t status = flash_program(src, address, byte_count);
|
|
if (status != FAPI_STATUS_SUCCESS) {
|
|
status = (STATUS_FAILED_PROGRAM |
|
|
((status << STATUS_ROM_CODE_S) & STATUS_ROM_CODE_M));
|
|
}
|
|
|
|
return STATUS_OK;
|
|
}
|