//------------------------------------------------------------------------------// 拳老疙   : arm7tdmi.c// 橇肺璃飄 : jflash-s3c44b0x// 汲  疙   : jflash-s3c44b0x 狼 ARM7TDMI 貿府 風憑撈促. // // 盔歷磊   : 蠟康芒 (林)力撈村叼矩萍 frog@falinux.com// 盔歷磊 	: ATMEL Co, LTD - flash uploader// 盔歷磊 	: (c) R.Longo - tp_003.c// 薦瀝		: 辣傣硅 (林)硅崔瀝焊烹腳 dadpeat@naver.com// 薦瀝老	: 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++);	
	
}