[coreboot-gerrit] Change in coreboot[master]: libpayload/keyboard: Implement hot (un)plugging

[Nico Huber (Code Review)]

Nico Huber has uploaded this change for review. ( https://review.coreboot.org/c/coreboot/+/47593 )

Change subject: libpayload/keyboard: Implement hot (un)plugging
......................................................................

libpayload/keyboard: Implement hot (un)plugging

While we assume a keyboard is attached, we send an echo command every
500ms. If there is no data coming from the keyboard within 200ms, we
assume it was detached.

Correspondingly, if we assume no keyboard is attached, we run an echo
command once per second.

Change-Id: I2c75182761729bf30711305f3d8b9d43eafad675
Signed-off-by: Nico Huber 
---
M payloads/libpayload/drivers/i8042/i8042.h
M payloads/libpayload/drivers/i8042/keyboard.c
2 files changed, 66 insertions(+), 2 deletions(-)

git pull ssh://review.coreboot.org:29418/coreboot refs/changes/93/47593/1

diff --git a/payloads/libpayload/drivers/i8042/i8042.h b/payloads/libpayload/drivers/i8042/i8042.h
index bcb42fd..8c18670 100644
--- a/payloads/libpayload/drivers/i8042/i8042.h
+++ b/payloads/libpayload/drivers/i8042/i8042.h
@@ -55,6 +55,7 @@
 #define   I8042_MODE_NUM_LOCK_OFF	(0 << 1)
 #define   I8042_MODE_SCROLL_LOCK_ON	(1 << 0)
 #define   I8042_MODE_SCROLL_LOCK_OFF	(0 << 0)
+#define I8042_KBCMD_ECHO		0xee
 #define I8042_KBCMD_SET_SCANCODE	0xf0
 #define I8042_KBCMD_SET_TYPEMATIC	0xf3
 #define I8042_KBCMD_EN			0xf4
diff --git a/payloads/libpayload/drivers/i8042/keyboard.c b/payloads/libpayload/drivers/i8042/keyboard.c
index dad8a44..09b35d3 100644
--- a/payloads/libpayload/drivers/i8042/keyboard.c
+++ b/payloads/libpayload/drivers/i8042/keyboard.c
@@ -237,9 +237,17 @@
    return ret;
 }

+static bool keyboard_peek_echo_result(void)
+{
+	const uint8_t ch = i8042_peek_data_ps2();
+	return ch == 0xee || ch == 0xfe;
+}
+
 static enum keyboard_state {
    STATE_INIT = 0,
    STATE_SIMPLIFIED_INIT,
+	STATE_HOTPLUG,
+	STATE_HOTPLUG_ECHO,
    STATE_DISABLE_SCAN,
    STATE_DRAIN_INPUT,
    STATE_DISABLE_TRANSLATION,
@@ -250,6 +258,7 @@
    STATE_ENABLE_TRANSLATION,
    STATE_ENABLE_SCAN,
    STATE_RUNNING,
+	STATE_RUNNING_ECHO,
    STATE_IGNORE
 } keyboard_state;

@@ -257,6 +266,8 @@
 static const char *const state_names[] = {
    STATE_NAMES_ENTRY(INIT),
    STATE_NAMES_ENTRY(SIMPLIFIED_INIT),
+	STATE_NAMES_ENTRY(HOTPLUG),
+	STATE_NAMES_ENTRY(HOTPLUG_ECHO),
    STATE_NAMES_ENTRY(DISABLE_SCAN),
    STATE_NAMES_ENTRY(DRAIN_INPUT),
    STATE_NAMES_ENTRY(DISABLE_TRANSLATION),
@@ -267,6 +278,7 @@
    STATE_NAMES_ENTRY(ENABLE_TRANSLATION),
    STATE_NAMES_ENTRY(ENABLE_SCAN),
    STATE_NAMES_ENTRY(RUNNING),
+	STATE_NAMES_ENTRY(RUNNING_ECHO),
    STATE_NAMES_ENTRY(IGNORE)
 };
 _Static_assert(ARRAY_SIZE(state_names) == STATE_IGNORE + 1,
@@ -295,6 +307,28 @@
    	next_state = STATE_CONFIGURE;
    	break;

+	case STATE_HOTPLUG:
+		if (timer_us(state_time) > 1*1000*1000) {
+			i8042_write_data(I8042_KBCMD_ECHO);
+			next_state = STATE_HOTPLUG_ECHO;
+		}
+		break;
+
+	case STATE_HOTPLUG_ECHO:
+		if (!i8042_data_ready_ps2()) {
+			if (timer_us(state_time) > 200*1000)
+				next_state = STATE_HOTPLUG;
+			break;
+		}
+
+		if (keyboard_peek_echo_result()) {
+			next_state = STATE_DISABLE_SCAN;
+			keyboard_time = timer_us(0);
+		}
+		(void)i8042_read_data_ps2();
+
+		break;
+
    case STATE_DISABLE_SCAN:
    	(void)keyboard_cmd(I8042_KBCMD_DEFAULT_DIS);
    	next_state = STATE_DRAIN_INPUT;
@@ -388,7 +422,31 @@
    	break;

case STATE_RUNNING:
-		/* TODO: Use echo command to detect detach. */
+		if (!i8042_data_ready_ps2()) {
+			if (timer_us(state_time) > 500*1000) {
+				i8042_write_data(I8042_KBCMD_ECHO);
+				next_state = STATE_RUNNING_ECHO;
+			}
+		} else {
+			state_time = timer_us(0);
+		}
+		break;
+
+	case STATE_RUNNING_ECHO:
+		if (!i8042_data_ready_ps2()) {
+			if (timer_us(state_time) > 200*1000) {
+				debug("INFO: Keyboard echo timed out.\n");
+				next_state = STATE_HOTPLUG;
+			}
+			break;
+		}
+
+		if (keyboard_peek_echo_result()) {
+			(void)i8042_read_data_ps2();
+			next_state = STATE_RUNNING;
+		}
+
+		state_time = timer_us(0);
    	break;

case STATE_IGNORE:
@@ -399,7 +457,10 @@

switch (next_state) {
    case STATE_INIT:
+	case STATE_HOTPLUG:
+	case STATE_HOTPLUG_ECHO:
    case STATE_RUNNING:
+	case STATE_RUNNING_ECHO:
    case STATE_IGNORE:
    	break;
    default:
@@ -418,7 +479,9 @@
 bool keyboard_havechar(void)
 {
    keyboard_poll();
-	return keyboard_state == STATE_RUNNING && i8042_data_ready_ps2();
+	return i8042_data_ready_ps2() &&
+	       (keyboard_state == STATE_RUNNING ||
+		(keyboard_state == STATE_RUNNING_ECHO && !keyboard_peek_echo_result()));
 }

unsigned char keyboard_get_scancode(void)