|
- /***************************************************************************
- * Copyright (C) 2011 by Rodrigo L. Rosa *
- * rodrigorosa.LG@gmail.com *
- * *
- * Based on a file written by: *
- * Kevin McGuire *
- * Marcel Wijlaars *
- * Michael Ashton *
- * *
- * This program is free software; you can redistribute it and/or modify *
- * it under the terms of the GNU General Public License as published by *
- * the Free Software Foundation; either version 2 of the License, or *
- * (at your option) any later version. *
- * *
- * This program is distributed in the hope that it will be useful, *
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
- * GNU General Public License for more details. *
- * *
- * You should have received a copy of the GNU General Public License *
- * along with this program; if not, write to the *
- * Free Software Foundation, Inc., *
- * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
- ***************************************************************************/
-
- #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>
- #include <target/algorithm.h>
- #include <target/dsp5680xx.h>
-
- 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;
-
- }
-
- // 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));
-
- 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;
- }
-
- 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(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);
- if(retval == ERROR_OK){
- for(int i = first;i<last;i++)
- bank->sectors[i].is_protected = 1;
- }
- }else{
- retval = dsp5680xx_f_unlock(bank->target);
- if(retval == ERROR_OK)
- for(int i = first;i<last;i++)
- bank->sectors[i].is_protected = 0;
- }
- return retval;
- }
-
- /*
- static int dsp5680xx_write_block(struct flash_bank *bank, uint8_t *buffer, uint32_t offset, uint32_t count){
- LOG_USER("%s not implemented",__FUNCTION__);
- return ERROR_OK;
- }
-
- static int dsp5680xx_write_single(struct flash_bank *bank, uint8_t *buffer, uint32_t offset, uint32_t count){
- LOG_USER("%s not implemented",__FUNCTION__);
- return ERROR_OK;
- }
- */
-
- //-- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- --
- //-- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- --
- // Flash stuff test
- //-- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- --
- //-- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- -- --
-
- 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);
- if(retval == ERROR_OK)
- bank->sectors[0].is_erased = 0;
- else
- bank->sectors[0].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_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.");
- return ERROR_OK;
- }
- /*
- static int dsp5680xx_set_write_enable(struct target *target, int enable){
- LOG_USER("%s not implemented",__FUNCTION__);
- return ERROR_OK;
- }
-
-
- static int dsp5680xx_check_flash_completion(struct target* target, unsigned int timeout_ms){
- LOG_USER("%s not implemented",__FUNCTION__);
- return ERROR_OK;
- }
- */
-
- 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(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_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
- };
- #endif // dsp5680xx_flash.h
|