Some progress for PSF2

1 files changed, 27 insertions, 17 deletions

diff --git a/src/features/psf.c b/src/features/psf.c
index 7b6a90a..ef63161 100644
--- a/src/features/psf.c
+++ b/src/features/psf.c
@@ -23,34 +23,33 @@ int psf_verify(char *data)
 }
 
 // Will be removed in the future
-void psf_test(char *chars)
+void psf_test(char *chars, int height, int width, int char_size)
 {
 	char ch = 'a';
 	int x = 50;
 	int y = 400;
 	const u32 c[3] = { 0xff, 0x00, 0x00 };
 
-	int font_height = 16;
-	int font_width = 8;
+	printf("%d %d %d\n", height, width, char_size);
 
 	int pos = x * vbe_bpl + y * vbe_pitch;
 	char *draw = (char *)&fb[pos];
 	u16 row = 0;
 
-	for (int cy = 0; cy <= font_height; cy++) {
-		row = chars[ch * font_height + cy];
+	for (int cy = 0; cy <= height; cy++) {
+		row = chars[ch * char_size + cy * ((width + 7) / 8)];
 
-		for (int cx = 0; cx <= font_width + 1; cx++) {
-			if (row & 0x80) {
+		for (int cx = 0; cx <= width + 1; cx++) {
+			if (row & (1 << (width - 1))) {
 				draw[vbe_bpl * cx] = (char)c[2];
 				draw[vbe_bpl * cx + 1] = (char)c[1];
 				draw[vbe_bpl * cx + 2] = (char)c[0];
-				/* } else { */
-				/* 	draw[vbe_bpl * cx] = (char)c[2]; */
-				/* 	draw[vbe_bpl * cx + 1] = (char)terminal_background[1]; */
-				/* 	draw[vbe_bpl * cx + 2] = (char)terminal_background[0]; */
-				/* } */
 			}
+			/* } else { */
+			/* 	draw[vbe_bpl * cx] = (char)c[2]; */
+			/* 	draw[vbe_bpl * cx + 1] = (char)terminal_background[1]; */
+			/* 	draw[vbe_bpl * cx + 2] = (char)terminal_background[0]; */
+			/* } */
 			row <<= 1;
 		}
 		draw += vbe_pitch;
@@ -62,14 +61,25 @@ char *psf_parse(char *data)
 	int version = psf_verify(data);
 
 	char *chars;
-	if (version == 1)
+	int height;
+	int width;
+	int char_size;
+
+	if (version == 1) {
 		chars = data + sizeof(struct psf1_header);
-	else if (version == 2)
-		chars = data + sizeof(struct psf2_header);
-	else
+		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 {
 		return 0;
+	}
 
-	psf_test(chars);
+	psf_test(chars, height, width, char_size);
 
 	return chars;
 }