srec.cpp

#include "srec.h"
#include "memio.h"

#include <stdio.h>

static char lineBuffer[255];


static int writeMem8( uint32_t address, uint32_t data )
{
   uint8_t mask;

   data = data & 0xff;


   switch( address & 3 )
   {
      case 0:

         mask = 0b0001;

         break;

      case 1:

         mask = 0b0010;
         data <<= 8;

         break;

      case 2:

         mask = 0b0100;
         data <<= 16;

         break;

      case 3:

         mask = 0b1000;
         data <<= 24;

         break;
   }

   storeData( address & 0xfffffffc, mask, data );

   return 0;
}

static int hexToIDigit( char *buf, int position )
{
   char c;
   
   c = buf[ position ];
   
   if ( ( c >= '0' ) and ( c <='9' ) )
   {
      return c - '0';
   }else if ( ( c >='a' ) and ( c <='f' ) )
   {
      return c - 'a' + 10;
   }else if ( ( c >='A' ) and ( c <='F' ) )
   {
      return c - 'A' + 10;
   }
   else
   {
      return -1;
   }
}

static int hexToIByte( char *buf, int position )
{
   int d1, d2;
   
   d1 = hexToIDigit( buf, position++ );
   if( d1 == -1 ) return -1;
   
   
   d2 = hexToIDigit( buf, position );
   if( d2 == -1 ) return -1;
   
   return ( d1 << 4 ) | d2;
}

static uint32_t decodeAndDisplayS0Record( char *buf )
{
   int idx;
   int recordLength;
   int i,v;
   
   recordLength = hexToIByte( buf, 2 );
   if( recordLength == -1 ) return 1;
   
   for( i = 0; i < recordLength - 3; i++ )
   {
      v = hexToIByte( buf, 8 + i * 2 );

      if( v == -1 ) return 1;
      
      printf( "%c", (char)v );
   
   }

   printf( "\n" );

   return 0;
}

static uint32_t decodeAndSaveS1_2_3Record( char *buf, uint32_t recordType )
{
   int   rv;
   uint32_t i;
   uint32_t dataFieldIdx;
   uint32_t address;
   uint32_t recordLength;
   uint32_t addressFieldLength;

   unsigned char *memPtr;
   
   memPtr = 0;
   
   recordLength = hexToIByte( buf, 2 );
   
   if( recordLength == -1 ) return 1;
   

   switch( recordType )
   {


      case 1:

         addressFieldLength = 2;
         dataFieldIdx       = 8;
         break;

      case 2:

         addressFieldLength = 3;
         dataFieldIdx       = 10;
         break;

      case 3:

         addressFieldLength = 4;
         dataFieldIdx       = 12;
         break;


   }
   address = 0;

   for( i = 0; i < addressFieldLength; i++ )
   {

      rv = hexToIByte( buf, 4 + i * 2 );
      
      if( rv == -1 ) return 1;

      address <<= 8;
      address |= (uint8_t)rv;

   }

   //printf( "%08x\n", address );

   for( i = 0; i < recordLength - addressFieldLength - 1; i++ )
   {
      rv = hexToIByte( buf, dataFieldIdx + i * 2 );
      if( rv == -1 ) return 1;
      
      writeMem8( address + i, rv );
   
   }
   
   return 0;
}


static uint32_t decodeAndExecuteS7_8_9Record( char *buf, uint32_t recordType )
{
   int32_t  rv;
   uint32_t address;
   uint32_t i;
   uint32_t addressFieldLength;


   switch( recordType )
   {
      
      case 7:
         addressFieldLength = 4;
         break;

      case 8:
         addressFieldLength = 3;
         break;

      case 9:
         addressFieldLength = 2;
         break;

      default:
         return 1;
   }

   address = 0;

   for( i = 0; i < addressFieldLength; i++ )
   {
      rv = hexToIByte( buf, 4 + i * 2 );
      if( rv == -1 ) return 1;
   
      address <<= 8;
      address |= (uint8_t)rv;
   
   }
   
   return address;
} 

uint32_t srecLoadFile( char *path, uint32_t *startPc )
{
   FILE *in;

   uint32_t    rv;
   uint32_t    i;

   if( startPc )
   {
      *startPc = 0;
   }

   in = fopen( path, "rb" );

   if( !in )
   {
      printf( "srecLoadFile: Can't open %s\n", path );
      return 1;
   }


   i = 0;

   while( fgets( ( char* )lineBuffer, ( sizeof( lineBuffer ) - 1 ), in ) )
   {

      rv = 0;

      if( lineBuffer[0] == 'S' )
      {
               
         switch( lineBuffer[1] )
         {

            case '0':
               //decodeAndDisplayS0Record( lineBuffer );
               break;

            case '1':
               rv = decodeAndSaveS1_2_3Record( lineBuffer, 1 );
               break;
               
            case '2':
               rv = decodeAndSaveS1_2_3Record( lineBuffer, 2 );
               break;

            case '3':
               rv = decodeAndSaveS1_2_3Record( lineBuffer, 3 );
               break;
               
            case '4':
            case '5':
            case '6':
               rv = 0;
               break;
               
            case '7':

               if( startPc )
               {
                  *startPc = decodeAndExecuteS7_8_9Record( lineBuffer, 7 );               
               }
               
               rv = 0;

               break;
               
            case '8':
            
               if( startPc )
               {
                  *startPc = decodeAndExecuteS7_8_9Record( lineBuffer, 8 );
               }

               rv = 0;

               break;

            case '9':


               if( startPc )
               {
                  *startPc = decodeAndExecuteS7_8_9Record( lineBuffer, 9 );
               }
               rv = 0;

               break;
               
            default:
               
               rv = 2;               
         }
      
      } 

      if( rv )
      {
         break;
      }
   }

   fclose( in );

   return rv;
}