Changeset 1ff1ee1 in mainline

Timestamp:

2012-01-03T13:29:09Z (13 years ago)

Author:

Jan Vesely <jano.vesely@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

ecc6323

Parents:

8bb9540

Message:

xtkbd: Add support for setting LED indicators.

This breaks XT compatibility (XT protocol is unidirectional),
but was requested on ML in order to maintain feature parity with the old
driver.

File:

• uspace/drv/char/xtkbd/xtkbd.c (modified) (2 diffs)

uspace/drv/char/xtkbd/xtkbd.c

@@ -178 +178 @@
 };
 
+#define KBD_CMD_SET_LEDS 0xed
+enum led_indicators {
+        LI_SCROLL       = 0x01,
+        LI_NUM          = 0x02,
+        LI_CAPS         = 0x04,
+};
+
 static int polling(void *);
 static void default_connection_handler(ddf_fun_t *, ipc_callid_t, ipc_call_t *);
@@ -310 +317 @@
 
         switch (method) {
-        case KBDEV_SET_IND:
-                /* XT keyboards do not support setting mods */
-                async_answer_0(icallid, ENOTSUP);
+        case KBDEV_SET_IND: {
+                /* XT keyboards do not support setting mods,
+                 * assume AT keyboard with Scan Code Set 1 */
+                const unsigned mods = IPC_GET_ARG1(*icall);
+                const uint8_t status = 0 |
+                    ((mods & KM_CAPS_LOCK) ? LI_CAPS : 0) |
+                    ((mods & KM_NUM_LOCK) ? LI_NUM : 0) |
+                    ((mods & KM_SCROLL_LOCK) ? LI_SCROLL : 0);
+                uint8_t cmds[] = { KBD_CMD_SET_LEDS, status };
+                const ssize_t size =
+                     char_dev_write(kbd->parent_sess, cmds, sizeof(cmds));
+                async_answer_0(icallid, size < 0 ? size : EOK);
                 break;
+        }
         /* This might be ugly but async_callback_receive_start makes no
          * difference for incorrect call and malloc failure. */