Merge remote-tracking branch 'Kernel/master'

Kernel/library/dumper.cpp

@@ -0,0 +1,88 @@
+/*
+	This file is part of Fennix Kernel.
+
+	Fennix Kernel is free software: you can redistribute it and/or
+	modify it under the terms of the GNU General Public License as
+	published by the Free Software Foundation, either version 3 of
+	the License, or (at your option) any later version.
+
+	Fennix Kernel is distributed in the hope that it will be useful,
+	but WITHOUT ANY WARRANTY; without even the implied warranty of
+	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+	GNU General Public License for more details.
+
+	You should have received a copy of the GNU General Public License
+	along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
+*/
+
+#include "dumper.hpp"
+
+#include <memory.hpp>
+#include <printf.h>
+#include <uart.hpp>
+#include <lock.hpp>
+#include <md5.h>
+
+NewLock(DumperLock);
+
+using namespace UniversalAsynchronousReceiverTransmitter;
+
+int vprintf_dumper(const char *format, va_list list) { return vfctprintf(uart_wrapper, NULL, format, list); }
+
+void WriteRaw(const char *format, ...)
+{
+	va_list args;
+	va_start(args, format);
+	vprintf_dumper(format, args);
+	va_end(args);
+}
+
+void DumpData(const char *Description, void *Address, unsigned long Length)
+{
+	if (Length == 0)
+		return;
+
+	SmartLock(DumperLock);
+	WriteRaw("-------------------------------------------------------------------------\n");
+	unsigned char *AddressChar = (unsigned char *)Address;
+	unsigned char Buffer[17];
+	unsigned long Iterate;
+
+	if (Description != nullptr)
+		WriteRaw("%s (%d bytes):\n", Description, Length);
+
+	for (Iterate = 0; Iterate < Length; Iterate++)
+	{
+		if ((Iterate % 16) == 0)
+		{
+			if (Iterate != 0)
+				WriteRaw("  %s\n", Buffer);
+			WriteRaw("  %04x ", Iterate);
+		}
+
+		WriteRaw(" %02x", AddressChar[Iterate]);
+
+		if ((AddressChar[Iterate] < 0x20) || (AddressChar[Iterate] > 0x7e))
+			Buffer[Iterate % 16] = '.';
+		else
+			Buffer[Iterate % 16] = AddressChar[Iterate];
+
+		Buffer[(Iterate % 16) + 1] = '\0';
+	}
+
+	while ((Iterate % 16) != 0)
+	{
+		WriteRaw("   ");
+		Iterate++;
+	}
+
+	WriteRaw("  %s\n", Buffer);
+	WriteRaw("-------------------------------------------------------------------------\n");
+	WriteRaw("Length: %ld bytes\n", Length);
+	uint8_t *result = md5File(AddressChar, Length);
+	WriteRaw("MD5: ");
+	for (int i = 0; i < 16; i++)
+		WriteRaw("%02x", result[i]);
+	kfree(result);
+	WriteRaw("\n-------------------------------------------------------------------------\n");
+}