Changeset 9e9d9bc6 in mainline for uspace/drv/hid/xtkbd/xtkbd.c

Timestamp:

2022-06-27T16:13:45Z (22 months ago)

Author:

Jiri Svoboda <jiri@…>

Branches:

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

Children:

0d59ea7e

Parents:

bb4ba92

Message:

XT keyboard scancode parsing needs some work

Properly decode fake shift as well as Pause sequences.

File:

• uspace/drv/hid/xtkbd/xtkbd.c (modified) (4 diffs)

uspace/drv/hid/xtkbd/xtkbd.c

@@ -132 +132 @@
         [0x58] = KC_F12,
 
+        [0x54] = KC_SYSREQ,
         [0x46] = KC_SCROLL_LOCK,
 
@@ -163 +164 @@
         [0x1d] = KC_RCTRL,
 
-        [0x37] = KC_SYSREQ,
+        [0x37] = KC_PRTSCR,
+        [0x46] = KC_PAUSE,
 
         [0x52] = KC_INSERT,
@@ -230 +232 @@
 static errno_t polling(void *arg)
 {
+        kbd_event_type_t evtype;
+        unsigned int key;
+        size_t map_size;
         xt_kbd_t *kbd = arg;
+        uint8_t code;
+        uint8_t xcode1;
+        uint8_t xcode2;
         errno_t rc;
 
         while (true) {
-                const unsigned int *map = scanmap_simple;
-                size_t map_size = sizeof(scanmap_simple) / sizeof(unsigned int);
-
-                uint8_t code = 0;
                 rc = xtkbd_get_code(kbd, &code);
                 if (rc != EOK)
@@ -248 +252 @@
                 /* Extended set */
                 if (code == KBD_SCANCODE_SET_EXTENDED) {
-                        map = scanmap_e0;
-                        map_size = sizeof(scanmap_e0) / sizeof(unsigned int);
-
-                        rc = xtkbd_get_code(kbd, &code);
+                        rc = xtkbd_get_code(kbd, &xcode1);
                         if (rc != EOK)
                                 return EIO;
 
-                        /* Handle really special keys */
-
-                        if (code == 0x2a) {  /* Print Screen */
-                                rc = xtkbd_get_code(kbd, &code);
-                                if (rc != EOK)
-                                        return EIO;
-
-                                if (code != 0xe0)
-                                        continue;
-
-                                rc = xtkbd_get_code(kbd, &code);
-                                if (rc != EOK)
-                                        return EIO;
-
-                                if (code == 0x37)
-                                        push_event(kbd->client_sess, KEY_PRESS, KC_PRTSCR);
-
+                        if ((xcode1 & 0x7f) == 0x2a)  /* Fake shift */
+                                continue;
+
+                        /* Bit 7 indicates press/release */
+                        evtype = (xcode1 & 0x80) ? KEY_RELEASE : KEY_PRESS;
+
+                        map_size = sizeof(scanmap_e0) / sizeof(unsigned int);
+                        key = (xcode1 & 0x7f) < map_size ?
+                            scanmap_e0[xcode1 & 0x7f] : 0;
+
+                        if (key != 0)
+                                push_event(kbd->client_sess, evtype, key);
+                        else
+                                ddf_msg(LVL_WARN, "Unknown scancode: e0 %hhx", xcode1);
+
+                        continue;
+                }
+
+                /* Extended special set */
+                if (code == KBD_SCANCODE_SET_EXTENDED_SPECIAL) {
+                        rc = xtkbd_get_code(kbd, &xcode1);
+                        if (rc != EOK)
+                                return EIO;
+
+                        rc = xtkbd_get_code(kbd, &xcode2);
+                        if (rc != EOK)
+                                return EIO;
+
+                        if ((xcode1 & 0x80) == (xcode2 & 0x80) &&
+                            (xcode1 & 0x7f) == 0x1d && (xcode2 & 0x7f) == 0x45) {
+                                /* Pause */
+                                evtype = (xcode1 & 0x80) ? KEY_RELEASE :
+                                    KEY_PRESS;
+                                push_event(kbd->client_sess, evtype, KC_PAUSE);
                                 continue;
                         }
 
-                        if (code == 0x46) {  /* Break */
-                                rc = xtkbd_get_code(kbd, &code);
-                                if (rc != EOK)
-                                        return EIO;
-
-                                if (code != 0xe0)
-                                        continue;
-
-                                rc = xtkbd_get_code(kbd, &code);
-                                if (rc != EOK)
-                                        return EIO;
-
-                                if (code == 0xc6)
-                                        push_event(kbd->client_sess, KEY_PRESS, KC_BREAK);
-
-                                continue;
-                        }
-                }
-
-                /* Extended special set */
-                if (code == KBD_SCANCODE_SET_EXTENDED_SPECIAL) {
-                        rc = xtkbd_get_code(kbd, &code);
-                        if (rc != EOK)
-                                return EIO;
-
-                        if (code != 0x1d)
-                                continue;
-
-                        rc = xtkbd_get_code(kbd, &code);
-                        if (rc != EOK)
-                                return EIO;
-
-                        if (code != 0x45)
-                                continue;
-
-                        rc = xtkbd_get_code(kbd, &code);
-                        if (rc != EOK)
-                                return EIO;
-
-                        if (code != 0xe1)
-                                continue;
-
-                        rc = xtkbd_get_code(kbd, &code);
-                        if (rc != EOK)
-                                return EIO;
-
-                        if (code != 0x9d)
-                                continue;
-
-                        rc = xtkbd_get_code(kbd, &code);
-                        if (rc != EOK)
-                                return EIO;
-
-                        if (code == 0xc5)
-                                push_event(kbd->client_sess, KEY_PRESS, KC_PAUSE);
-
+                        ddf_msg(LVL_WARN, "Unknown scancode: e1 %hhx %hhx",
+                            xcode1, xcode2);
                         continue;
                 }
 
                 /* Bit 7 indicates press/release */
-                const kbd_event_type_t type =
-                    (code & 0x80) ? KEY_RELEASE : KEY_PRESS;
-                code &= ~0x80;
-
-                const unsigned int key = (code < map_size) ? map[code] : 0;
+                evtype = (code & 0x80) ? KEY_RELEASE : KEY_PRESS;
+
+                map_size = sizeof(scanmap_simple) / sizeof(unsigned int);
+                key = (code & 0x7f) < map_size ?
+                    scanmap_simple[code & 0x7f] : 0;
 
                 if (key != 0)
-                        push_event(kbd->client_sess, type, key);
+                        push_event(kbd->client_sess, evtype, key);
                 else
                         ddf_msg(LVL_WARN, "Unknown scancode: %hhx", code);