|
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
typedef signed char int8_t;
typedef unsigned char uint8_t;
typedef signed short int16_t;
typedef unsigned short uint16_t;
typedef signed int int32_t;
typedef unsigned int uint32_t;
typedef float flt_t;
typedef double lflt_t;
#define _not_hex_(src) ((('0' > src) || ('9' < src)) && (('a' > src) || ('f' < src)) && (('A' > src) || ('F' < src)))
#define _hex_trans_eq_(src,dst) \
{ \
if (_not_hex_(src)) \
{ \
return HEX_ERR; \
} \
if (('0' <= (src)) && ('9' >= (src))) \
{ \
dst = (src) - '0'; \
} \
else if (('a' <= (src)) && ('f' >= (src))) \
{ \
dst = (src) - 'a' + 10; \
} \
else if (('A' <= (src)) && ('F' >= (src))) \
{ \
dst = (src) - 'A' + 10; \
} \
}
#define _hex_trans_or_(src,dst) \
{ \
if (_not_hex_(src)) \
{ \
return HEX_ERR; \
} \
if (('0' <= (src)) && ('9' >= (src))) \
{ \
dst |= (src) - '0'; \
} \
else if (('a' <= (src)) && ('f' >= (src))) \
{ \
dst |= (src) - 'a' + 10; \
} \
else if (('A' <= (src)) && ('F' >= (src))) \
{ \
dst |= (src) - 'A' + 10; \
} \
}
#define _hex_trans_or_shift_(src,dst) \
{ \
dst <<= 4; \
_hex_trans_or_(src,dst); \
}
enum RESULT{HEX_ERR = -1, HEX_DATA_OK = 0, HEX_END_OK = 1, HEX_LBA_OK = 2, HEX_SEG_OK = 3};
int8_t _hex2bin_(const uint8_t* src, uint8_t* dst, uint8_t* data_type, uint8_t* data_len, uint16_t* data_addr)
{
uint8_t check_sum, i;
// 如果源code长度小于11,表明源code有误!
if (11 > strlen((const char*)src))
{
return HEX_ERR;
}
// 校验起始字节是否为':',如果不为':',表明源code有误!
if (':' != *src++)
{
return HEX_ERR;
}
// 得到数据长度的高4位
_hex_trans_eq_(*src, *data_len);
src++;
// 得到数据长度的低4位
_hex_trans_or_shift_(*src, *data_len);
src++;
// 校验和
check_sum = *data_len;
// 得到数据地址
_hex_trans_eq_(*src, *data_addr);
src++;
_hex_trans_or_shift_(*src, *data_addr);
src++;
// 校验和
check_sum += *data_addr;
_hex_trans_or_shift_(*src, *data_addr);
src++;
_hex_trans_or_shift_(*src, *data_addr);
src++;
// 校验和
check_sum += *data_addr;
// 得到数据类型
_hex_trans_eq_(*src, *data_type);
src++;
_hex_trans_or_shift_(*src, *data_type);
src++;
// 校验和
check_sum += *data_type;
switch (*data_type)
{
case 0: // 数据记录
for (i = *data_len; i; i--, dst++)
{
_hex_trans_eq_(*src, *dst);
src++;
_hex_trans_or_shift_(*src, *dst);
src++;
// 校验和
check_sum += *dst;
}
// 校验
_hex_trans_eq_(*src, i);
src++;
_hex_trans_or_shift_(*src, i);
check_sum += i;
return check_sum? HEX_ERR : HEX_DATA_OK;
case 1: // 文件结束记录
if (*data_addr)
{
return HEX_ERR;
}
// 校验
_hex_trans_eq_(*src, i);
src++;
_hex_trans_or_shift_(*src, i);
check_sum += i;
return check_sum? HEX_ERR : HEX_END_OK;
case 2: // 扩展段地址记录
if (*data_addr)
{
return HEX_ERR;
}
// 得到扩展段地址
_hex_trans_eq_(*src, *data_addr);
src++;
_hex_trans_or_shift_(*src, *data_addr);
src++;
// 校验和
check_sum += *data_addr;
_hex_trans_or_shift_(*src, *data_addr);
src++;
_hex_trans_or_shift_(*src, *data_addr);
src++;
// 校验和
check_sum += *data_addr;
return check_sum? HEX_ERR : HEX_SEG_OK;
case 4: // 扩展线性地址记录
if (*data_addr)
{
return HEX_ERR;
}
// 得到扩展段地址
// 得到数据地址
_hex_trans_eq_(*src, *data_addr);
src++;
_hex_trans_or_shift_(*src, *data_addr);
src++;
// 校验和
check_sum += *data_addr;
_hex_trans_or_shift_(*src, *data_addr);
src++;
_hex_trans_or_shift_(*src, *data_addr);
src++;
// 校验和
check_sum += *data_addr;
return check_sum? HEX_ERR : HEX_LBA_OK;
default:
return HEX_ERR;
}
return HEX_ERR;
}
int8_t hex2bin(const int8_t* src_file_path, const int8_t* dst_file_path)
{
uint8_t buffer_hex[1024], buffer_bin[256];
uint8_t data_type, len_bin;
uint16_t addr_low;
uint32_t addr_high = 0;
FILE* src_file;
FILE* dst_file;
src_file = fopen((const char*)src_file_path, "r");
if (!src_file)
{
return -1;
}
dst_file = fopen((const char*)dst_file_path, "wb");
if (!dst_file)
{
fclose(src_file);
return -1;
}
for ( ; !feof(src_file); )
{
if (NULL == fgets((char*)buffer_hex, 1024, src_file))
{
break;
}
if (HEX_ERR == _hex2bin_((const uint8_t*)buffer_hex, (uint8_t*)buffer_bin, &data_type, &len_bin, &addr_low))
{
break;
}
switch (data_type)
{
case 0: // 数据记录
if (ftell(dst_file) != addr_low + addr_high)
{
fseek(dst_file, addr_low + addr_high, SEEK_SET);
}
if (1 != fwrite((const uint8_t*)buffer_bin, len_bin, 1, dst_file))
{
fclose(src_file);
fclose(dst_file);
return -1;
}
break;
case 1: // 文件结束记录
fclose(src_file);
fclose(dst_file);
return 0;
case 2: // 扩展段地址记录
addr_high = ((uint32_t)addr_low) << 2;
break;
case 4: // 扩展线性地址记录
addr_high = ((uint32_t)addr_low) << 16;
break;
default:
fclose(src_file);
fclose(dst_file);
return -1;
}
}
fclose(src_file);
fclose(dst_file);
return 0;
}
int main(void)
{
if (!hex2bin((const int8_t*)"avr-test.hex",(const int8_t*)"avr-test.bin"))
printf("ok!\n");
return 0;
}
|
|