1 files changed, 60 insertions, 0 deletions
diff --git a/libs/libgui/psf.c b/libs/libgui/psf.c
new file mode 100644
index 0000000..e28c2d7
--- /dev/null
+++ b/libs/libgui/psf.c
@@ -0,0 +1,60 @@
+// MIT License, Copyright (c) 2020 Marvin Borner
+// PSF parser
+
+#include <def.h>
+#include <libgui/gfx.h>
+#include <libgui/psf.h>
+#include <mem.h>
+#include <print.h>
+
+// Verifies the PSF magics
+// Returns the PSF version or 0
+static int psf_verify(char *data)
+{
+	struct psf1_header *header1 = (struct psf1_header *)data;
+	struct psf2_header *header2 = (struct psf2_header *)data;
+
+	if (header1->magic[0] == PSF1_MAGIC_0 && header1->magic[1] == PSF1_MAGIC_1)
+		return 1;
+	else if (header2->magic[0] == PSF2_MAGIC_0 && header2->magic[1] == PSF2_MAGIC_1 &&
+		 header2->magic[2] == PSF2_MAGIC_2 && header2->magic[3] == PSF2_MAGIC_3)
+		return 2;
+	else
+		return 0;
+}
+
+struct font *psf_parse(char *data)
+{
+	if (!data)
+		return NULL;
+
+	int version = psf_verify(data);
+
+	char *chars;
+	int height;
+	int width;
+	int char_size;
+
+	if (version == 1) {
+		chars = data + sizeof(struct psf1_header);
+		height = ((struct psf1_header *)data)->char_size;
+		width = 8;
+		char_size = ((struct psf1_header *)data)->char_size;
+	} else if (version == 2) {
+		chars = data + ((struct psf2_header *)data)->size;
+		height = ((struct psf2_header *)data)->height;
+		width = ((struct psf2_header *)data)->width;
+		char_size = ((struct psf2_header *)data)->char_size;
+	} else {
+		print("Unknown font!\n");
+		return NULL;
+	}
+
+	struct font *font = malloc(sizeof(*font));
+	font->chars = chars;
+	font->size.x = width;
+	font->size.y = height;
+	font->char_size = char_size;
+
+	return font;
+}