forked from vdudouyt/stm8flash
-
Notifications
You must be signed in to change notification settings - Fork 0
/
ihex.c
86 lines (78 loc) · 2.46 KB
/
ihex.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
/* stlink/v2 stm8 memory programming utility
(c) Valentin Dudouyt, 2012 - 2014 */
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "ihex.h"
#include "error.h"
#include "byte_utils.h"
char line[256];
static unsigned char checksum(unsigned char *buf, unsigned int length, int chunk_len, int chunk_addr, int chunk_type) {
int sum = chunk_len + (LO(chunk_addr)) + (HI(chunk_addr)) + chunk_type;
int i;
for(i = 0; i < length; i++) {
sum += buf[i];
}
int complement = (~sum + 1);
return complement & 0xff;
}
int ihex_read(FILE *pFile, unsigned char *buf, unsigned int start, unsigned int end) {
fseek(pFile, 0, SEEK_SET);
unsigned int chunk_len, chunk_addr, chunk_type, i, byte, line_no = 0, greatest_addr = 0;
while(fgets(line, sizeof(line), pFile)) {
line_no++;
// Reading chunk header
if(sscanf(line, ":%02x%04x%02x", &chunk_len, &chunk_addr, &chunk_type) != 3) {
free(buf);
ERROR2("Error while parsing IHEX at line %d\n", line_no);
}
// Reading chunk data
for(i = 9; i < strlen(line) - 1; i +=2) {
if(sscanf(&(line[i]), "%02x", &byte) != 1) {
free(buf);
ERROR2("Error while parsing IHEX at line %d byte %d\n", line_no, i);
}
if(chunk_type != 0x00) {
// The only data records have to be processed
continue;
}
if((i - 9) / 2 >= chunk_len) {
// Respect chunk_len and do not capture checksum as data
break;
}
if(chunk_addr < start) {
free(buf);
ERROR2("Address %04x is out of range at line %d\n", chunk_addr, line_no);
}
if(chunk_addr + chunk_len > end) {
free(buf);
ERROR2("Address %04x + %d is out of range at line %d\n", chunk_addr, chunk_len, line_no);
}
if(chunk_addr + chunk_len > greatest_addr) {
greatest_addr = chunk_addr + chunk_len;
}
buf[chunk_addr - start + (i - 9) / 2] = byte;
}
}
return(greatest_addr - start);
}
void ihex_write(FILE *pFile, unsigned char *buf, unsigned int start, unsigned int end) {
unsigned int chunk_len, chunk_start, chunk_type, i, byte, line_no = 0, greatest_addr = 0;
chunk_start = start;
while(chunk_start < end)
{
chunk_len = end - chunk_start;
if (chunk_len > 32)
{
chunk_len = 32;
}
fprintf(pFile, ":%02X%04X00",chunk_len,chunk_start);
for(i = chunk_start - start; i < (chunk_start + chunk_len - start); i++)
{
fprintf(pFile, "%02X",buf[i]);
}
fprintf(pFile, "%02X\n", checksum( &buf[chunk_start - start], chunk_len, chunk_len, chunk_start, 0));
chunk_start += chunk_len;
}
fprintf(pFile,":00000001FF\n");
}