Subversion Repositories tv80

/*

 * load_ihex.cpp

 *

 *  Created on: Feb 15, 2011

 *      Author: hutch

 */

#include "load_ihex.h"

#include <stdio.h>

#include <string.h>

#include <assert.h>

int inline readline(FILE *fh, char *buf)

{

  int c = 1, cnt = 0;

  if (feof(fh)) {

    *buf = (char) 0;

    return 0;

  }

  while (c) {

    c = fread (buf, 1, 1, fh);

    cnt++;

    if (c && (*buf == '\n')) {

      buf++;

      *buf = (char) 0;

      c = 0;

    }

    else buf++;

  }

  return cnt;

}

int load_ihex(char *filename, uint8_t *buffer, int max)

{

  FILE *fh;

  char line[80];

  char *lp;

  int rlen, addr, rtyp, databyte;

  int rv;

  int dcount = 0;

  int highest = 0;

  fh = fopen (filename, "r");

  rv = readline (fh, line);

    while (strlen(line) > 0) {

      sscanf (line, ":%02x%04x%02x", &rlen, &addr, &rtyp);

      lp = line + 9;

      for (int c=0; c<rlen; c++) {

        sscanf (lp, "%02x", &databyte);

        lp += 2;

        buffer[addr+c] = databyte; dcount++;

        assert (dcount < max);

        if ((addr+c) > highest) highest = addr+c;

      }

      rv = readline (fh, line);

    }

  fclose (fh);

  printf ("ENVMEM  : Read %d bytes from %s\n", dcount, filename);

  return (highest);

}