123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238 |
- #include "flash.h"
- #include "log.h"
- #include "common.h"
- #include "error.h"
- #include "hal_mcu.h"
- uint8_t flash_write_ucds(uint32_t addr,uint32_t value)
- {
- if(addr>0x3ffc || (addr&0x03)>0)
- {
- return PPlus_ERR_INVALID_DATA;
- }
- else
- {
- uint32_t temp = value;
- uint32_t offset = (addr + FLASH_UCDS_ADDR_BASE) & 0xffffff;
- if(ProgramWord (offset, (uint8_t *) &temp, 4)==0) return PPlus_ERR_FATAL;
- }
-
- return PPlus_SUCCESS;
-
- }
- uint8_t flash_write_ucds_block(uint32_t addr,uint32_t length,uint32_t *buf)
- {
-
- if(addr>0x3ffc||((addr+(length<<2))>0x3ffc || (addr&0x03)>0))
- {
- return PPlus_ERR_INVALID_DATA;
- }
- else
- {
- for(uint32_t i=0;i<length;i++)
- {
- flash_write_ucds(addr+(i<<2),buf[i]);
- }
- }
-
- return PPlus_SUCCESS;
-
- }
- uint8_t flash_read_ucds_block(uint32_t addr,uint32_t length,uint32_t *tobuf)
- {
- if(addr>0x3ffc||((addr+(length<<2))>0x3ffc) || (addr&0x03)>0 )
- {
- return PPlus_ERR_INVALID_DATA;
- }
- else
- {
- for(uint32_t i=0;i<length;i++)
- {
- tobuf[i]=flash_read_ucds(addr+(i<<2));
- }
- }
-
- return PPlus_SUCCESS;
- }
- uint8_t flash_write_ucds_block_byte(uint32_t addr,uint32_t length,uint8_t *buf)
- {
-
- if(addr>0x3ffc||((addr+(length))>0x3ffc)|| (addr&0x03)>0)
- {
- return PPlus_ERR_INVALID_DATA;
- }
- else
- {
- uint32_t i;
- for(i=0;i<(length>>2);i++)
- {
- flash_write_ucds(addr+(i<<2), (buf[4*i+3]<<24 ) | (buf[4*i+2]<<16)| (buf[4*i+1]<<8) | buf[4*i] );
- }
- if(length-(i<<2)==3)
- {
- flash_write_ucds(addr+(i<<2), (buf[4*i+2]<<16)| (buf[4*i+1]<<8) | buf[4*i] );
- }
- else if(length-(i<<2)==2)
- {
- flash_write_ucds(addr+(i<<2), (buf[4*i+1]<<8) | buf[4*i] );
- }
- else if(length-(i<<2)==1)
- {
- flash_write_ucds(addr+(i<<2), buf[4*i] );
- }
- }
-
- return PPlus_SUCCESS;
-
- }
- uint8_t flash_read_ucds_block_byte(uint32_t addr,uint32_t length,uint8_t *tobuf)
- {
- if(addr>0x3ffc||((addr+(length))>0x3ffc)|| (addr&0x03)>0)
- {
- return PPlus_ERR_INVALID_DATA;
- }
- else
- {
- uint32_t i,wbuf;
- for(i=0;i<(length>>2);i++)
- {
- wbuf = flash_read_ucds(addr+(i<<2));
- tobuf[(i<<2) ] = 0x000000ff & wbuf;
- tobuf[(i<<2)+1] = (0x0000ff00 & wbuf)>>8;
- tobuf[(i<<2)+2] = (0x00ff0000 & wbuf)>>16;
- tobuf[(i<<2)+3] = (0xff000000 & wbuf)>>24;
- }
- if(length-(i<<2)==3)
- {
- wbuf = flash_read_ucds(addr+(i<<2));
- tobuf[(i<<2) ] = 0x000000ff & wbuf;
- tobuf[(i<<2)+1] = (0x0000ff00 & wbuf)>>8;
- tobuf[(i<<2)+2] = (0x00ff0000 & wbuf)>>16;
- }
- else if(length-(i<<2)==2)
- {
- wbuf = flash_read_ucds(addr+(i<<2));
- tobuf[(i<<2) ] = 0x000000ff & wbuf;
- tobuf[(i<<2)+1] = (0x0000ff00 & wbuf)>>8;
- }
- else if(length-(i<<2)==1)
- {
- wbuf = flash_read_ucds(addr+(i<<2));
- tobuf[(i<<2) ] = 0x000000ff & wbuf;
- }
- }
-
- return PPlus_SUCCESS;
- }
- uint32_t flash_read_ucds(uint32_t addr)
- {
- if(addr>0x3ffc)
- {
- return 0xffffffff;
- }
- else
- {
- return read_reg(addr+FLASH_UCDS_ADDR_BASE);
- }
- }
- void flash_erase_ucds_all(void)
- {
- flash_sector_erase(0x11005000);
- flash_sector_erase(0x11006000);
- flash_sector_erase(0x11007000);
- flash_sector_erase(0x11008000);
- }
- uint8_t flash_erase_ucds(uint32_t addr)
- {
- if(addr>0x3ffc)
- {
- return PPlus_ERR_INVALID_DATA;
- }
-
- if(addr<0x0fff)
- {
- flash_sector_erase(0x11005000);
- }
- else if(addr<0x1fff)
- {
- flash_sector_erase(0x11006000);
- }
- else if(addr<0x2fff)
- {
- flash_sector_erase(0x11007000);
- }
- else if(addr<0x3fff)
- {
- flash_sector_erase(0x11008000);
- }
- return PPlus_SUCCESS;
- }
|