flash.c

AVR反汇编,对ATMEGA8有效

/*
  Program: revava - Atmel Dis-Assembler
  File: Flash.C, Copyright (C) 2001 Daniel J. Winker

  This program is free software; you can redistribute it and/or
  modify it under the terms of the GNU General Public License
  as published by the Free Software Foundation; either version 2
  of the License, or (at your option) any later version.

  This program is distributed in the hope that it will be useful,
  but WITHOUT ANY WARRANTY; without even the implied warranty of
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  GNU General Public License for more details.

  You should have received a copy of the GNU General Public License
  along with this program; if not, write to the Free Software
  Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
*/

#include <string.h>
#include "Error.h"
#include "Flash.h"

#define FALSE 0
#define TRUE  (!FALSE)

TFlash::TFlash(){
	// Clear the Arrays because I don't remember what the rules of
	// C++ are on this.
	memset( (void *)code_space,        0, sizeof( code_space ));
	memset( (void *)code_byte_written, 0, sizeof( code_byte_written ));
}

void TFlash::FlipEndian( void ){
	int           i;
	unsigned char temp;

	for( i = 0; i < FLASH_SIZE; i += 2 ){
		temp = code_space[ i ];
		code_space[ i     ] = code_space[ i + 1 ] ;
		code_space[ i + 1 ] = temp;
	}
}

void TFlash::flashset(
	unsigned short       addr,
	unsigned char        nbytes,
	const unsigned char* data){

	int*           pi;
	unsigned char* pc;

	pi = code_byte_written + addr;
	pc = code_space + addr;

	// Check boundries
	if(( addr + nbytes ) > FLASH_SIZE ){
		char msg[ 80 ];	// FIXME - Magic Number
		sprintf(
			msg,
			"Address: %04X, Offset: %02X exceeds FLASH_SIZE: %04X", 
			addr, nbytes - 1, FLASH_SIZE);
		throw TGenericError( msg ); 
	}
	
	while( nbytes-- ){
		// Increment counter for this byte, then increment the pointer
		// to the byte counter.
		++( *( pi++ ) );

		*pc++ = *data++;
	}
}

unsigned short TFlash::get_flash_word(
	unsigned short addr,
	int*           high_byte_written,
	int*           low_byte_written ){

	// Check boundry
	if(( addr + 1 ) >= FLASH_SIZE ){
		char msg[ 80 ];	// FIXME - Magic Number
		sprintf(
			msg,
			"get_flash_word: Word Address: %04X, exceeds FLASH_SIZE: %04X", 
			addr, FLASH_SIZE);
		throw TGenericError( msg ); 
	}

	*high_byte_written = code_byte_written[ addr ];
	*low_byte_written  = code_byte_written[ addr + 1 ];

	return( ( code_space[ addr ] << 8 ) | code_space[ addr + 1 ] );
}

void TFlash::Dump( void ){
	char code_line[ 60 ];	// FIXME - Magic Number
	char ascii_line[ 20 ];	// FIXME - Magic Number
	char* pcode_line;
	char* pascii_line;
	unsigned char c1;
	unsigned char c2;
	int have_data;

	int i;
	int j;

	for( i = 0; i < FLASH_SIZE; i += 0x10 ){

		pcode_line  = code_line;
		pascii_line = ascii_line;
		have_data   = FALSE;

		for( j = 0; j < 0x8; j += 2 ){

			c1 = code_space[ i + j ];
			c2 = code_space[ i + j + 1 ];

			sprintf( pcode_line, "%02X%02X ", c1, c2 );

			sprintf(
				pascii_line,
				"%c%c",
				c1 >= (unsigned char)' ' && c1 <= (unsigned char)'~' ? c1 : '.',
				c2 >= (unsigned char)' ' && c2 <= (unsigned char)'~' ? c2 : '.' );

			// Cover them up if they weren't really there.
			if( code_byte_written[ i + j ] ){
				have_data = TRUE;
			} else {
				*( pcode_line  + 0 ) = '-';
				*( pcode_line  + 1 ) = '-';
				*( pascii_line + 0 ) = ' ';
			}

			if( code_byte_written[ i + j + 1 ] ){
				have_data = TRUE;
			} else {
				*( pcode_line  + 2 ) = '-';
				*( pcode_line  + 3 ) = '-';
				*( pascii_line + 1 ) = ' ';
			}

			pcode_line  += 5;
			pascii_line += 2;
		}

		*pascii_line++ = ' ';

		while( j < 0x10 ){

			c1 = code_space[ i + j ];
			c2 = code_space[ i + j + 1 ];

			sprintf( pcode_line, " %02X%02X", c1, c2 );

			sprintf(
				pascii_line,
				"%c%c",
				c1 >= (unsigned char)' ' && c1 <= (unsigned char)'~' ? c1 : '.',
				c2 >= (unsigned char)' ' && c2 <= (unsigned char)'~' ? c2 : '.' );

			// Cover them up if they weren't really there.
			if( code_byte_written[ i + j ] ){
				have_data = TRUE;
			} else {
				*( pcode_line  + 1 ) = '-';
				*( pcode_line  + 2 ) = '-';
				*( pascii_line + 0 ) = ' ';
			}

			if( code_byte_written[ i + j + 1 ] ){
				have_data = TRUE;
			} else {
				*( pcode_line  + 3 ) = '-';
				*( pcode_line  + 4 ) = '-';
				*( pascii_line + 1 ) = ' ';
			}

			pcode_line  += 5;
			pascii_line += 2;
			j += 2;
		}

		if( have_data ){
			printf( "%04X: %s  %s\n", i, code_line, ascii_line );
		}
	}
}

void TFlash::DebugDump( void ){
	char code_line[ 60 ];	// FIXME - Magic Number
	char flag_line[ 20 ];	// FIXME - Magic Number
	char ascii_line[ 20 ];	// FIXME - Magic Number
	char* pcode_line;
	char* pflag_line;
	char* pascii_line;
	unsigned char c1;
	unsigned char c2;

	int i;
	int j;

	for( i = 0; i < FLASH_SIZE; i += 0x10 ){

		pcode_line  = code_line;
		pflag_line  = flag_line;
		pascii_line = ascii_line;

		for( j = 0; j < 0x8; j += 2 ){

			c1 = code_space[ i + j ];
			c2 = code_space[ i + j + 1 ];

			sprintf( pcode_line, "%02X%02X ", c1, c2 );

			pcode_line += 5;

			sprintf(
				pflag_line,
				"%1.1d%1.1d",
				code_byte_written[ i + j ],
				code_byte_written[ i + j + 1 ] );

			pflag_line += 2;

			sprintf(
				pascii_line,
				"%c%c",
				c1 >= (unsigned char)' ' && c1 <= (unsigned char)'~' ? c1 : '.',
				c2 >= (unsigned char)' ' && c2 <= (unsigned char)'~' ? c2 : '.' );

			pascii_line += 2;
		}

		*pflag_line++  = ' ';
		*pascii_line++ = ' ';

		while( j < 0x10 ){

			c1 = code_space[ i + j ];
			c2 = code_space[ i + j + 1 ];

			sprintf( pcode_line, " %02X%02X", c1, c2 );

			pcode_line += 5;

			sprintf(
				pflag_line,
				"%1.1d%1.1d",
				code_byte_written[ i + j ],
				code_byte_written[ i + j + 1 ] );

			pflag_line += 2;

			sprintf(
				pascii_line,
				"%c%c",
				c1 >= (unsigned char)' ' && c1 <= (unsigned char)'~' ? c1 : '.',
				c2 >= (unsigned char)' ' && c2 <= (unsigned char)'~' ? c2 : '.' );

			pascii_line += 2;
			j += 2;
		}

		printf( "%04X: %s  %s  %s\n", i, code_line, flag_line, ascii_line );
	}
}