src/util/btoccs/b2i2c.c

   1 /* Create an ascii hex i2c data file */
   2
   3 #include <stdio.h>
   4 #include <malloc.h>
   5
   6 unsigned onesComplementAdd (unsigned value1, unsigned value2)
   7 {
   8   unsigned result;
   9
  10   result = (unsigned)value1 + (unsigned)value2;
  11
  12   result = (result >> 16) + (result & 0xFFFF); /* add in carry   */
  13   result += (result >> 16);                    /* maybe one more */
  14   result = (result & 0xffff);
  15   return (unsigned)result;
  16
  17 } /* end of beth_ones_complement_add() */
  18
  19
  20 int asciiByte (unsigned char c)
  21 {
  22   if ((c >= '0') && (c <= '9'))
  23     return (1);
  24
  25   if ((c >= 'A') && (c <= 'F'))
  26     return (1);
  27
  28   return (0);
  29 }
  30
  31 int toNum (unsigned char c)
  32 {
  33   if ((c >= '0') && (c <= '9'))
  34     return (c - '0');
  35
  36   return (c - 'A' + 10);
  37
  38 }
  39
  40
  41 void  stripLine (FILE *s)
  42 {
  43   char iline[132];
  44
  45   fgets (iline, 131, s);
  46
  47 }
  48
  49 /* Read a .b file. */
  50 int readBFile (FILE *s, unsigned char *data, unsigned maxSize)
  51 {
  52   unsigned char x, y;
  53   int byteCount = 0;
  54
  55   /* Strip the 1st two lines */
  56   stripLine (s);
  57   stripLine (s);
  58
  59   for (;;) {
  60
  61     /* read the 1st ascii char */
  62     do  {
  63       x = fgetc (s);
  64       if (x == (unsigned char)EOF)
  65         return (byteCount);
  66
  67     } while (!asciiByte(x));
  68
  69     /* Read the next ascii char */
  70     y = fgetc (s);
  71     if (y == (unsigned char)EOF)
  72       return (byteCount);
  73     if (asciiByte(y))
  74       data[byteCount++] = (toNum(x) << 4) | toNum (y);
  75
  76     if (byteCount >= maxSize)  {
  77       fprintf (stderr, "Max input array size exceeded\n");
  78       return (-1);
  79     }
  80
  81   }
  82
  83
  84 }
  85
  86
  87 int copyBlock (unsigned char *source, int idx, int maxSize, unsigned char *dest, int count)
  88 {
  89   int i;
  90
  91   for (i = 0; i < count; i++)  {
  92     if (idx >= maxSize)
  93       break;
  94     dest[i] = source[idx++];
  95   }
  96
  97   return (i);
  98
  99 }
 100
 101 void blockCheckSum (unsigned char *block, int blockSize)
 102 {
 103   unsigned checksum = 0;
 104   unsigned value;
 105   int i;
 106
 107   if (blockSize & 0x0001)  {
 108     fprintf (stderr, "program requires an even blocksize\n");
 109     exit (-1);
 110   }
 111
 112   for (i = 0; i < blockSize; i += 2) {
 113     value = (block[i] << 8) | block[i+1];
 114     checksum = onesComplementAdd (checksum, value);
 115   }
 116
 117   /* Put the checksum into the block starting at byte 2. Use big endian */
 118   checksum = ~checksum;
 119   block[3] = checksum & 0xff;
 120   block[2] = (checksum >> 8) & 0xff;
 121
 122 }
 123
 124 #define SIZE    0x10000   /* max array size */
 125
 126 int main (int argc, char *argv[])
 127 {
 128   FILE *strin;
 129   FILE *strout;
 130
 131   unsigned char *dataSet1;
 132   unsigned char *dataSet2;
 133
 134   unsigned char block[128];
 135   unsigned blockSize;
 136
 137   unsigned pIn;
 138   unsigned pOut;
 139
 140   int inSize;
 141   int i;
 142
 143   /* Arg check */
 144   if (argc != 3)  {
 145     fprintf (stderr, "usage: %s infile outfile\n", argv[0]);
 146     return (-1);
 147   }
 148
 149   /* Open the input file */
 150   strin = fopen (argv[1], "r");
 151   if (strin == NULL)  {
 152     fprintf (stderr, "%s: Could not open file %s for reading\n", argv[0], argv[1]);
 153     return (-1);
 154   }
 155
 156   /* Allocate the two data set memories */
 157   dataSet1 = malloc (SIZE * sizeof (unsigned char));
 158   dataSet2 = malloc (SIZE * sizeof (unsigned char));
 159   if ((dataSet1 == NULL) || (dataSet2 == NULL))  {
 160     fprintf (stderr, "%s: Malloc failure\n", argv[0]);
 161     return (-1);
 162   }
 163
 164   /* Read the data into the byte stream */
 165   if ((inSize = readBFile (strin, dataSet1, SIZE)) < 0)
 166     return (inSize);
 167   fclose (strin);
 168
 169   /* Perform the i2c block formatting. The block size will be fixed at 128 bytes,
 170    * 2 bytes of length, 2 bytes checksum, 124 bytes of data. */
 171   pIn = 0;
 172   pOut = 0;
 173
 174   do  {
 175
 176     /* Copy the block, leave 4 bytes at the top */
 177     blockSize = copyBlock (dataSet1, pIn, inSize, &block[4], 124);
 178     pIn += blockSize; /* advance to next data in source */
 179
 180     if (blockSize)  {
 181       blockSize += 4;   /* Add room for the header - big endian */
 182       block[1] = blockSize & 0xff;
 183       block[0] = (blockSize >> 8) & 0xff;
 184       block[2] = block[3] = 0;
 185
 186       /* Checksum the block */
 187       blockCheckSum (block, blockSize);
 188
 189       /* Copy the results to the destination block */
 190       if ((pOut + blockSize) >= SIZE)  {
 191         fprintf (stderr, "%s: destination array size exceeded\n", argv[0]);
 192         return (-1);
 193       }
 194       for (i = 0; i < blockSize; i++)
 195         dataSet2[pOut++] = block[i];
 196     }
 197
 198   } while (blockSize == 128);
 199
 200
 201   /* Copy the resulting data set into the output file in ccs format */
 202   strout = fopen (argv[2], "w");
 203   if (strout == NULL)  {
 204     fprintf (stderr, "%s: Could not open %s for writing\n", argv[0], argv[2]);
 205     return (-1);
 206   }
 207
 208
 209   /* Write the two line header */
 210   fprintf (strout, "%c\n$A000000\n", (unsigned char)2);
 211
 212   /* Write out the data */
 213   for (i = 0; i < pOut; i++)  {
 214     if ( ((i+1)%24) )
 215       fprintf (strout, "%02X ", dataSet2[i]);
 216     else
 217       fprintf (strout, "%02X\n", dataSet2[i]);
 218   }
 219
 220   /* Write the close character */
 221   fprintf (strout, "\n%c", (unsigned char)3);
 222
 223   fclose (strout);
 224
 225   return (0);
 226
 227 }
 228
 229
 230
 231
 232
 233
 234
 235