/*----------------------------------------------------------------------------*/
/* Copyright (c) FIRST 2008. All Rights Reserved.							  */
/* Open Source Software - may be modified and shared by FRC teams. The code   */
/* must be accompanied by the FIRST BSD license file in $(WIND_BASE)/WPILib.  */
/*----------------------------------------------------------------------------*/

#include "Error.h"

#include <iostream>
#include <sstream>
#include <cstring>
#include <cstdlib>
#include <stdint.h>
#include "HAL/Task.hpp"

#include "DriverStation.h"
#include "Timer.h"
#include "Utility.h"
bool Error::m_suspendOnErrorEnabled = false;

Error::Error()
	: m_code(0)
	, m_lineNumber(0)
	, m_originatingObject(NULL)
	, m_timestamp (0.0)
{}

Error::~Error()
{}

void Error::Clone(Error &error)
{
	m_code = error.m_code;
	m_message = error.m_message;
	m_filename = error.m_filename;
	m_function = error.m_function;
	m_lineNumber = error.m_lineNumber;
	m_originatingObject = error.m_originatingObject;
	m_timestamp = error.m_timestamp;
}

Error::Code Error::GetCode() const
{	return m_code;  }

const char * Error::GetMessage() const
{	return m_message.c_str();  }

const char * Error::GetFilename() const
{	return m_filename.c_str();  }

const char * Error::GetFunction() const
{	return m_function.c_str();  }

uint32_t Error::GetLineNumber() const
{	return m_lineNumber;  }

const ErrorBase* Error::GetOriginatingObject() const
{	return m_originatingObject;  }

double Error::GetTimestamp() const
{	return m_timestamp;  }

void Error::Set(Code code, const char* contextMessage, const char* filename, const char* function, uint32_t lineNumber, const ErrorBase* originatingObject)
{
	bool report = true;

	if(code == m_code && GetTime() - m_timestamp < 1)
	{
		report = false;
	}

	m_code = code;
	m_message = contextMessage;
	m_filename = filename;
	m_function = function;
	m_lineNumber = lineNumber;
	m_originatingObject = originatingObject;

	if(report)
	{
		m_timestamp = GetTime();
		Report();
	}

    if (m_suspendOnErrorEnabled) suspendTask(0);
}

void Error::Report()
{
	std::stringstream errorStream;

	errorStream << "Error on line " << m_lineNumber << " ";
	errorStream << "of "<< basename(m_filename.c_str()) << ": ";
	errorStream << m_message << std::endl;
	errorStream << GetStackTrace(4);

	std::string error = errorStream.str();

	DriverStation::ReportError(error);
}

void Error::Clear()
{
	m_code = 0;
	m_message = "";
	m_filename = "";
	m_function = "";
	m_lineNumber = 0;
	m_originatingObject = NULL;
	m_timestamp = 0.0;
}