Allowed sharing of common C++ code between RoboRIO and Simulation.

Change-Id: I8bf2bda9df389c13ae0567a62dbf0ca931ceb6f8

wpilibc/wpilibC++/src/Error.cpp

@@ -0,0 +1,104 @@
+/*----------------------------------------------------------------------------*/
+/* 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 <cstdio>
+#include <cstring>
+#include <cstdlib>
+#include <stdint.h>
+#include "HAL/Task.hpp"
+
+//#include "NetworkCommunication/FRCComm.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::GetTime() const
+{	return m_timestamp;  }
+
+void Error::Set(Code code, const char* contextMessage, const char* filename, const char* function, uint32_t lineNumber, const ErrorBase* originatingObject)
+{
+	m_code = code;
+	m_message = contextMessage;
+	m_filename = filename;
+	m_function = function;
+	m_lineNumber = lineNumber;
+	m_originatingObject = originatingObject;
+	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();
+
+	// Print the error and send it to the DriverStation
+	std::cout << error << std::endl;
+    // TODO: Better logging HALSetErrorData(error.c_str(), error.size(), 100);
+}
+
+void Error::Clear()
+{
+	m_code = 0;
+	m_message = "";
+	m_filename = "";
+	m_function = "";
+	m_lineNumber = 0;
+	m_originatingObject = NULL;
+	m_timestamp = 0.0;
+}