1 files changed, 43 insertions, 11 deletions

diff --git a/src/ppu.c b/src/ppu.c
index ff93ec1..aa99ed8 100644
--- a/src/ppu.c
+++ b/src/ppu.c
@@ -4,6 +4,7 @@
 
 #include <linux/fb.h>
 #include <sys/ioctl.h>
+#include <sys/kd.h>
 #include <sys/mman.h>
 
 #include "ppu.h"
@@ -89,6 +90,46 @@ redraw_screen(void) {
     }
 }
 
+static struct termios prev_t;
+
+void
+set_tty(bool graphics) {
+    // Disable TTY echo and set graphics mode.
+    int tty = open("/dev/tty0", O_RDWR);
+    if (!tty) {
+        fprintf(stderr,"error: couldn't open tty\n");
+        exit(EXIT_FAILURE);
+    }
+
+    if (graphics) {
+        if (ioctl(tty, KDSETMODE, KD_GRAPHICS)) {
+            fprintf(stderr,"error: setting graphics mode failed\n");
+            exit(EXIT_FAILURE);
+        }
+        struct termios t;
+        if (tcgetattr(STDIN_FILENO, &t)) {
+            fprintf(stderr, "error: couldn't disable terminal echo\n");
+            exit(EXIT_FAILURE);
+        }
+        prev_t = t;
+        t.c_lflag &= ~((tcflag_t) ECHO);
+        if (tcsetattr(STDIN_FILENO, TCSANOW, &t)) {
+            fprintf(stderr, "error: couldn't disable terminal echo\n");
+            exit(EXIT_FAILURE);
+        }
+    } else {
+        if (ioctl(tty, KDSETMODE, KD_TEXT)) {
+            fprintf(stderr,"error: setting text mode failed\n");
+            exit(EXIT_FAILURE);
+        }
+        if (tcsetattr(STDIN_FILENO, TCSANOW, &prev_t)) {
+            fprintf(stderr, "error: couldn't restore terminal attributes\n");
+            exit(EXIT_FAILURE);
+        }
+    }
+    close(tty);
+}
+
 int
 ppu_init(void) {
     // Open frambuffer and get the size.
@@ -122,17 +163,8 @@ ppu_init(void) {
         exit(EXIT_FAILURE);
     }
 
-    // Disable echo.
-    struct termios t;
-    if (tcgetattr(STDIN_FILENO, &t)) {
-        fprintf(stderr, "error: couldn't disable terminal echo\n");
-        exit(EXIT_FAILURE);
-    }
-    t.c_lflag &= ~((tcflag_t) ECHO);
-    if (tcsetattr(STDIN_FILENO, TCSANOW, &t)) {
-        fprintf(stderr, "error: couldn't disable terminal echo\n");
-        exit(EXIT_FAILURE);
-    }
+    // Prepare TTY for graphics mode.
+    set_tty(true);
 
     // Initialize default palette.
     palette[0] = 0x444444;