X-Git-Url: http://git.squeep.com/?p=dcpu16;a=blobdiff_plain;f=hw_keyboard.c;fp=hw_keyboard.c;h=89f91ec00557c8c90abca944126e4d05a3205225;hp=f69b8f4227e7eaa07a69ce7ffcfdc3ab9f5c0004;hb=ff3d78d4e1781afbac5d2e9e0fe8361f850bbccb;hpb=1470698024f5511a3b94b7bb50b1097cc6659b32

diff --git a/hw_keyboard.c b/hw_keyboard.c
index f69b8f4..89f91ec 100644
--- a/hw_keyboard.c
+++ b/hw_keyboard.c
@@ -18,6 +18,15 @@
 #define VOIDP(__x__) (__x__)
 #endif
 
+#define MSG_(__level__, __vm__, ...) do { ((__vm__) ? ((struct dcpu16 *)(__vm__))->msg_cb_ : dcpu16_msg_)(__level__, __VA_ARGS__); } while (0)
+#define MSG_INFO(__vm__, ...) MSG_(DCPU16_MSG_INFO, __vm__, __VA_ARGS__)
+#define MSG_ERROR(__vm__, ...) MSG_(DCPU16_MSG_ERROR, __vm__, __VA_ARGS__)
+#ifdef DEBUG
+#define MSG_DEBUG(__vm__, ...) MSG_(DCPU16_MSG_DEBUG, __vm__, __VA_ARGS__)
+#else /* DEBUG  */
+#define MSG_DEBUG(__vm__, ...) do { } while (0)
+#endif /* DEBUG */
+
 struct keyboard_ {
     char *buf;
     size_t buf_sz;
@@ -70,9 +79,7 @@ void keyboard_rfbevent_(rfbBool down, rfbKeySym key, rfbClientPtr cl) {
     struct dcpu16_hw *hw = (struct dcpu16_hw *)cl->screen->screenData;
     struct keyboard_ *keyboard = (struct keyboard_ *)hw->data;
 
-#ifdef DEBUG
-    hw->vm->msg_cb_(MSG_DEBUG, "%s>> down:%u rfb_key:0x%04x", down, key);
-#endif /* DEBUG */
+    MSG_DEBUG(hw->vm, "%s>> down:%u rfb_key:0x%04x", down, key);
 
     if (keysym_rfbtodcpu(key, &dcpu_key)) {
         /* unhandled key event */
@@ -82,7 +89,7 @@ void keyboard_rfbevent_(rfbBool down, rfbKeySym key, rfbClientPtr cl) {
     keyboard->keys_pressed[dcpu_key] = (down ? 1 : 0);
     if (down) {
         if ((keyboard->buf_tail + 1) % keyboard->buf_sz == keyboard->buf_head) {
-            hw->vm->msg_cb_(MSG_INFO, "keyboard buffer overflow");
+            MSG_INFO(hw->vm, "keyboard buffer overflow");
             return;
         }
         keyboard->buf[keyboard->buf_tail] = dcpu_key;
@@ -105,6 +112,8 @@ void keyboard_reset_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
     keyboard->buf_head = 0;
     keyboard->buf_tail = 0;
     memset(keyboard->keys_pressed, 0, sizeof keyboard->keys_pressed);
+
+    MSG_DEBUG(vm, "%s>>", __func__);
 }
 
 static
@@ -125,6 +134,8 @@ void keyboard_hwi_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
             memset(keyboard->buf, 0, keyboard->buf_sz);
             keyboard->buf_head = 0;
             keyboard->buf_tail = 0;
+
+            MSG_DEBUG(vm, "%s>> buffer cleared", __func__);
             break;
 
         case 1: /* get next key from buffer as C */
@@ -133,14 +144,20 @@ void keyboard_hwi_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
             vm->reg[DCPU16_REG_C] = keyboard->buf[keyboard->buf_head];
             keyboard->buf_head += 1;
             keyboard->buf_head %= keyboard->buf_sz;
+
+            MSG_DEBUG(vm, "%s>> next key: %u", __func__, vm->reg[DCPU16_REG_C]);
             break;
 
         case 2: /* get currently-pressed-state of key in B as C */
             vm->reg[DCPU16_REG_C] = keyboard->keys_pressed[reg_b & 0x00ff];
+
+            MSG_DEBUG(vm, "%s>> state of key 0x%02x: %spressed", __func__, reg_b & 0x00ff, keyboard->keys_pressed[reg_b & 0x00ff] ? "" : "not ");
             break;
 
         case 3: /* set interrupt state */
             keyboard->interrupt_message = reg_b;
+
+            MSG_DEBUG(vm, "%s>> interrupt_message:0x%04x", __func__, reg_b);
             break;
 
     }
@@ -152,13 +169,13 @@ int keyboard_data_init_(struct dcpu16_hw *hw, void *data) {
 
     hw->data = calloc(1, sizeof(struct keyboard_));
     if (hw->data == NULL) {
-        hw->vm->msg_cb_(MSG_ERROR, "%s():%s", "calloc", strerror(errno));
+        MSG_ERROR(hw->vm, "%s():%s", "calloc", strerror(errno));
         return -1;
     }
 
     ((struct keyboard_ *)(hw->data))->buf = malloc(buf_sz * sizeof *((struct keyboard_ *)(hw->data))->buf);
     if (((struct keyboard_ *)(hw->data))->buf == NULL) {
-        hw->vm->msg_cb_(MSG_ERROR, "%s():%s", "malloc", strerror(errno));
+        MSG_ERROR(hw->vm, "%s():%s", "malloc", strerror(errno));
         free(hw->data);
         hw->data = NULL;
         return -1;
@@ -201,13 +218,11 @@ int keyboard_data_ctl_(struct dcpu16_hw *hw, const char *cmd, void *data_in, voi
         }
 
         if (buf_sz_in) {
-#ifdef DEBUG
-            hw->vm->msg_cb_(MSG_DEBUG, "%s>> resizing buffer from %zu to %zu", __func__, keyboard->buf_sz, *buf_sz_in);
-#endif /* DEBUG */
+            MSG_DEBUG(hw->vm, "%s>> resizing buffer from %zu to %zu", __func__, keyboard->buf_sz, *buf_sz_in);
 
             tmp_ptr = realloc(keyboard->buf, *buf_sz_in);
             if (tmp_ptr == NULL) {
-                hw->vm->msg_cb_(MSG_DEBUG, "%s():%s", "realloc", strerror(errno));
+                MSG_ERROR(hw->vm, "%s():%s", "realloc", strerror(errno));
                 return -1;
             }
             keyboard->buf = tmp_ptr;
@@ -215,6 +230,8 @@ int keyboard_data_ctl_(struct dcpu16_hw *hw, const char *cmd, void *data_in, voi
             keyboard->buf_head = keyboard->buf_tail = 0;
         }
 
+        MSG_DEBUG(hw->vm, "%s>> %s now:%zu was:%zu", __func__, "buffer_size", *buf_sz_in, *buf_sz_out);
+
         return 0;
     }
 
@@ -229,6 +246,8 @@ int keyboard_data_ctl_(struct dcpu16_hw *hw, const char *cmd, void *data_in, voi
         rfbScreen->screenData = hw;
         rfbScreen->kbdAddEvent = keyboard_rfbevent_;
 
+        MSG_DEBUG(hw->vm, "%s>> %s rfbScreen:%p", __func__, "associate_rfbScreen", rfbScreen);
+
         return 0;
     }
 #endif /* HAVE_LIBVNCSERVER */