Advertisement
ScaV

Fiio Checksum Appender

Nov 27th, 2014
478
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 3.84 KB | None | 0 0
  1. #include <stdio.h>
  2. #include <stdlib.h>
  3. #include <string.h>
  4.  
  5. #define CLUSTER_SIZE        0x200
  6. #define CRC_MAX_BLOCK_SIZE  0x80000
  7.  
  8. #define BYTEn(x, n)         ( *( (_BYTE*) &(x) + n ) )
  9. #define BYTE1(x)            BYTEn(x, 1)
  10. #define _BYTE               unsigned char
  11.  
  12. int AppendCRC( const char *filename );
  13. int GetBlockCRC( int data_size, void *data_array, int prev_crc );
  14.  
  15. int AppendCRC( const char *filename )
  16. {
  17.    FILE *fw_file;
  18.    int filepos_begin;
  19.    int filepos_end;
  20.  
  21.    void *data_array;
  22.    int data_size;
  23.  
  24.    int return_code = 0;
  25.    int crc = 0;
  26.  
  27.    fw_file = fopen( filename, "rb+" );
  28.    if( !fw_file )
  29.    {
  30.       printf( "add crc open file error.\n" );
  31.       return -1;
  32.    }
  33.  
  34.    filepos_begin = 0;
  35.    fseek( fw_file, 0, SEEK_END );
  36.    filepos_end = ftell( fw_file );
  37.  
  38.    fseek( fw_file, 0, SEEK_SET );
  39.    data_array = malloc( CRC_MAX_BLOCK_SIZE );
  40.    if ( data_array )
  41.    {
  42.       while( filepos_begin < filepos_end )
  43.       {
  44.          data_size = filepos_end - filepos_begin < CRC_MAX_BLOCK_SIZE? filepos_end - filepos_begin: CRC_MAX_BLOCK_SIZE;
  45.          if( fread( data_array, data_size, 1, fw_file ) != 1 )
  46.          {
  47.             printf( "add crc, read file error\n" );
  48.             return_code = -3;
  49.             free( data_array );
  50.  
  51.             fclose( fw_file );
  52.             return return_code;
  53.          }
  54.  
  55.          crc = GetBlockCRC( data_size, data_array, crc );
  56.          memset( data_array, 0, CRC_MAX_BLOCK_SIZE );
  57.          filepos_begin += data_size;
  58.       }
  59.  
  60.       printf( "crc=0x%08x\n", crc );
  61.       free( data_array );
  62.    }
  63.  
  64.    fseek( fw_file, 0, SEEK_END );
  65.    if( fwrite( &crc, sizeof( crc ), 1, fw_file ) != 1 )
  66.    {
  67.       printf( "add crc write failed !!!\n" );
  68.       return_code = -4;
  69.    }
  70.  
  71.    fclose( fw_file );
  72.    return return_code;
  73. }
  74.  
  75. int GetBlockCRC( int data_size, void *data_array, int prev_crc )
  76. {
  77.    int values[256] = {
  78.       0, 4129, 8258, 12387, 16516, 20645, 24774, 28903, 33032, 37161, 41290, 45419, 49548, 53677, 57806, 61935, 4657, 528, 12915, 8786, 21173, 17044, 29431, 25302, 37689, 33560, 45947, 41818, 54205, 50076, 62463, 58334, 9314, 13379, 1056, 5121, 25830, 29895, 17572, 21637, 42346, 46411, 34088, 38153, 58862, 62927, 50604, 54669, 13907, 9842, 5649, 1584, 30423, 26358, 22165, 18100, 46939, 42874, 38681, 34616, 63455, 59390, 55197, 51132, 18628, 22757, 26758, 30887, 2112, 6241, 10242, 14371, 51660, 55789, 59790, 63919, 35144, 39273, 43274, 47403, 23285, 19156, 31415, 27286, 6769, 2640, 14899, 10770, 56317, 52188, 64447, 60318, 39801, 35672, 47931, 43802, 27814, 31879, 19684, 23749, 11298, 15363, 3168, 7233, 60846, 64911, 52716, 56781, 44330, 48395, 36200, 40265, 32407, 28342, 24277, 20212, 15891, 11826, 7761, 3696, 65439, 61374, 57309, 53244, 48923, 44858, 40793, 36728, 37256, 33193, 45514, 41451, 53516, 49453, 61774, 57711, 4224, 161, 12482, 8419, 20484, 16421, 28742, 24679, 33721, 37784, 41979, 46042, 49981, 54044, 58239, 62302, 689, 4752, 8947, 13010, 16949, 21012, 25207, 29270, 46570, 42443, 38312, 34185, 62830, 58703, 54572, 50445, 13538, 9411, 5280, 1153, 29798, 25671, 21540, 17413, 42971, 47098, 34713, 38840, 59231, 63358, 50973, 55100, 9939, 14066, 1681, 5808, 26199, 30326, 17941, 22068, 55628, 51565, 63758, 59695, 39368, 35305, 47498, 43435, 22596, 18533, 30726, 26663, 6336, 2273, 14466, 10403, 52093, 56156, 60223, 64286, 35833, 39896, 43963, 48026, 19061, 23124, 27191, 31254, 2801, 6864, 10931, 14994, 64814, 60687, 56684, 52557, 48554, 44427, 40424, 36297, 31782, 27655, 23652, 19525, 15522, 11395, 7392, 3265, 61215, 65342, 53085, 57212, 44955, 49082, 36825, 40952, 28183, 32310, 20053, 24180, 11923, 16050, 3793, 7920
  79.    };
  80.  
  81.    int result = prev_crc;
  82.    for( int i = 0; i < data_size; ++i )
  83.    {
  84.       result = *( values + ( *(_BYTE *) data_array ^ BYTE1(result) ) ) ^ (result << 8);
  85.       data_array = (_BYTE *) data_array + 1;
  86.    }
  87.    return result;
  88. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement