Changes in uspace/srv/kbd/ctl/pc.c [f954906:c145bc2] in mainline

File:

• uspace/srv/kbd/ctl/pc.c (modified) (4 diffs)

uspace/srv/kbd/ctl/pc.c

@@ -40 +40 @@
 #include <io/keycode.h>
 #include <kbd_ctl.h>
+#include <kbd_port.h>
 #include <gsp.h>
 
@@ -45 +46 @@
         ds_s,
         ds_e
+};
+
+enum special_code {
+        SC_ACK = 0xfa,
+        SC_NAK = 0xfe
+};
+
+enum lock_ind_bits {
+        LI_SCROLL       = 0x01,
+        LI_NUM          = 0x02,
+        LI_CAPS         = 0x04
+};
+
+enum kbd_command {
+        KBD_CMD_SET_LEDS = 0xed
 };
 
@@ -194 +210 @@
         size_t map_length;
 
+        /*
+         * ACK/NAK are returned as response to us sending a command.
+         * We are not interested in them.
+         */
+        if (scancode == SC_ACK || scancode == SC_NAK)
+                return;
+
         if (scancode == 0xe0) {
                 ds = ds_e;
@@ -230 +253 @@
 }
 
+void kbd_ctl_set_ind(unsigned mods)
+{
+        uint8_t b;
+
+        b = 0;
+        if ((mods & KM_CAPS_LOCK) != 0)
+                b = b | LI_CAPS;
+        if ((mods & KM_NUM_LOCK) != 0)
+                b = b | LI_NUM;
+        if ((mods & KM_SCROLL_LOCK) != 0)
+                b = b | LI_SCROLL;
+
+        kbd_port_write(KBD_CMD_SET_LEDS);
+        kbd_port_write(b);
+}
+
 /**
  * @}