arm7tdmi.c

ADS模拟JTAG口烧写FLASH的工具

//------------------------------------------------------------------------------
// 拳老疙   : arm7tdmi.c
// 橇肺璃飘 : jflash-s3c44b0x
// 汲  疙   : jflash-s3c44b0x 狼 ARM7TDMI 贸府 风凭捞促. 
// 
// 盔历磊   : 蜡康芒 (林)力捞村叼矩萍 [e-mail]
// 盔历磊 	: ATMEL Co, LTD - flash uploader
// 盔历磊 	: (c) R.Longo - tp_003.c
// 荐沥		: 辣傣硅 (林)硅崔沥焊烹脚 [e-mail]
// 荐沥老	: 2003 斥 9岿 7老
// 盔历累鼻 : (林)力捞村叼矩萍 
//            捞 橇肺弊伐 筋胶狼 俺累 棺 犁 硅器甫 倾侩 钦聪促.
//            俺累等 橇肺弊伐狼 惑诀利 捞侩档 倾侩 钦聪促. 
//            俺累等 橇肺弊伐狼 傍俺绰 鞘夸窍促搁 窍瘤 臼酒档 邓聪促. 
// 犁历累鼻 : GPL俊 蝶抚聪促.
// 林  狼   : 
//------------------------------------------------------------------------------
//******************************************************************************
//
// 庆歹 沥狼
//
//******************************************************************************

#include <stdio.h>
#include <stdlib.h>
//#include <asm/io.h>
//#include <unistd.h>
#include <string.h>
//#include <memory.h>


#include	"jtag.h"
#include	"arm7tdmi.h"

//* Define Watchdog
#define WATCHDOG	100

#define	ADD_WAIT_STATE	16

//*----------------------------------------------------------------------------
//* Function Name       : JTAG_Select_Scan_Chain
//* Object              : Select the Scan Chain
//* Input Parameters    : sc
//* Output Parameters   : none
//* Functions called    : JTAG_Shift_ir, JTAG_Shift_dr_4_bits
//*----------------------------------------------------------------------------
void JTAG_Select_Scan_Chain(unsigned int sc)
{

	//* Shift SCAN_N instruction
	JTAG_Shift_ir(SCAN_N, NO_IDLE);

	//* Shift the number of the scan chain
	JTAG_Shift_dr_4_bits(sc);

	//* Shift INTEST instruction
	JTAG_Shift_ir(INTEST, NO_IDLE);

}

//*----------------------------------------------------------------------------
//* Function Name       : JTAG_Read_Debug_Status
//* Object              : Read the Debug Status register of the ICEBreaker 
//* 					  Module
//* Input Parameters    : none
//* Output Parameters   : none
//* Functions called    : JTAG_Select_Scan_Chain, JTAG_Read_ICEBreaker
//*----------------------------------------------------------------------------
unsigned int JTAG_Read_Debug_Status(void)
{
	
	unsigned int value;
	
	//* Select ICEBreaker Scan Chain
	JTAG_Select_Scan_Chain(ICE_BREAKER);
	
	//* Read the Debug Status register
	JTAG_Read_Bkru(ICE_DBG_STS, &value);

	return (value & ICE_DBG_STS_MASK);
}

//*----------------------------------------------------------------------------
//* Function Name       : JTAG_Test_Is_Breaked
//* Object              : Test if the core is in debug mode 
//* Input Parameters    : value max of the watchdog
//* Output Parameters   : none
//* Functions called    : JTAG_Select_Scan_Chain, JTAG_Read_ICEBreaker
//*----------------------------------------------------------------------------
unsigned int JTAG_Test_Is_Breaked(unsigned int value)
{
	unsigned int temp;
	unsigned int watchdog = 0;

	//* Polling of the bits DBGACK and nMREQ 	
	while ((watchdog < value) && ((JTAG_Read_Debug_Status() & READ_DEBUG_STATUS_MASK)
			!= READ_DEBUG_STATUS_MASK))
	{
		watchdog++;
	}
	
	//* Test if the core is breaked
	if (watchdog < value)
	{
		return TRUE;	
	}
	else 
	{
		return FALSE;
	}
}

void JTAG_Write_Memory(unsigned int address, unsigned int value, unsigned int halfword)
{
	
	unsigned int null;

	JTAG_Select_Scan_Chain(DEBUG);

    JTAG_Step(LDMIA_R0_R0_R1, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(address, &null);

	JTAG_Step(value, &null);
	
	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

    JTAG_Step_System_Speed(NOP);

	if(halfword)
	{
		JTAG_Step(WRITE_MEM_HALFWORD, &null);
	}
	else
	{
		JTAG_Step(WRITE_MEM, &null);
	}

	JTAG_Step(NOP, &null);

	JTAG_Shift_ir(RESTART, IDLE);	//* Shift RESTART instruction	

	for(null = 0; null < ADD_WAIT_STATE; null++);	
	
}

void JTAG_Read_Memory(unsigned int address, unsigned int *value, unsigned int halfword)
{

	unsigned int null;

	
	JTAG_Select_Scan_Chain(DEBUG);

    JTAG_Step(WRITE_REG, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(address, &null);
	
	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

    JTAG_Step_System_Speed(NOP);

	if(halfword)
	{
		JTAG_Step(READ_MEM_HALFWORD, &null);
	}
	else
	{
		JTAG_Step(READ_MEM, &null);
	}

	JTAG_Shift_ir(RESTART, IDLE);	//* Shift RESTART instruction	
	
	for(null = 0; null < ADD_WAIT_STATE; null++);	
	
	JTAG_Select_Scan_Chain(DEBUG);

    JTAG_Step(READ_REG|(R1<<12), &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, value);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);
}


//*----------------------------------------------------------------------------
//* Function Name       : JTAG_Stop
//* Object              : Stop the core and put it in debug mode
//* Input Parameters    : none
//* Output Parameters   : none
//* Functions called    : JTAG_Write_ICEBreaker
//*----------------------------------------------------------------------------
unsigned int JTAG_Stop(void)
{
	unsigned int null;

	JTAG_Write_ICEBreaker(ICE_WTP0_ADDR_VAL, 0x00000000);
	JTAG_Write_ICEBreaker(ICE_WTP0_ADDR_MASK, 0xFFFFFFFF);	
	
	// Set a break on all data activity
	JTAG_Write_ICEBreaker(ICE_WTP0_DATA_VAL, 0x00000000);
	JTAG_Write_ICEBreaker(ICE_WTP0_DATA_MASK, 0xFFFFFFFF);

	// Set the Control registers
	JTAG_Write_ICEBreaker(ICE_WTP0_CTRL_VAL, 0x00000100);	// Enable bit
	JTAG_Write_ICEBreaker(ICE_WTP0_CTRL_MASK, 0xFFFFFFF7);  
	
		
	//* Polling of the bits DBGACK and nMREQ 	
	if (JTAG_Test_Is_Breaked(WATCHDOG) == TRUE)
	{
		printf("  The ARM is in debug mode\n");
		printf("  The value in the debug status register is 0x%08X \n", JTAG_Read_Debug_Status());
		
		//* Set the Control registers
		JTAG_Write_ICEBreaker(ICE_WTP0_CTRL_VAL, 0x00000000);	// Enable bit
	}	
	else
	{
		printf("  The core is NOT stopped !!!\n");
		return(FALSE);	
	}

	return(TRUE);

}

//*----------------------------------------------------------------------------
//* Function Name       : JTAG_Write_ICEBreaker
//* Object              : Write a data in the register specified by the address
//* Input Parameters    : address, data
//* Output Parameters   : none
//* Functions called    : JTAG_Select_Scan_Chain, JTAG_Write_Bkru
//*----------------------------------------------------------------------------
void JTAG_Write_ICEBreaker(unsigned int address, unsigned int data)
{

	//* Select ICE Breaker Scan Chain
	JTAG_Select_Scan_Chain(ICE_BREAKER);

	//* Write data in the specified register
	JTAG_Write_Bkru(address, data);

}

//*----------------------------------------------------------------------------
//* Function Name       : JTAG_Read_ICEBreaker
//* Object              : Read a data in the register specified by the address
//* Input Parameters    : address, data
//* Output Parameters   : none
//* Functions called    : JTAG_Select_Scan_Chain, JTAG_Write_Bkru
//*----------------------------------------------------------------------------
void JTAG_Read_ICEBreaker(unsigned int address, unsigned int *data)
{

	//* Select ICE Breaker Scan Chain
	JTAG_Select_Scan_Chain(ICE_BREAKER);

	//* Write data in the specified register
	JTAG_Read_Bkru(address, data);

}

//*----------------------------------------------------------------------------
//* Function Name       : Read_ID_Code
//* Object              : read the ID Code of the core
//* Input Parameters    : none
//* Output Parameters   : TRUE
//* Functions called    : at91_pio_open, at91_pio_write
//*----------------------------------------------------------------------------
unsigned int Read_ID_Code(void)
{

	unsigned int code;
	
   	//* Reset the TAP controller
   	JTAG_Reset();
   	//* Shift IDCode instruction
   	JTAG_Shift_ir(IDCODE, NO_IDLE);
   	//* Get the ID code of the target
   	JTAG_IDCode(&code);
	printf("  The target's ID code is : 0x%08X\n", code);
   	if(code == CORE_IDCODE) return(TRUE);
   	else return(FALSE);
}

//*----------------------------------------------------------------------------
//* Function Name       : Reset
//* Object              : Reset the JTAG
//* Input Parameters    : none
//* Output Parameters   : none
//* Functions called    : JTAG_Reset
//*----------------------------------------------------------------------------
void Reset(void)
{
	
	JTAG_Reset();

	printf("  The value in the debug status register is 0x%08X \n", JTAG_Read_Debug_Status());
   	
}


void JTAG_Go(unsigned int *context)
{
	unsigned int i, null;

	JTAG_Select_Scan_Chain(DEBUG);

    JTAG_Step(0xE89EFFFF, &null);

	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);
	
	for(i = 0; i < 16; i++)	JTAG_Step(context[i], &null);
	
	JTAG_Step(NOP, &null);

	JTAG_Step(NOP, &null);

    JTAG_Step_System_Speed(NOP);

    JTAG_Step(BRANCH_PC, &null);

	JTAG_Shift_ir(RESTART, IDLE);	//* Shift RESTART instruction	

	for(null = 0; null < ADD_WAIT_STATE; null++);	
	
}