ihex.c

Avr系列单片机反汇编器源代码.GCC编译

/*
 *  ihex.h
 *  Utility functions to create, read, write, and print Intel HEX8 binary records.
 *
 *  Written by Vanya A. Sergeev <[e-mail]>
 *  Version 1.0 - December 2006
 *
 *  Public Domain
 *
 */

#include "ihex.h"

/* Initializes a new IHexRecord structure that the paramater ihexRecord points to with the passed
 * record type, 32-bit integer address, 8-bit data array, and size of 8-bit data array. */
int New_IHexRecord(int type, uint16_t address, uint8_t data[], int dataLen, IHexRecord *ihexRecord) {
	/* Data length size check, assertion of ihexRecord */
	if (dataLen < 0 || dataLen > IHEX_MAX_DATA_LEN/2 || ihexRecord == NULL)
		return IHEX_ERROR_INVALID_ARGUMENTS;
	
	ihexRecord->type = type;
	ihexRecord->address = address;
	memcpy(ihexRecord->data, data, dataLen);
	ihexRecord->dataLen = dataLen;
	ihexRecord->checksum = Checksum_IHexRecord(*ihexRecord);
	
	return IHEX_OK;		
}

/* Utility function to read an Intel Hex record from a file */
int Read_IHexRecord(IHexRecord *ihexRecord, FILE *in) {
	char recordBuff[IHEX_RECORD_BUFF_SIZE];
	/* A temporary buffer to hold ascii hex encoded data, set to the maximum length we would ever need */
	char hexBuff[IHEX_ADDRESS_LEN+1];
	int dataCount, i;
		
	/* Check our file pointer and the IHexRecord struct */
	if (in == NULL || ihexRecord == NULL)
		return IHEX_ERROR_INVALID_ARGUMENTS;
		
	if (fgets(recordBuff, IHEX_RECORD_BUFF_SIZE, in) == NULL) {
			/* In case we hit EOF, don't report a file error */
			if (feof(in) != 0)
				return IHEX_ERROR_EOF;
			else
				return IHEX_ERROR_FILE;
	}
	/* Get rid of that \n */
	recordBuff[strlen(recordBuff)-1] = 0;
	
	/* Size check for start code, count, addess, and type fields */
	if (strlen(recordBuff) < 1+IHEX_COUNT_LEN+IHEX_ADDRESS_LEN+IHEX_TYPE_LEN)
		return IHEX_ERROR_INVALID_RECORD;
		
	/* Check the for colon start code */
	if (recordBuff[IHEX_START_CODE_OFFSET] != IHEX_START_CODE)
		return IHEX_ERROR_INVALID_RECORD;
	
	/* Copy the ascii hex encoding of the count field into hexBuff, convert it to a usable integer */
	strncpy(hexBuff, recordBuff+IHEX_COUNT_OFFSET, IHEX_COUNT_LEN);
	hexBuff[IHEX_COUNT_LEN] = 0;
	dataCount = strtol(hexBuff, (char **)NULL, 16);
	
	/* Copy the ascii hex encoding of the address field into hexBuff, convert it to a usable integer */
	strncpy(hexBuff, recordBuff+IHEX_ADDRESS_OFFSET, IHEX_ADDRESS_LEN);
	hexBuff[IHEX_ADDRESS_LEN] = 0;
	ihexRecord->address = strtol(hexBuff, (char **)NULL, 16);
	
	/* Copy the ascii hex encoding of the address field into hexBuff, convert it to a usable integer */
	strncpy(hexBuff, recordBuff+IHEX_TYPE_OFFSET, IHEX_TYPE_LEN);
	hexBuff[IHEX_TYPE_LEN] = 0;
	ihexRecord->type = strtol(hexBuff, (char **)NULL, 16);
	
	/* Size check for start code, count, address, type, data and checksum fields */
	if (strlen(recordBuff) < 1+IHEX_COUNT_LEN+IHEX_ADDRESS_LEN+IHEX_TYPE_LEN+dataCount*2+IHEX_CHECKSUM_LEN)
		return IHEX_ERROR_INVALID_RECORD;
	
	/* Loop through each ascii hex byte of the data field, pull it out into hexBuff,
	 * convert it and store the result in the data buffer of the Intel Hex record */
	for (i = 0; i < dataCount; i++) {
		/* Times two i because every byte is represented by two ascii hex characters */
		strncpy(hexBuff, recordBuff+IHEX_DATA_OFFSET+2*i, IHEX_ASCII_HEX_BYTE_LEN);
		hexBuff[IHEX_ASCII_HEX_BYTE_LEN] = 0;
		ihexRecord->data[i] = strtol(hexBuff, (char **)NULL, 16);
	}
	ihexRecord->dataLen = dataCount;	
	
	/* Copy the ascii hex encoding of the checksum field into hexBuff, convert it to a usable integer */
	strncpy(hexBuff, recordBuff+IHEX_DATA_OFFSET+dataCount*2, IHEX_CHECKSUM_LEN);
	hexBuff[IHEX_CHECKSUM_LEN] = 0;
	ihexRecord->checksum = strtol(hexBuff, (char **)NULL, 16);

	if (ihexRecord->checksum != Checksum_IHexRecord(*ihexRecord))
		return IHEX_ERROR_INVALID_RECORD;
	
	return IHEX_OK;
}

/* Utility function to write an Intel Hex record from a file */
int Write_IHexRecord(const IHexRecord ihexRecord, FILE *out) {
	int i;
	
	/* Check our file pointer */
	if (out == NULL)
		return IHEX_ERROR_INVALID_ARGUMENTS;
		
	/* Check that the data length is in range */
	if (ihexRecord.dataLen > IHEX_MAX_DATA_LEN/2)
		return IHEX_ERROR_INVALID_RECORD;
	
	/* Write the start code, data count, address, and type fields */
	if (fprintf(out, "%c%2.2X%2.4X%2.2X", IHEX_START_CODE, ihexRecord.dataLen, ihexRecord.address, ihexRecord.type) < 0)
		return IHEX_ERROR_FILE;
		
	/* Write the data bytes */
	for (i = 0; i < ihexRecord.dataLen; i++) {
		if (fprintf(out, "%2.2X", ihexRecord.data[i]) < 0)
			return IHEX_ERROR_FILE;
	}
	
	/* Calculate and write the checksum field */
	if (fprintf(out, "%2.2X\r\n", Checksum_IHexRecord(ihexRecord)) < 0)
		return IHEX_ERROR_FILE;
		
	return IHEX_OK;
}

/* Utility function to print the information stored in an Intel Hex record */
void Print_IHexRecord(const IHexRecord ihexRecord) {
	int i;
	printf("Intel Hex Record Type: %d\n", ihexRecord.type);
	printf("Intel Hex Record Address: 0x%2.4X\n", ihexRecord.address);
	printf("Intel Hex Record Data: {");
	for (i = 0; i < ihexRecord.dataLen; i++) {
		printf("0x%02X, ", ihexRecord.data[i]);
	}
	printf("}\n");
	printf("Intel Hex Record Checksum: 0x%2.2X\n", ihexRecord.checksum);
}

/* Utility function to calculate the checksum of an Intel Hex record */
uint8_t Checksum_IHexRecord(const IHexRecord ihexRecord) {
	uint8_t checksum;
	int i;

	/* Add the data count, type, address, and data bytes together */
	checksum = ihexRecord.dataLen;
	checksum += ihexRecord.type;
	checksum += (uint8_t)ihexRecord.address;
	checksum += (uint8_t)((ihexRecord.address & 0xFF00)>>8);
	for (i = 0; i < ihexRecord.dataLen; i++)
		checksum += ihexRecord.data[i];
	
	/* Two's complement on checksum */
	checksum = ~checksum + 1;

	return checksum;
}