hex2hcd/hex2hcd.c

/*
 * Copyright (C) 2012 Canonical
 *
 * 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 Street, Fifth Floor, Boston, MA 02110-1301, USA.
 *
 */

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <errno.h>

#define RBUF_SIZE 640

static unsigned int asc_to_int(char a)
{
    return a >= 'A' ? (a - 'A') + 10 : a - '0';
}

static unsigned int hex_to_int(const char *h)
{
    return asc_to_int(*h) * 0x10 + asc_to_int(*(h + 1));
}

static unsigned int lhex_to_int(const char *h)
{
    return hex_to_int(h) * 0x100 + hex_to_int(h + 2);
}

static int check_sum(const char *str, int len)
{
    unsigned int sum, cal;
    int i;
    sum = hex_to_int(str + len - 2);
    for (cal = 0, i = 1; i < len - 2; i += 2)
        cal += hex_to_int(str + i);
    cal = 0x100 - cal & 0xFF;
    return sum == cal;
}

static int check_hex_line(const char *str, int len)
{
    if ((str[0] != ':') || (len < 11) || !check_sum(str, len) ||
        (hex_to_int(str + 1) * 2 + 11 != len))
        return 0;
    return 1;
}

static FILE *open_file(const char *fileName, const char *mode) 
{
    FILE *file = fopen(fileName, mode);
    if (!file) {
        printf("The file '%s' could not be opened with the following reason\n", fileName);
        puts(strerror(errno));
        exit(-EIO);
    }
    return file;
}

int main(int argc, char *argv[])
{
    unsigned int addr = 0;
    char *ifn, *ofn;
    FILE *ifp, *ofp;
    char *rbuf;
    ssize_t len, i;
    size_t buflen;

    switch (argc) {
        case 2:
            ifn = ofn = argv[1];
            break;
        case 3:
            ifn = argv[1];
            ofn = argv[2];
            break;
        default:
            printf("Usage: %s <input hex file> [<output file>]\n", argv[0]);
            return 0;
    }


    ifp = open_file(ifn, "r");
    ofp = open_file(ofn, "w");
    

    rbuf = NULL;
    while (len = getline(&rbuf, &buflen, ifp)) {
        int type;
        char obuf[7];
        unsigned int dest_addr;

        while ((rbuf[len - 1] == '\r') || (rbuf[len - 1] == '\n')) len--;

        printf("%d, %s\n", (int)len, rbuf);

        if (!check_hex_line(rbuf, len)) break;

        type = hex_to_int(rbuf + 7);

        switch (type) {
            case 4:
                addr = lhex_to_int(rbuf + 9) * 0x10000;
                printf("Bump addr to 0x%08X\n", addr);
                break;
            case 0:
                dest_addr = addr + lhex_to_int(rbuf + 3);
                obuf[0] = 0x4c;
                obuf[1] = 0xfc;
                obuf[2] = hex_to_int(rbuf + 1) + 4;
                obuf[3] = dest_addr;
                obuf[4] = dest_addr >> 8;
                obuf[5] = dest_addr >> 16;
                obuf[6] = dest_addr >> 24;

                if (fwrite(obuf, 7, 1, ofp) != 1) goto output_err;

                for (i = 0; i < hex_to_int(rbuf + 1); i++) {
                    obuf[0] = hex_to_int(rbuf + 9 + i * 2);
                    if (fwrite(obuf, 1, 1, ofp) != 1) goto output_err;
                }
                break;
            case 1:
                if (fwrite("\x4e\xfc\x04\xff\xff\xff\xff", 7, 1, ofp) != 1) goto output_err;
                goto end;
            default:
                return -EINVAL;
        }
    }

    puts("Hex file formatting error");
    return -EINVAL;

    output_err:
        puts("Error on writing output file");
        return -EIO;

    end: 
        return 0;
}