Added serial input to text mode

main.c

@@ -26,13 +26,83 @@ void core1_entry() {
 static video_framebuffer_t fb0, fb1;
 static text_mode_buffer_t text_mode_buffer;
 
-static bool framebuffer_switched = true;
+static volatile bool framebuffer_switched = true;
 static bool text_mode = true;
+static bool text_mode_dirty = true;
+static uint console_row = 0;
+static uint console_col = 0;
 
 void framebuffer_switched_cb(){
     framebuffer_switched = true;
 }
 
+static void text_mode_clear_buffer(void) {
+    memset(text_mode_buffer, 0, sizeof(text_mode_buffer));
+    console_row = 0;
+    console_col = 0;
+}
+
+static void text_mode_scroll_up(void) {
+    memmove(&text_mode_buffer[0][0],
+            &text_mode_buffer[1][0],
+            (CHAR_LINES - 1) * CHARS_PER_LINE * sizeof(text_mode_buffer[0][0]));
+    memset(text_mode_buffer[CHAR_LINES - 1], 0, CHARS_PER_LINE * sizeof(text_mode_buffer[0][0]));
+}
+
+static void text_mode_newline(void) {
+    console_col = 0;
+    if (console_row + 1 >= CHAR_LINES) {
+        text_mode_scroll_up();
+    } else {
+        console_row++;
+    }
+}
+
+static void text_mode_put_char(char c) {
+    if (c == '\r') {
+        console_col = 0;
+        return;
+    }
+
+    if (c == '\n') {
+        text_mode_newline();
+        return;
+    }
+
+    if (c == '\b' || c == 0x7f) {
+        if (console_col > 0) {
+            console_col--;
+            text_mode_buffer[console_row][console_col] = 0;
+        }
+        return;
+    }
+
+    if ((unsigned char)c < 32 || (unsigned char)c > 126) {
+        return;
+    }
+
+    text_mode_buffer[console_row][console_col] = c;
+
+    console_col++;
+    if (console_col >= CHARS_PER_LINE) {
+        text_mode_newline();
+    }
+}
+
+static void text_mode_puts(const char *s) {
+    while (*s) {
+        text_mode_put_char(*s++);
+    }
+}
+
+static void poll_usb_console(void) {
+    int ch;
+    while ((ch = getchar_timeout_us(0)) != PICO_ERROR_TIMEOUT) {
+        text_mode_put_char((char)ch);
+        putchar(ch);
+    }
+}
+
 void main() {
     stdio_init_all();
     multicore_launch_core1(core1_entry);
@@ -42,9 +112,10 @@ void main() {
     video_set_framebuffer_switched_cb(framebuffer_switched_cb);
     video_init(fb0);
 
-    memset(text_mode_buffer, 0, CHAR_LINES*CHARS_PER_LINE);
+    text_mode_clear_buffer();
-    strcpy(&text_mode_buffer[0][0], "PicoPAL text mode");
+    text_mode_puts("+------------------------------+\r");
-    strcpy(&text_mode_buffer[1][0], "-----------------");
+    text_mode_puts("|      Pico-PAL text mode      |\r");
+    text_mode_puts("+------------------------------+\r");
 
     gpio_init(25);
     gpio_set_dir(25, GPIO_OUT);
@@ -52,6 +123,7 @@ void main() {
     int fbnum = 1;
     video_framebuffer_ptr_t fbs[] = {fb0, fb1};
     while (true) {
+        poll_usb_console();
 
         // Check if need to draw new frame
         if(framebuffer_switched){
@@ -60,6 +132,7 @@ void main() {
             if(text_mode){
                 draw_text_mode(fbs[fbnum], text_mode_buffer);
             }
+
             fbnum = (fbnum+1)%2;
             framebuffer_switched = false;
         }