feat(behavior): Add key toggle

app/src/behaviors/behavior_key_toggle.c

@@ -0,0 +1,44 @@
+/*
+ * Copyright (c) 2022 The ZMK Contributors
+ *
+ * SPDX-License-Identifier: MIT
+ */
+
+#define DT_DRV_COMPAT zmk_behavior_key_toggle
+
+#include <device.h>
+#include <drivers/behavior.h>
+#include <logging/log.h>
+
+#include <zmk/hid.h>
+#include <zmk/event_manager.h>
+#include <zmk/events/keycode_state_changed.h>
+#include <zmk/behavior.h>
+
+LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
+
+static int behavior_key_toggle_init(const struct device *dev) { return 0; }
+
+static int on_keymap_binding_pressed(struct zmk_behavior_binding *binding,
+                                     struct zmk_behavior_binding_event event) {
+    LOG_DBG("position %d keycode 0x%02X", event.position, binding->param1);
+    bool pressed = zmk_hid_is_pressed(binding->param1);
+    return ZMK_EVENT_RAISE(
+        zmk_keycode_state_changed_from_encoded(binding->param1, !pressed, event.timestamp));
+}
+
+static int on_keymap_binding_released(struct zmk_behavior_binding *binding,
+                                      struct zmk_behavior_binding_event event) {
+    return 0;
+}
+
+static const struct behavior_driver_api behavior_key_toggle_driver_api = {
+    .binding_pressed = on_keymap_binding_pressed,
+    .binding_released = on_keymap_binding_released,
+};
+
+#define KT_INST(n)                                                                                 \
+    DEVICE_DT_INST_DEFINE(n, behavior_key_toggle_init, NULL, NULL, NULL, APPLICATION,              \
+                          CONFIG_KERNEL_INIT_PRIORITY_DEFAULT, &behavior_key_toggle_driver_api);
+
+DT_INST_FOREACH_STATUS_OKAY(KT_INST)

app/src/hid.c

@@ -4,6 +4,7 @@
  * SPDX-License-Identifier: MIT
  */
 
+#include "zmk/keys.h"
 #include <logging/log.h>
 LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL);
 
@@ -55,6 +56,11 @@ int zmk_hid_unregister_mod(zmk_mod_t modifier) {
     return current == GET_MODIFIERS ? 0 : 1;
 }
 
+bool zmk_hid_mod_is_pressed(zmk_mod_t modifier) {
+    zmk_mod_flags_t mod_flag = 1 << modifier;
+    return (zmk_hid_get_explicit_mods() & mod_flag) == mod_flag;
+}
+
 int zmk_hid_register_mods(zmk_mod_flags_t modifiers) {
     int ret = 0;
     for (zmk_mod_t i = 0; i < 8; i++) {
@@ -96,6 +102,13 @@ static inline int deselect_keyboard_usage(zmk_key_t usage) {
     return 0;
 }
 
+static inline bool check_keyboard_usage(zmk_key_t usage) {
+    if (usage > ZMK_HID_KEYBOARD_NKRO_MAX_USAGE) {
+        return false;
+    }
+    return keyboard_report.body.keys[usage / 8] & (1 << (usage % 8));
+}
+
 #elif IS_ENABLED(CONFIG_ZMK_HID_REPORT_TYPE_HKRO)
 
 #define TOGGLE_KEYBOARD(match, val)                                                                \
@@ -119,6 +132,15 @@ static inline int deselect_keyboard_usage(zmk_key_t usage) {
     return 0;
 }
 
+static inline int check_keyboard_usage(zmk_key_t usage) {
+    for (int idx = 0; idx < CONFIG_ZMK_HID_KEYBOARD_REPORT_SIZE; idx++) {
+        if (keyboard_report.body.keys[idx] == usage) {
+            return true;
+        }
+    }
+    return false;
+}
+
 #else
 #error "A proper HID report type must be selected"
 #endif
@@ -164,6 +186,13 @@ int zmk_hid_keyboard_release(zmk_key_t code) {
     return 0;
 };
 
+bool zmk_hid_keyboard_is_pressed(zmk_key_t code) {
+    if (code >= HID_USAGE_KEY_KEYBOARD_LEFTCONTROL && code <= HID_USAGE_KEY_KEYBOARD_RIGHT_GUI) {
+        return zmk_hid_mod_is_pressed(code - HID_USAGE_KEY_KEYBOARD_LEFTCONTROL);
+    }
+    return check_keyboard_usage(code);
+}
+
 void zmk_hid_keyboard_clear() { memset(&keyboard_report.body, 0, sizeof(keyboard_report.body)); }
 
 int zmk_hid_consumer_press(zmk_key_t code) {
@@ -176,6 +205,17 @@ int zmk_hid_consumer_release(zmk_key_t code) {
     return 0;
 };
 
+void zmk_hid_consumer_clear() { memset(&consumer_report.body, 0, sizeof(consumer_report.body)); }
+
+bool zmk_hid_consumer_is_pressed(zmk_key_t key) {
+    for (int idx = 0; idx < CONFIG_ZMK_HID_CONSUMER_REPORT_SIZE; idx++) {
+        if (consumer_report.body.keys[idx] == key) {
+            return true;
+        }
+    }
+    return false;
+}
+
 int zmk_hid_press(uint32_t usage) {
     switch (ZMK_HID_USAGE_PAGE(usage)) {
     case HID_USAGE_KEY:
@@ -196,7 +236,15 @@ int zmk_hid_release(uint32_t usage) {
     return -EINVAL;
 }
 
-void zmk_hid_consumer_clear() { memset(&consumer_report.body, 0, sizeof(consumer_report.body)); }
+bool zmk_hid_is_pressed(uint32_t usage) {
+    switch (ZMK_HID_USAGE_PAGE(usage)) {
+    case HID_USAGE_KEY:
+        return zmk_hid_keyboard_is_pressed(ZMK_HID_USAGE_ID(usage));
+    case HID_USAGE_CONSUMER:
+        return zmk_hid_consumer_is_pressed(ZMK_HID_USAGE_ID(usage));
+    }
+    return false;
+}
 
 struct zmk_hid_keyboard_report *zmk_hid_get_keyboard_report() {
     return &keyboard_report;