From e515f1a40bab340cb46f3be56b42b42e7d9c6910 Mon Sep 17 00:00:00 2001
From: notaz <notasas@gmail.com>
Date: Sun, 11 Nov 2012 21:00:45 +0200
Subject: [PATCH] basic text drawing function from PCSX

---
 fonts.c | 56 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 fonts.h |  2 ++
 2 files changed, 58 insertions(+)

diff --git a/fonts.c b/fonts.c
index ea65481..cbad3c6 100644
--- a/fonts.c
+++ b/fonts.c
@@ -1,3 +1,6 @@
+#include <stdio.h>
+#include <stdarg.h>
+
 unsigned char fontdata8x8[64*16] =
 {
 	0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
@@ -216,3 +219,56 @@ unsigned char fontdata6x8[256][8] = {
 { 0x00>>2, 0x10>>2, 0x10>>2, 0x28>>2, 0x28>>2, 0x44>>2, 0x7c>>2, 0x00>>2, },
 };
 
+/* note: may use 1 extra pixel on the right */
+void basic_text_out16_nf(void *fb, int w, int x, int y, const char *text)
+{
+	int i, l;
+	unsigned short *screen;
+	unsigned short val = 0xffff;
+
+	screen = (unsigned short *)fb + x + y * w;
+	for (i = 0; ; i++, screen += 8)
+	{
+		char c = text[i];
+		if (c == 0)
+			break;
+		if (c == ' ')
+			continue;
+
+		for (l = 0; l < 8; l++)
+		{
+			unsigned char fd = fontdata8x8[c * 8 + l];
+			unsigned short *s = screen + l * w;
+			unsigned char fd1, fdp = 0;
+
+			if (fd&0x80) s[0] = val;
+			if (fd&0x40) s[1] = val;
+			if (fd&0x20) s[2] = val;
+			if (fd&0x10) s[3] = val;
+			if (fd&0x08) s[4] = val;
+			if (fd&0x04) s[5] = val;
+			if (fd&0x02) s[6] = val;
+			if (fd&0x01) s[7] = val;
+
+			// draw "shadow"
+			if (l > 0)
+				fdp = fontdata8x8[c * 8 + l - 1];
+
+			for (fd1 = 0x80; fd1 != 0; fd1 >>= 1, s++)
+				if (!(fd & (fd1 >> 1)) && ((fdp | fd) & fd1))
+					s[1] = (s[1] >> 1) & 0x7bef;
+		}
+	}
+}
+
+void basic_text_out16(void *fb, int w, int x, int y, const char *texto, ...)
+{
+	va_list args;
+	char    buffer[256];
+
+	va_start(args, texto);
+	vsnprintf(buffer, sizeof(buffer), texto, args);
+	va_end(args);
+
+	basic_text_out16_nf(fb, w, x, y, buffer);
+}
diff --git a/fonts.h b/fonts.h
index dbbdd4c..b66993c 100644
--- a/fonts.h
+++ b/fonts.h
@@ -2,3 +2,5 @@
 extern unsigned char fontdata8x8[64*16];
 extern unsigned char fontdata6x8[256-32][8];
 
+void basic_text_out16_nf(void *fb, int w, int x, int y, const char *text);
+void basic_text_out16(void *fb, int w, int x, int y, const char *texto, ...);
-- 
2.39.5