--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/navienginebsp/ne1_tb/specific/monitor.cpp	Tue Sep 28 18:00:05 2010 +0100
@@ -0,0 +1,125 @@
+/*
+* 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
+	}
+