/*****************************************************************************
 *
 * Copyright (C) 2012 Advanced Micro Devices, Inc.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in the
 *       documentation and/or other materials provided with the distribution.
 *     * Neither the name of Advanced Micro Devices, Inc. nor the names of
 *       its contributors may be used to endorse or promote products derived
 *       from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED. IN NO EVENT SHALL ADVANCED MICRO DEVICES, INC. BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *
 ***************************************************************************/


#include "Platform.h"

#define	COM_BASE_ADDRESS	0x3f8
#define DIVISOR			115200
#define LF			0x0a
#define CR			0x0d


#ifdef CIM_DEBUG
  #ifndef CIM_DEBUG_LEVEL
  #define CIM_DEBUG_LEVEL       0xf
#endif

void
TraceCode( UINT32 Level, UINT32 Code){

	if (!(Level & CIM_DEBUG_LEVEL)){
		return;
	}
#if CIM_DEBUG & 1
	if	(Code != 0xFF){
		WriteIO(0x80,AccWidthUint8,&Code);
	}
#endif

}


void
TraceDebug( UINT32 Level, CHAR8 *Format, ...){
	CHAR8	temp[16];
	va_list	ArgList;

	if (!(Level & CIM_DEBUG_LEVEL)){
		return;
	}

#if CIM_DEBUG & 2
	ArgList = va_start(ArgList,Format);
	Format= (CHAR8*) FIXUP_PTR(Format);
	while	(1){
		if (*Format == 0) break;
		if (*Format == '%'){
			int Radix = 0;
			if(*(Format+1)=='s'||*(Format+1)=='S'){
				SendStringPort((CHAR8*) FIXUP_PTR(va_arg(ArgList,CHAR8*)));
				Format+=2;
				continue;
			}

			if(*(Format+1)=='d'||*(Format+1)=='D'){
				Radix = 10;
			}
		    if(*(Format+1)=='x'||*(Format+1)=='X'){
				Radix = 16;
			}
			if	(Radix){
				ItoA(va_arg(ArgList,int),Radix,temp);
				SendStringPort(temp);
				Format+=2;
				continue;
			}
		}
		SendBytePort(*Format);
		if(*(Format)==0x0a) SendBytePort(0x0d);
		Format++;
	}
	va_end(ArgList);
#endif
}


void
ItoA( UINT32 Value, int Radix, char* pstr)
{
	char* tsptr = pstr;
	char* rsptr = pstr;
	char  ch1,ch2;
	unsigned int  Reminder;
//Create String
	do{
		Reminder = Value%Radix;
		Value = Value/Radix;
		if (Reminder<0xa) *tsptr=Reminder+'0';
		else *tsptr=Reminder-0xa+'a';
		tsptr++;
	} while(Value);
//Reverse String
	*tsptr = 0;
	tsptr--;
	while(tsptr>rsptr){
		ch1	= *tsptr;
		ch2 = *rsptr;
		*rsptr = ch1;
		*tsptr = ch2;
		tsptr--;
		rsptr++;
	}
}

void
InitSerialOut(){
	UINT8	Data;
	UINT16	Divisor;
	Data = 0x87;
	WriteIO(COM_BASE_ADDRESS + 0x3,AccWidthUint8, &Data);
	Divisor = 115200 / DIVISOR;
	Data = Divisor & 0xFF;
	WriteIO(COM_BASE_ADDRESS + 0x00,AccWidthUint8, &Data);
	Data = Divisor >> 8;
	WriteIO(COM_BASE_ADDRESS + 0x01,AccWidthUint8, &Data);
	Data = 0x07;
	WriteIO(COM_BASE_ADDRESS + 0x3,AccWidthUint8, &Data);
}


void
SendStringPort(char* pstr){

	while (*pstr!=0){
		SendBytePort(*pstr);
		pstr++;
	}
}

void
SendBytePort(UINT8 Data)
{
	int   Count = 80;
	UINT8 Status;
	do {
		ReadIO((COM_BASE_ADDRESS + 0x05),AccWidthUint8, &Status);
		if(Status == 0xff) break;
	// Loop  port is ready
	} while ( (Status & 0x20) == 0 && (--Count) != 0);
	WriteIO(COM_BASE_ADDRESS + 0x00,AccWidthUint8, &Data);
}
#endif