bosko lekovic
/
ETHtoCOM_10
nova verzija tcp+udp->serial com
DataFlash/flashDataBlock.cpp
- Committer:
- bosko001
- Date:
- 2020-07-10
- Revision:
- 26:c14d034d7459
- Parent:
- 22:11279d24a105
File content as of revision 26:c14d034d7459:
#include "mbed.h" #include "flashDataBlock.h" #include "FlashIAPBlockDevice.h" extern void printf_niz( char *s, char *niz, int val ); //{ // printf("%s",s); // for( int i=0; i < val; i++) printf("%c", niz[i]); // printf("\n\r"); //} FlashIAPBlockDevice bd((uint32_t)FLASH_ADDRESS,BLOCK_VALUE); int device_size; int read_size; int program_size; int erase_size; int erase_value; int buffer_dimension = buffer_dimension; int init_fdb( ) { // Initialize the flash IAP block device and print the memory layout int err = bd.init(); if( err ) { printf("flash data block init err=%d \n\r", err); return 1; } else printf("flash data block init OK \n\r"); device_size = bd.size(); read_size = bd.get_read_size(); program_size = bd.get_program_size(); erase_size = bd.get_erase_size(); erase_value = bd.get_erase_value(); // printf("Flash block device size: %x\n\r", device_size = bd.size()); // printf("Flash block device read size: %x\n\r", read_size = bd.get_read_size()); // printf("Flash block device program size: %x\n\r", program_size = bd.get_program_size()); // printf("Flash block device erase size: %x\n\r", erase_size = bd.get_erase_size()); // printf("Flash block device geterase value: %x\n\r", erase_value = bd.get_erase_value()); if( bd.is_valid_read( 0, bd.get_read_size() ) ) ;//printf(" flash data block read valid \n\r"); else {printf(" flash data block read NOT valid \n\r"); return 2;} return 0; } void deinit_fdb( void ) { bd.deinit(); } int scale_buffer_dimension( int val ) { if( val > device_size ) { val = buffer_dimension = device_size; /*printf("buf_dim = %d\n\r", buffer_dimension);*/} else if( val > buffer_dimension ) { buffer_dimension = val; /* printf("buf_dim = %d\n\r", buffer_dimension);*/} return val; } int read_fdb( int rel_adr, char *buffer, int val ) { int err; val = scale_buffer_dimension( rel_adr+val ); err = bd.read(buffer, rel_adr, val); return (err == 0) ? val : 0 ; } int write_byte_in_flash( int adr, char value ) { int err = 0; int prog_page = program_size; int adr_first = (adr/prog_page)*prog_page; int adr_last = adr_first + prog_page; scale_buffer_dimension( adr ); char *buffer = (char*)malloc(buffer_dimension); if( !(err = bd.read(buffer, 0, buffer_dimension))) if( !(err = bd.erase(0, erase_size))) { buffer[adr] = value; err = bd.program(buffer, 0, (buffer_dimension % prog_page) ? buffer_dimension + prog_page - buffer_dimension % prog_page: buffer_dimension); } free(buffer); return err; } int write_niz_in_flash( int adr, char *niz, int nizval ) { int err = 0; int prog_page = bd.get_program_size(); int adr_first = (adr/prog_page)*prog_page; int adr_last = adr_first + prog_page; scale_buffer_dimension( adr + nizval ); char *buffer = (char*)malloc(buffer_dimension); if(!(err = bd.read(buffer, 0, buffer_dimension))) if(!(err = bd.erase(0, bd.get_erase_size()))) { for( int i = adr; i<(adr+nizval); i++) buffer[adr+i] = niz[i]; err = bd.program(buffer, 0, (buffer_dimension % prog_page) ? buffer_dimension + prog_page - buffer_dimension % prog_page: buffer_dimension); } free(buffer); return err; }