1
0
mirror of https://github.com/raphnet/gc_n64_usb-v3 synced 2024-10-31 15:45:09 -04:00
gc_n64_usb-v3/tool/ihex.c
2015-10-12 14:40:32 -04:00

144 lines
3.1 KiB
C

#include <stdio.h>
#include <string.h>
#include "hexdump.h"
static unsigned char chk(unsigned char *buf, int len)
{
int i;
unsigned char r = 0;
for (i=0; i<len; i++) {
r += buf[i];
}
return r;
}
/* \return The highest address written to, or negative on errors.
*/
int load_ihex(const char *file, unsigned char *dstbuf, int bufsize)
{
FILE *fptr;
char linebuf[550];
unsigned char databuf[2+1+255+1];
int ret = 0;
int line = 0;
int eof_seen = 0;
unsigned int max_address = 0;
unsigned int offset = 0;
fptr = fopen(file, "r");
if (!fptr) {
perror("fopen");
return -1;
}
do {
if (fgets(linebuf, sizeof(linebuf), fptr)) {
unsigned int data_count;
unsigned int address;
int input_nibbles, input_bytes;
int i;
line++;
if (linebuf[0] != ':') {
fprintf(stderr, "Ignored invalid line %d\n", line);
continue;
}
if (eof_seen) {
fprintf(stderr, "extra data after EOF record in hex file\n");
ret = -7;
goto err;
}
// :10 0000 00 92C064C7ABC0AAC0A9C0A8C0A7C0A6C0 00
// ^ ^ ^ ^ ^-- Checksum
// | | | +----- Data [data_count]
// | | +---- Record type
// | +------ Address
// +----- data_count
//
input_nibbles = strlen(linebuf) - 1;
for (input_bytes=0,i=0; i<input_nibbles; i+=2) {
unsigned int byte;
if (1 != sscanf(linebuf + 1 + i, "%02x", &byte)) {
break;
}
databuf[input_bytes] = byte;
input_bytes++;
}
//printf("Input bytes: %d\n", input_bytes);
//printHexBuf(databuf, input_bytes);
// Validate the record checksum
if (chk(databuf, input_bytes)) {
fprintf(stderr, "Bad checksum at line %d\n", line);
ret = -4;
goto err;
}
// Data length sanity check
data_count = databuf[0];
if (input_bytes != 1+2+1+data_count+1) {
fprintf(stderr, "Invalid record (less data than expected) at line %d\n", line);
ret = -5;
goto err;
}
address = databuf[1]<<8 | databuf[2];
switch(databuf[3])
{
case 0x00: // Data
if (address + offset + data_count > bufsize) {
fprintf(stderr, "hex file too large\n");
ret = -6;
goto err;
}
if (address + offset + data_count > max_address) {
max_address = address + offset + data_count;
}
memcpy(dstbuf + address + offset, databuf + 4, data_count);
break;
case 0x01: // EOF
eof_seen = 1;
break;
case 0x04: // Extended linear address
if (data_count != 2) {
fprintf(stderr, "ihex parser: Malformatted 0x04 record at line %d\n", line);
ret = -8;
goto err;
}
offset = (databuf[4] << 24) | (databuf[5] << 16);
//printf("OFfset: 0x%08x\n", offset);
break;
case 0x03: // Start segment address
case 0x05: // Start linear address
// Ignored
break;
default:
case 0x02: // Extended segment address
fprintf(stderr, "ihex parser: Unimplemented record type 0x%02x at line %d\n", databuf[3], line);
ret = -2;
goto err;
}
}
} while (!feof(fptr));
fclose(fptr);
return max_address;
err:
fclose(fptr);
return ret;
}