ihex.c

#include <unistd.h>
#include <strings.h>
#include <stdio.h>
#include <string.h>

#include <inttypes.h>

int hexfile_parse(char *line, unsigned int *type, unsigned int *addr, unsigned char *buffer)
{
        unsigned int row_len = 0;
        unsigned int row_index = 7;
        unsigned int i;
        int tmp;
        
        uint8_t cksum = 0;
        int retval = 0;
        
        retval = sscanf(line, ":%2x%4x%2x", &row_len, addr, type);
        
        cksum += row_len;
        cksum += *addr >> 8;
        cksum += *addr & 0xFF;
        cksum += *type;
        
        i = 0;
        if (retval == 3)
        {
                while(i < row_len)
                {
                        
                        if (sscanf(&line[row_index], "%2x", &tmp) == 1)
                        {
                                cksum += tmp;
                                buffer[i++] = (unsigned char) tmp;
                                row_index += 2;
                        }
                        else return -1;
                }
                if (sscanf(&line[row_index], "%2x", &tmp) == 1)
                {
                        if ((cksum + (uint8_t) tmp) == 0) return row_len;
                }
        }
        return -1;
}

int hexfile_out(char *line, unsigned int type, unsigned int address, unsigned char *data, unsigned int bytes)
{
        uint8_t cksum = 0;
        uint8_t i = 0;
        char tmp[8];
        
        sprintf(line, ":%2.2X%4.4X%2.2X", bytes, address, type);        
        cksum -= bytes;
        cksum -= address >> 8;
        cksum -= address & 0xFF;
        cksum -= type;

        for (i=0; i<bytes; i++)
        {
                sprintf(tmp, "%2.2X", data[i]);
                strcat(line, tmp);
                cksum -= data[i];
        }
        sprintf(tmp, "%2.2X\r\n", cksum);
        strcat(line, tmp);
        
        return strlen(line);
}