From 4269b25ecfd65d6512756512ff9a0ea6edbb189a Mon Sep 17 00:00:00 2001
From: Jeremy Soller <jeremy@system76.com>
Date: Fri, 8 Nov 2019 13:27:59 -0700
Subject: [PATCH] Allow writing to controller output port

---
 src/board/system76/galp3-c/kbc.c | 9 +++++++++
 1 file changed, 9 insertions(+)

diff --git a/src/board/system76/galp3-c/kbc.c b/src/board/system76/galp3-c/kbc.c
index 6943ce7..ea85f12 100644
--- a/src/board/system76/galp3-c/kbc.c
+++ b/src/board/system76/galp3-c/kbc.c
@@ -46,6 +46,7 @@ enum KbcState {
     KBC_STATE_WRITE_CONFIG,
     KBC_STATE_SET_LEDS,
     KBC_STATE_SCANCODE,
+    KBC_STATE_WRITE_PORT,
 };
 
 void kbc_event(struct Kbc * kbc) {
@@ -96,6 +97,10 @@ void kbc_event(struct Kbc * kbc) {
             case 0xAE:
                 printf("  enable first port\n");
                 break;
+            case 0xD1:
+                printf("  write port byte\n");
+                state = KBC_STATE_WRITE_PORT;
+                break;
             }
         } else {
             printf("kbc data: %02X\n", data);
@@ -178,6 +183,10 @@ void kbc_event(struct Kbc * kbc) {
                     }
                     kbc_keyboard(kbc, 0xFA);
                     break;
+                case KBC_STATE_WRITE_PORT:
+                    printf("  write port byte\n");
+                    state = KBC_STATE_NORMAL;
+                    break;
             }
         }
     }