FIX: clear keyboard_keys.

NOT change layer when one more Fn keys pressed/other than Fn key pressed

2 files changed, 10 insertions, 5 deletions

diff --git a/hhkb/keymap.c b/hhkb/keymap.c
index d7e6bbe3be..572f530b93 100644
--- a/hhkb/keymap.c
+++ b/hhkb/keymap.c
@@ -152,12 +152,17 @@ int get_layer(void) {
         for (int col = 0; col < MATRIX_ROWS; col++) {
             if (matrix[row] & 1<<col) continue; // NOT pressed
             uint8_t code = get_keycode(0, row, col);
-            if      (code == FN_1) layer = 1;
-            else if (code == FN_2) layer = 2;
-            else if (code == FN_3) layer = 3;
-            else if (code == FN_4) layer = 4;
+
+            // NOT change current_layer when one more Fn keys pressed
+            //                          when other than Fn key pressed
+            if      (code == FN_1) layer = layer ? current_layer : 1;
+            else if (code == FN_2) layer = layer ? current_layer : 2;
+            else if (code == FN_3) layer = layer ? current_layer : 3;
+            else if (code == FN_4) layer = layer ? current_layer : 4;
             else if (KB_LCTRL <= code && code <= KB_RGUI)
                 modifiers |= 1<<(code & 0x07);
+            else // other_key_pressed
+                layer = current_layer;
         }
     }
 
diff --git a/key_process.c b/key_process.c
index 0bce91883e..4a9e81b756 100644
--- a/key_process.c
+++ b/key_process.c
@@ -58,7 +58,7 @@ void proc_matrix(void) {
         }
 
         keyboard_modifier_keys = 0;
-        for (int i = 0; i < 3; i++) keyboard_keys[i] = KB_NO;
+        for (int i = 0; i < 6; i++) keyboard_keys[i] = KB_NO;
         key_index = 0;
         mouse_btn = 0;
         mouse_x = 0;