/*
* Copyright (c) 2008-2009 Nokia Corporation and/or its subsidiary(-ies).
* All rights reserved.
* This component and the accompanying materials are made available
* under the terms of "Eclipse Public License v1.0"
* which accompanies this distribution, and is available
* at the URL "http://www.eclipse.org/legal/epl-v10.html".
*
* Initial Contributors:
* Nokia Corporation - initial contribution.
*
* Contributors:
*
* Description:  
* ne1_tb\specific\monitor.cpp
* Kernel crash debugger - NE1_TBVariant specific
*
*/



#include <kernel/monitor.h>
#include "variant.h"
#include "uart/uart16550_ne.h"

// A copy of TNaviEngine::DoDebugOutput
static TUint DebugPortAddr()
	{
	TUint debugPort;
	switch (Kern::SuperPage().iDebugPort)
		{
		case Arm::EDebugPortJTAG:	debugPort = 0; break; //indicates JTAG debugging
		case 0x101:
		case 1:						debugPort=KHwBaseUart1;	break;
		case 2:						debugPort=KHwBaseUart2;	break;
		default:					debugPort=KHwBaseUart0;	break;
		}
	return debugPort;
	}


//
// UART code
//
void CrashDebugger::InitUart()
	{
	// Initialise the UART for standard debug output
	TUint32 baseAddr = DebugPortAddr();
	if (baseAddr) // baseAddr is NULL in case of jtag logging
		{
		TUint32 dp = Kern::SuperPage().iDebugPort;
		TBool highSpeed = (dp==0x100 || dp==0x101);

		// Baud Rate = 115200; 8 bits, no parity, 1 stop bit
		*((volatile TInt*) (baseAddr+K16550LCROffset))  = 0x83;
		*((volatile TInt*) (baseAddr+K16550BDLoOffset)) = highSpeed ? KBaudRateDiv_230400 : KBaudRateDiv_default;
		*((volatile TInt*) (baseAddr+K16550BDHiOffset)) = 0;
		*((volatile TInt*) (baseAddr+K16550LCROffset))  = 3;

		// Set the FIFO control register (FCR) to polled mode & don't use interrupts
		*((volatile TInt*) (baseAddr+K16550FCROffset)) = 0;
		*((volatile TInt*) (baseAddr+K16550FCROffset)) = 1;
		*((volatile TInt*) (baseAddr+K16550IEROffset)) = 0;
		}
	}

void CrashDebugger::UartOut(TUint aChar)
	{
	TUint debugPort = DebugPortAddr();
	volatile TUint32& LSR = *(volatile TUint32*)(debugPort + 0x14);
	volatile TUint32& TXHR = *(volatile TUint32*)(debugPort + 0x00);
	volatile TUint32& RXHR = *(volatile TUint32*)(debugPort + 0x00);
	while (LSR & 1)
		{ 
		if (CheckPower())
			return;
		TUint32 c = RXHR;
		if (c==19)            // XOFF
			{
			FOREVER
				{
				// wait for XON
				while (!(LSR & 1))
					{
					if (CheckPower())
						return;
					}
				c = RXHR;
				if (c==17)    // XON
					break;
				else if (c==3)		// Ctrl C
					Leave(KErrCancel);
				}
			}
		else if (c==3)		// Ctrl C
			Leave(KErrCancel);
		}
	while (!(LSR & 32))
		CheckPower();
	TXHR = aChar;
	}

TUint8 CrashDebugger::UartIn()
	{
	TUint debugPort = DebugPortAddr();
	volatile TUint32& LSR = *(volatile TUint32*)(debugPort + 0x14);
	volatile TUint32& RXHR = *(volatile TUint32*)(debugPort + 0x00);
	while (!(LSR & 1))
		{
		if (CheckPower())
			return (TUint8)0x0d;
		}
	return (TUint8)RXHR;
	}

TBool CrashDebugger::CheckPower()
	{
	//
	// TO DO: (mandatory)
	//
	// Check if power supply is stable and return ETrue if not
	//
	return EFalse;	// EXAMPLE ONLY
	}