diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/mds-kkbd.c | 156 |
1 files changed, 143 insertions, 13 deletions
diff --git a/src/mds-kkbd.c b/src/mds-kkbd.c index 07a5de7..21da035 100644 --- a/src/mds-kkbd.c +++ b/src/mds-kkbd.c @@ -64,6 +64,15 @@ */ #define KEYBOARD_ID "kernel" +/** + * LED:s that we believe are pressent on the keyboard + */ +#ifdef LED_COMPOSE +# define PRESENT_LEDS "num caps scrl compose" +#else +# define PRESENT_LEDS "num caps scrl" +#endif + /** @@ -141,7 +150,17 @@ static int scancode_ptr = 0; /** * Message buffer for `send_key` */ -static char* key_send_buffer = NULL; +static char key_send_buffer[111]; + +/** + * Message buffer for the main thread + */ +static char* send_buffer = NULL; + +/** + * The size of `send_buffer` + */ +static size_t send_buffer_size = 0; /** * The keyboard listener thread @@ -210,7 +229,6 @@ int initialise_server(void) fail_if (server_initialised()); stage = 4; fail_if (mds_message_initialise(&received)); - fail_if (xmalloc(key_send_buffer, 111, char)); return 0; @@ -418,10 +436,12 @@ int master_loop(void) pfail: xperror(*argv); fail: - if (!rc && reexecing) - return 0; + pthread_mutex_destroy(&send_mutex); + free(send_buffer); if ((!joined) && (errno = pthread_join(kbd_thread, NULL))) xperror(*argv); + if (!rc && reexecing) + return 0; mds_message_destroy(&received); return rc; } @@ -511,6 +531,31 @@ int handle_message(void) /** + * Make sure `send_buffer` is large enough + * + * @param size The size required for the buffer + * @return Zero on success, -1 on error + */ +static int ensure_send_buffer_size(size_t size) +{ + char* old = send_buffer; + + if (send_buffer_size >= size) + return 0; + + if (xrealloc(send_buffer, size, char)) + { + send_buffer = old; + return -1; + } + else + send_buffer_size = size, + + return 0; +} + + +/** * Handle the received message after it has been * identified to contain `Command: enumerate-keyboards` * @@ -522,22 +567,71 @@ int handle_message(void) int handle_enumerate_keyboards(const char* recv_client_id, const char* recv_message_id, const char* recv_modify_id) { + int32_t msgid; + size_t n; + if (recv_modify_id == NULL) { eprint("did not get add modify ID, ignoring."); return 0; } + if (strequals(recv_client_id, "0:0")) { eprint("received information request from an anonymous client, sending non-modifying response."); - /* TODO send non-modifying response */ - return 0; + + with_mutex (send_mutex, + msgid = message_id; + message_id = message_id == INT32_MAX ? 0 : (message_id + 1); + ); + + if (ensure_send_buffer_size(48 + strlen(recv_modify_id) + 1) < 0) + return -1; + sprintf(send_buffer, + "Modify: no\n" + "Modify ID: %s\n" + "Message ID: " PRIi32 "\n" + "\n", + recv_modify_id, msgid); + + with_mutex (send_mutex, + r = full_send(send_buffer, strlen(send_buffer)); + ); + return r; } - /* TODO */ + with_mutex (send_mutex, + msgid = message_id; + message_id = message_id == INT32_MAX ? 0 : (message_id + 1); + message_id = message_id == INT32_MAX ? 0 : (message_id + 1); + ); - return 0; + n = 176 + 3 * sizeof(size_t) + strlen(KEYBOARD_ID); + n += strlen(recv_modify_id) + strlen(recv_message_id); + if (ensure_send_buffer_size(n + 1) < 0) + return -1; + sprintf(send_buffer, + "Modify: yes\n" + "Modify ID: %s\n" + "Message ID: " PRIi32 "\n" + "\n" + /* NEXT MESSAGE */ + "Command: keyboard-enumeration\n" + "To: %s\n" + "In response to: %s\n" + "Length: %lu\n" + "Message ID: " PRIi32 "\n" + "\n" + KEYBOARD_ID "\n", + recv_modify_id, msgid, + recv_message_id, recv_client_id, strlen(KEYBOARD_ID) + 1, msgid + 1); + + with_mutex (send_mutex, + r = full_send(send_buffer, strlen(send_buffer)); + ); + + return r; } @@ -653,6 +747,8 @@ int handle_set_keyboard_leds(const char* recv_active, const char* recv_mask, int handle_get_keyboard_leds(const char* recv_client_id, const char* recv_message_id, const char* recv_keyboard) { + int r; + if ((recv_keyboard != NULL) && !strequals(recv_keyboard, KEYBOARD_ID)) return 0; @@ -668,9 +764,38 @@ int handle_get_keyboard_leds(const char* recv_client_id, const char* recv_messag return 0; } - /* TODO */ + with_mutex (send_mutex, + msgid = message_id; + message_id = message_id == INT32_MAX ? 0 : (message_id + 1); + ); - return 0; + n = 95 + 3 * sizeof(size_t) + 2 * strlen(PRESENT_LEDS); + n += strlen(recv_client_id) + strlen(recv_message_id); + if (ensure_send_buffer_size(n + 1) < 0) + return -1; + sprintf(send_buffer, + "To: %s\n" + "In response to: %s\n" + "Message ID: " PRIi32 "\n" + "Active:%s%s%s%s%s\n" + "Present: " PRESENT_LEDS "\n" + "\n" + recv_client_id, recv_message_id, msgid, + (leds & LED_NUM_LOCK) ? " num" : "", + (leds & LED_CAPS_LOCK) ? " caps" : "", + (leds & LED_SCRL_LOCK) ? " scroll" : "", +#ifdef LED_COMPOSE + (leds & LED_COMPOSE) ? " compose" : +#endif + "", + leds == 0 ? " none" : "" + ); + + with_mutex (send_mutex, + r = full_send(send_buffer, strlen(send_buffer)); + ); + + return r; } @@ -835,6 +960,7 @@ void close_input(void) int send_key(int* restrict scancode, int trio) { int r, keycode, released = (scancode[0] & 0x80) == 0x80; + int32_t msgid; scancode[0] &= 0x7F; if (trio) { @@ -847,6 +973,11 @@ int send_key(int* restrict scancode, int trio) if ((size_t)keycode < mapping_size) keycode = mapping[keycode]; + with_mutex (send_mutex, + msgid = message_id; + message_id = message_id == INT32_MAX ? 0 : (message_id + 1); + ); + if (trio) sprintf(key_send_buffer, "Command: key-sent\n" @@ -857,7 +988,7 @@ int send_key(int* restrict scancode, int trio) "Message ID: " PRIi32 "\n" "\n", scancode[0], scancode[1], scancode[2], keycode, - released ? "yes" : "no", message_id); + released ? "yes" : "no", msgid); else sprintf(key_send_buffer, "Command: key-sent\n" @@ -868,9 +999,8 @@ int send_key(int* restrict scancode, int trio) "Message ID: " PRIi32 "\n" "\n", scancode[0], keycode, - released ? "yes" : "no", message_id); + released ? "yes" : "no", msgid); - message_id = message_id == INT32_MAX ? 0 : (message_id + 1); with_mutex (send_mutex, r = full_send(key_send_buffer, strlen(key_send_buffer)); ); |