96 lines
2.2 KiB
C
96 lines
2.2 KiB
C
/* MSPDebug - debugging tool for the eZ430
|
|
* Copyright (C) 2009, 2010 Daniel Beer
|
|
*
|
|
* 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <ctype.h>
|
|
#include "binfile.h"
|
|
|
|
int ihex_check(FILE *in)
|
|
{
|
|
rewind(in);
|
|
return fgetc(in) == ':';
|
|
}
|
|
|
|
static int feed_line(FILE *in, u_int8_t *data, int nbytes, imgfunc_t cb,
|
|
void *user_data)
|
|
{
|
|
u_int8_t cksum = 0;
|
|
int i;
|
|
|
|
if (nbytes < 5 || data[3])
|
|
return 0;
|
|
|
|
/* Verify checksum */
|
|
for (i = 0; i + 1 < nbytes; i++)
|
|
cksum += data[i];
|
|
cksum = ~(cksum - 1) & 0xff;
|
|
|
|
if (data[nbytes - 1] != cksum) {
|
|
fprintf(stderr, "ihex: invalid checksum: %02x "
|
|
"(calculated %02x)\n", data[nbytes - 1], cksum);
|
|
return -1;
|
|
}
|
|
|
|
return cb(user_data,
|
|
((u_int16_t)data[1]) << 8 | ((u_int16_t)data[2]),
|
|
data + 4, nbytes - 5);
|
|
}
|
|
|
|
int ihex_extract(FILE *in, imgfunc_t cb, void *user_data)
|
|
{
|
|
char buf[128];
|
|
int lno = 0;
|
|
|
|
rewind(in);
|
|
while (fgets(buf, sizeof(buf), in)) {
|
|
int len = strlen(buf);
|
|
int i;
|
|
u_int8_t data[64];
|
|
int nbytes;
|
|
|
|
lno++;
|
|
if (buf[0] != ':') {
|
|
fprintf(stderr, "ihex: line %d: invalid start "
|
|
"marker\n", lno);
|
|
continue;
|
|
}
|
|
|
|
/* Trim trailing whitespace */
|
|
while (len && isspace(buf[len - 1]))
|
|
len--;
|
|
buf[len] = 0;
|
|
|
|
/* Decode hex digits */
|
|
nbytes = (len - 1) / 2;
|
|
for (i = 0; i < nbytes; i++) {
|
|
char d[] = {buf[i * 2 + 1], buf[i * 2 + 2], 0};
|
|
|
|
data[i] = strtoul(d, NULL, 16);
|
|
}
|
|
|
|
/* Handle the line */
|
|
if (feed_line(in, data, nbytes, cb, user_data) < 0) {
|
|
fprintf(stderr, "ihex: error on line %d\n", lno);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|