int error = -1;
size_t off;
+ int num_zero = 0;
const int fd = open(path, O_RDWR | O_TRUNC | O_CREAT, 00700);
if (fd == -1) {
for (off = 0; off < size; off += 1024) {
size_t read_size = 1024;
size_t rounded_size;
+ size_t index;
if ((off + read_size) > size)
read_size = size - off;
stlink_read_mem32(sl, addr + off, rounded_size);
+ for(index = 0; index < read_size; index ++) {
+ if (sl->q_buf[index] == 0)
+ num_zero ++;
+ else
+ num_zero = 0;
+ }
if (write(fd, sl->q_buf, read_size) != (ssize_t) read_size) {
fprintf(stderr, "write() != read_size\n");
goto on_error;
}
}
+ /* Ignore NULL Bytes at end of file */
+ ftruncate(fd, size - num_zero);
+
/* success */
error = 0;
int stlink_fwrite_flash(stlink_t *sl, const char* path, stm32_addr_t addr) {
/* write the file in flash at addr */
int err;
+ unsigned int num_zero = 0, index;
mapped_file_t mf = MAPPED_FILE_INITIALIZER;
if (map_file(&mf, path) == -1) {
WLOG("map_file() == -1\n");
return -1;
}
+ for(index = 0; index < mf.len; index ++) {
+ if (mf.base[index] == 0)
+ num_zero ++;
+ else
+ num_zero = 0;
+ }
+ if(num_zero != 0) {
+ ILOG("Ignoring %d bytes of Zeros at end of file\n",num_zero);
+ mf.len -= num_zero;
+ }
err = stlink_write_flash(sl, addr, mf.base, mf.len);
unmap_file(&mf);
return err;