aboutsummaryrefslogtreecommitdiff
path: root/src/flash/nor/dsp5680xx_flash.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/flash/nor/dsp5680xx_flash.c')
-rw-r--r--src/flash/nor/dsp5680xx_flash.c296
1 files changed, 168 insertions, 128 deletions
diff --git a/src/flash/nor/dsp5680xx_flash.c b/src/flash/nor/dsp5680xx_flash.c
index dd32a2fa..78cd6e3d 100644
--- a/src/flash/nor/dsp5680xx_flash.c
+++ b/src/flash/nor/dsp5680xx_flash.c
@@ -35,14 +35,10 @@
*
*/
-
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
-#ifndef DSP5680XX_FLASH_H
-#define DSP5680XX_FLASH_H
-
#include "imp.h"
#include <helper/binarybuffer.h>
#include <helper/time_support.h>
@@ -53,35 +49,39 @@ struct dsp5680xx_flash_bank {
struct working_area *write_algorithm;
};
-static int dsp5680xx_build_sector_list(struct flash_bank *bank){
- uint32_t offset = HFM_FLASH_BASE_ADDR;
- bank->sectors = malloc(sizeof(struct flash_sector) * bank->num_sectors);
- int i;
- for (i = 0; i < bank->num_sectors; ++i){
- bank->sectors[i].offset = i*HFM_SECTOR_SIZE;
- bank->sectors[i].size = HFM_SECTOR_SIZE;
- offset += bank->sectors[i].size;
- bank->sectors[i].is_erased = -1;
- bank->sectors[i].is_protected = -1;
- }
- LOG_USER("%s not tested yet.",__FUNCTION__);
- return ERROR_OK;
+static int dsp5680xx_build_sector_list(struct flash_bank *bank)
+{
+ uint32_t offset = HFM_FLASH_BASE_ADDR;
+
+ bank->sectors = malloc(sizeof(struct flash_sector) * bank->num_sectors);
+ int i;
+
+ for (i = 0; i < bank->num_sectors; ++i) {
+ bank->sectors[i].offset = i * HFM_SECTOR_SIZE;
+ bank->sectors[i].size = HFM_SECTOR_SIZE;
+ offset += bank->sectors[i].size;
+ bank->sectors[i].is_erased = -1;
+ bank->sectors[i].is_protected = -1;
+ }
+ LOG_USER("%s not tested yet.", __func__);
+ return ERROR_OK;
}
-// flash bank dsp5680xx 0 0 0 0 <target#>
-FLASH_BANK_COMMAND_HANDLER(dsp5680xx_flash_bank_command){
- struct dsp5680xx_flash_bank *nbank;
+/* flash bank dsp5680xx 0 0 0 0 <target#> */
+FLASH_BANK_COMMAND_HANDLER(dsp5680xx_flash_bank_command)
+{
+ struct dsp5680xx_flash_bank *nbank;
- nbank = malloc(sizeof(struct dsp5680xx_flash_bank));
+ nbank = malloc(sizeof(struct dsp5680xx_flash_bank));
- bank->base = HFM_FLASH_BASE_ADDR;
- bank->size = HFM_SIZE_BYTES; // top 4k not accessible
- bank->driver_priv = nbank;
- bank->num_sectors = HFM_SECTOR_COUNT;
- dsp5680xx_build_sector_list(bank);
+ bank->base = HFM_FLASH_BASE_ADDR;
+ bank->size = HFM_SIZE_BYTES; /* top 4k not accessible */
+ bank->driver_priv = nbank;
+ bank->num_sectors = HFM_SECTOR_COUNT;
+ dsp5680xx_build_sector_list(bank);
- return ERROR_OK;
+ return ERROR_OK;
}
/**
@@ -93,26 +93,29 @@ FLASH_BANK_COMMAND_HANDLER(dsp5680xx_flash_bank_command){
*
* @return
*/
-static int dsp5680xx_flash_protect_check(struct flash_bank *bank){
- int retval = ERROR_OK;
- uint16_t protected = 0;
- retval = dsp5680xx_f_protect_check(bank->target,&protected);
- if(retval != ERROR_OK){
- for(int i = 0;i<HFM_SECTOR_COUNT;i++)
- bank->sectors[i].is_protected = -1;
- return ERROR_OK;
- }
- for(int i = 0;i<HFM_SECTOR_COUNT/2;i++){
- if(protected & 1){
- bank->sectors[2*i].is_protected = 1;
- bank->sectors[2*i+1].is_protected = 1;
- }else{
- bank->sectors[2*i].is_protected = 0;
- bank->sectors[2*i+1].is_protected = 0;
- }
- protected = (protected >> 1);
- }
- return retval;
+static int dsp5680xx_flash_protect_check(struct flash_bank *bank)
+{
+ int retval = ERROR_OK;
+
+ uint16_t protected = 0;
+
+ retval = dsp5680xx_f_protect_check(bank->target, &protected);
+ if (retval != ERROR_OK) {
+ for (int i = 0; i < HFM_SECTOR_COUNT; i++)
+ bank->sectors[i].is_protected = -1;
+ return ERROR_OK;
+ }
+ for (int i = 0; i < HFM_SECTOR_COUNT / 2; i++) {
+ if (protected & 1) {
+ bank->sectors[2 * i].is_protected = 1;
+ bank->sectors[2 * i + 1].is_protected = 1;
+ } else {
+ bank->sectors[2 * i].is_protected = 0;
+ bank->sectors[2 * i + 1].is_protected = 0;
+ }
+ protected = (protected >> 1);
+ }
+ return retval;
}
/**
@@ -127,21 +130,27 @@ static int dsp5680xx_flash_protect_check(struct flash_bank *bank){
*
* @return
*/
-static int dsp5680xx_flash_protect(struct flash_bank *bank, int set, int first, int last){
- // This applies security to flash module after next reset, it does not actually apply protection (protection refers to undesired access from the core)
- int retval;
- if(set)
- retval = dsp5680xx_f_lock(bank->target);
-else{
- retval = dsp5680xx_f_unlock(bank->target);
- if (retval == ERROR_OK) {
- /* mark all as erased */
- for (int i = 0; i <= (HFM_SECTOR_COUNT-1); i++)
- /* FM does not recognize it as erased if erased via JTAG. */
- bank->sectors[i].is_erased = 1;
+static int dsp5680xx_flash_protect(struct flash_bank *bank, int set, int first,
+ int last)
+{
+/**
+ * This applies security to flash module after next reset, it does
+ * not actually apply protection (protection refers to undesired access from the core)
+ */
+ int retval;
+
+ if (set)
+ retval = dsp5680xx_f_lock(bank->target);
+ else {
+ retval = dsp5680xx_f_unlock(bank->target);
+ if (retval == ERROR_OK) {
+ /* mark all as erased */
+ for (int i = 0; i <= (HFM_SECTOR_COUNT - 1); i++)
+ /* FM does not recognize it as erased if erased via JTAG. */
+ bank->sectors[i].is_erased = 1;
+ }
}
-}
- return retval;
+ return retval;
}
/**
@@ -154,34 +163,54 @@ else{
*
* @return
*/
-static int dsp5680xx_flash_write(struct flash_bank *bank, uint8_t *buffer, uint32_t offset, uint32_t count){
- int retval;
- if((offset + count/2)>bank->size){
- LOG_ERROR("%s: Flash bank cannot fit data.",__FUNCTION__);
- return ERROR_FAIL;
- }
- if(offset%2){
- LOG_ERROR("%s: Writing to odd addresses not supported. This chip uses word addressing, Openocd only supports byte addressing. The workaround results in disabling writing to odd byte addresses.",__FUNCTION__);
- return ERROR_FAIL;
- }
- retval = dsp5680xx_f_wr(bank->target, buffer, bank->base + offset/2, count, 0);
- uint32_t addr_word;
- for(addr_word = bank->base + offset/2;addr_word<count/2;addr_word+=(HFM_SECTOR_SIZE/2)){
- if(retval == ERROR_OK)
- bank->sectors[addr_word/(HFM_SECTOR_SIZE/2)].is_erased = 0;
- else
- bank->sectors[addr_word/(HFM_SECTOR_SIZE/2)].is_erased = -1;
- }
- return retval;
+static int dsp5680xx_flash_write(struct flash_bank *bank, uint8_t * buffer,
+ uint32_t offset, uint32_t count)
+{
+ int retval;
+
+ if ((offset + count / 2) > bank->size) {
+ LOG_ERROR("%s: Flash bank cannot fit data.", __func__);
+ return ERROR_FAIL;
+ }
+ if (offset % 2) {
+ /**
+ * Writing to odd addresses not supported.
+ * This chip uses word addressing, Openocd only supports byte addressing.
+ * The workaround results in disabling writing to odd byte addresses
+ */
+ LOG_ERROR
+ ("%s: Writing to odd addresses not supported for this target",
+ __func__);
+ return ERROR_FAIL;
+ }
+ retval =
+ dsp5680xx_f_wr(bank->target, buffer, bank->base + offset / 2, count,
+ 0);
+ uint32_t addr_word;
+
+ for (addr_word = bank->base + offset / 2; addr_word < count / 2;
+ addr_word += (HFM_SECTOR_SIZE / 2)) {
+ if (retval == ERROR_OK)
+ bank->sectors[addr_word /
+ (HFM_SECTOR_SIZE / 2)].is_erased = 0;
+ else
+ bank->sectors[addr_word /
+ (HFM_SECTOR_SIZE / 2)].is_erased = -1;
+ }
+ return retval;
}
-static int dsp5680xx_probe(struct flash_bank *bank){
- LOG_DEBUG("%s not implemented",__FUNCTION__);
- return ERROR_OK;
+static int dsp5680xx_probe(struct flash_bank *bank)
+{
+ LOG_DEBUG("%s not implemented", __func__);
+ return ERROR_OK;
}
-static int dsp5680xx_flash_info(struct flash_bank *bank, char *buf, int buf_size){
- snprintf(buf, buf_size, "\ndsp5680xx flash driver info:\n - Currently only full erase/lock/unlock are implemented. \n - Call with bank==0 and sector 0 to 0.\n - Protect requires arp_init-reset to complete. \n - Before removing protection the master tap must be selected, and arp_init-reset is required to complete unlocking.");
+static int dsp5680xx_flash_info(struct flash_bank *bank, char *buf,
+ int buf_size)
+{
+ snprintf(buf, buf_size,
+ "\ndsp5680xx flash driver info:\n - See comments in code.");
return ERROR_OK;
}
@@ -195,19 +224,26 @@ static int dsp5680xx_flash_info(struct flash_bank *bank, char *buf, int buf_size
*
* @return
*/
-static int dsp5680xx_flash_erase(struct flash_bank * bank, int first, int last){
- int retval;
- retval = dsp5680xx_f_erase(bank->target, (uint32_t) first, (uint32_t) last);
-if ((!(first|last)) || ((first == 0) && (last == (HFM_SECTOR_COUNT-1))))
- last = HFM_SECTOR_COUNT-1;
- if(retval == ERROR_OK)
- for(int i = first;i<=last;i++)
- bank->sectors[i].is_erased = 1;
- else
- // If an error occurred unknown status is set even though some sector could have been correctly erased.
- for(int i = first;i<=last;i++)
- bank->sectors[i].is_erased = -1;
- return retval;
+static int dsp5680xx_flash_erase(struct flash_bank *bank, int first, int last)
+{
+ int retval;
+
+ retval =
+ dsp5680xx_f_erase(bank->target, (uint32_t) first, (uint32_t) last);
+ if ((!(first | last))
+ || ((first == 0) && (last == (HFM_SECTOR_COUNT - 1))))
+ last = HFM_SECTOR_COUNT - 1;
+ if (retval == ERROR_OK)
+ for (int i = first; i <= last; i++)
+ bank->sectors[i].is_erased = 1;
+ else
+ /**
+ * If an error occurred unknown status
+ *is set even though some sector could have been correctly erased.
+ */
+ for (int i = first; i <= last; i++)
+ bank->sectors[i].is_erased = -1;
+ return retval;
}
/**
@@ -218,37 +254,41 @@ if ((!(first|last)) || ((first == 0) && (last == (HFM_SECTOR_COUNT-1))))
*
* @return
*/
-static int dsp5680xx_flash_erase_check(struct flash_bank * bank){
- int retval = ERROR_OK;
- uint8_t erased = 0;
- uint32_t i;
- for(i=0;i<HFM_SECTOR_COUNT;i++){
- if(bank->sectors[i].is_erased == -1){
- retval = dsp5680xx_f_erase_check(bank->target,&erased,i);
- if (retval != ERROR_OK){
- bank->sectors[i].is_erased = -1;
- }else{
- if(erased)
- bank->sectors[i].is_erased = 1;
- else
- bank->sectors[i].is_erased = 0;
- }
- }
- }
- return retval;
+static int dsp5680xx_flash_erase_check(struct flash_bank *bank)
+{
+ int retval = ERROR_OK;
+
+ uint8_t erased = 0;
+
+ uint32_t i;
+
+ for (i = 0; i < HFM_SECTOR_COUNT; i++) {
+ if (bank->sectors[i].is_erased == -1) {
+ retval =
+ dsp5680xx_f_erase_check(bank->target, &erased, i);
+ if (retval != ERROR_OK) {
+ bank->sectors[i].is_erased = -1;
+ } else {
+ if (erased)
+ bank->sectors[i].is_erased = 1;
+ else
+ bank->sectors[i].is_erased = 0;
+ }
+ }
+ }
+ return retval;
}
struct flash_driver dsp5680xx_flash = {
- .name = "dsp5680xx_flash",
- .flash_bank_command = dsp5680xx_flash_bank_command,
- .erase = dsp5680xx_flash_erase,
- .protect = dsp5680xx_flash_protect,
- .write = dsp5680xx_flash_write,
- //.read = default_flash_read,
- .probe = dsp5680xx_probe,
- .auto_probe = dsp5680xx_probe,
- .erase_check = dsp5680xx_flash_erase_check,
- .protect_check = dsp5680xx_flash_protect_check,
- .info = dsp5680xx_flash_info
+ .name = "dsp5680xx_flash",
+ .flash_bank_command = dsp5680xx_flash_bank_command,
+ .erase = dsp5680xx_flash_erase,
+ .protect = dsp5680xx_flash_protect,
+ .write = dsp5680xx_flash_write,
+ /* .read = default_flash_read, */
+ .probe = dsp5680xx_probe,
+ .auto_probe = dsp5680xx_probe,
+ .erase_check = dsp5680xx_flash_erase_check,
+ .protect_check = dsp5680xx_flash_protect_check,
+ .info = dsp5680xx_flash_info
};
-#endif // dsp5680xx_flash.h
generated by cgit v1.2.3-18-g5258 (git 2.32.0) at 2024-10-17 14:32:51 +0000