summaryrefslogtreecommitdiff
path: root/payloads/libpayload
diff options
context:
space:
mode:
Diffstat (limited to 'payloads/libpayload')
-rw-r--r--payloads/libpayload/drivers/keyboard.c21
-rw-r--r--payloads/libpayload/include/libpayload.h1
2 files changed, 22 insertions, 0 deletions
diff --git a/payloads/libpayload/drivers/keyboard.c b/payloads/libpayload/drivers/keyboard.c
index e65f08534a..0175bc74d9 100644
--- a/payloads/libpayload/drivers/keyboard.c
+++ b/payloads/libpayload/drivers/keyboard.c
@@ -31,6 +31,8 @@
#include <libpayload-config.h>
#include <libpayload.h>
+#define I8042_CMD_DIS_KB 0xad
+
struct layout_maps {
const char *country;
const unsigned short map[4][0x57];
@@ -300,3 +302,22 @@ void keyboard_init(void)
console_add_input_driver(&cons);
}
+void keyboard_disconnect(void)
+{
+ /* If 0x64 returns 0xff, then we have no keyboard
+ * controller */
+ if (inb(0x64) == 0xFF)
+ return;
+
+ /* Empty keyboard buffer */
+ while (keyboard_havechar())
+ keyboard_getchar();
+
+ /* Send keyboard disconnect command */
+ outb(I8042_CMD_DIS_KB, 0x64);
+ keyboard_wait_write();
+
+ /* Hand off with empty buffer */
+ while (keyboard_havechar())
+ keyboard_getchar();
+}
diff --git a/payloads/libpayload/include/libpayload.h b/payloads/libpayload/include/libpayload.h
index 8e03c0b5b5..10a4505c30 100644
--- a/payloads/libpayload/include/libpayload.h
+++ b/payloads/libpayload/include/libpayload.h
@@ -150,6 +150,7 @@ int add_reset_handler(void (*new_handler)(void));
* @{
*/
void keyboard_init(void);
+void keyboard_disconnect(void);
int keyboard_havechar(void);
unsigned char keyboard_get_scancode(void);
int keyboard_getchar(void);