emulator/bthost: Add debug support

This adds bthost_set_debug which can be used to debug internals of
bthost.

Signed-off-by: Anuj Jain <anuj01.jain@samsung.com>
Signed-off-by: Ayush Garg <ayush.garg@samsung.com>

diff --git a/emulator/bthost.c b/emulator/bthost.c
index 26ae34b..6dd977b 100755 (executable)
--- a/emulator/bthost.c
+++ b/emulator/bthost.c
@@ -23,6 +23,7 @@
 #include "lib/bluetooth.h"
 
 #include "src/shared/util.h"
+#include "src/shared/tester.h"
 #include "monitor/bt.h"
 #include "monitor/rfcomm.h"
 #include "bthost.h"
@@ -212,6 +213,10 @@ struct bthost {
        bool conn_init;
        bool le;
        bool sc;
+
+       bthost_debug_func_t debug_callback;
+       bthost_destroy_func_t debug_destroy;
+       void *debug_data;
 };
 
 struct bthost *bthost_create(void)
@@ -486,9 +491,20 @@ static void queue_command(struct bthost *bthost, const struct iovec *iov,
 static void send_packet(struct bthost *bthost, const struct iovec *iov,
                                                                int iovlen)
 {
+       int i;
+
        if (!bthost->send_handler)
                return;
 
+       for (i = 0; i < iovlen; i++) {
+               if (!i)
+                       util_hexdump('<', iov[i].iov_base, iov[i].iov_len,
+                               bthost->debug_callback, bthost->debug_data);
+               else
+                       util_hexdump(' ', iov[i].iov_base, iov[i].iov_len,
+                               bthost->debug_callback, bthost->debug_data);
+       }
+
        bthost->send_handler(iov, iovlen, bthost->send_data);
 }
 
@@ -674,6 +690,9 @@ static void send_command(struct bthost *bthost, uint16_t opcode,
        uint8_t pkt = BT_H4_CMD_PKT;
        struct iovec iov[3];
 
+       util_debug(bthost->debug_callback, bthost->debug_data,
+                               "command 0x%02x", opcode);
+
        iov[0].iov_base = &pkt;
        iov[0].iov_len = sizeof(pkt);
 
@@ -758,6 +777,22 @@ void bthost_notify_ready(struct bthost *bthost, bthost_ready_cb cb)
        bthost->ready_cb = cb;
 }
 
+bool bthost_set_debug(struct bthost *bthost, bthost_debug_func_t callback,
+                       void *user_data, bthost_destroy_func_t destroy)
+{
+       if (!bthost)
+               return false;
+
+       if (bthost->debug_destroy)
+               bthost->debug_destroy(bthost->debug_data);
+
+       bthost->debug_callback = callback;
+       bthost->debug_destroy = destroy;
+       bthost->debug_data = user_data;
+
+       return true;
+}
+
 static void read_local_features_complete(struct bthost *bthost,
                                                const void *data, uint8_t len)
 {
@@ -834,7 +869,8 @@ static void evt_cmd_complete(struct bthost *bthost, const void *data,
        case BT_HCI_CMD_LE_SET_EXT_ADV_ENABLE:
                break;
        default:
-               printf("Unhandled cmd_complete opcode 0x%04x\n", opcode);
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                               "Unhandled cmd_complete opcode 0x%04x", opcode);
                break;
        }
 
@@ -1241,6 +1277,9 @@ static void evt_le_meta_event(struct bthost *bthost, const void *data,
        if (len < 1)
                return;
 
+       util_debug(bthost->debug_callback, bthost->debug_data,
+                               "event 0x%02x", *event);
+
        switch (*event) {
        case BT_HCI_EVT_LE_CONN_COMPLETE:
                evt_le_conn_complete(bthost, evt_data, len - 1);
@@ -1258,7 +1297,8 @@ static void evt_le_meta_event(struct bthost *bthost, const void *data,
                evt_le_ext_conn_complete(bthost, evt_data, len - 1);
                break;
        default:
-               printf("Unsupported LE Meta event 0x%2.2x\n", *event);
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                               "Unsupported LE Meta event 0x%2.2x", *event);
                break;
        }
 }
@@ -1276,6 +1316,9 @@ static void process_evt(struct bthost *bthost, const void *data, uint16_t len)
 
        param = data + sizeof(*hdr);
 
+       util_debug(bthost->debug_callback, bthost->debug_data,
+                               "event 0x%02x", hdr->evt);
+
        switch (hdr->evt) {
        case BT_HCI_EVT_CMD_COMPLETE:
                evt_cmd_complete(bthost, param, hdr->plen);
@@ -1342,7 +1385,8 @@ static void process_evt(struct bthost *bthost, const void *data, uint16_t len)
                break;
 
        default:
-               printf("Unsupported event 0x%2.2x\n", hdr->evt);
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                               "Unsupported event 0x%2.2x", hdr->evt);
                break;
        }
 }
@@ -1673,7 +1717,8 @@ static void l2cap_sig(struct bthost *bthost, struct btconn *conn,
                break;
 
        default:
-               printf("Unknown L2CAP code 0x%02x\n", hdr->code);
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                               "Unknown L2CAP code 0x%02x", hdr->code);
                ret = false;
        }
 
@@ -1891,7 +1936,8 @@ static void l2cap_le_sig(struct bthost *bthost, struct btconn *conn,
                break;
 
        default:
-               printf("Unknown L2CAP code 0x%02x\n", hdr->code);
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                               "Unknown L2CAP code 0x%02x", hdr->code);
                ret = false;
        }
 
@@ -2231,7 +2277,8 @@ static void process_rfcomm(struct bthost *bthost, struct btconn *conn,
                rfcomm_uih_recv(bthost, conn, l2conn, data, len);
                break;
        default:
-               printf("Unknown frame type\n");
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                                       "Unknown frame type");
                break;
        }
 }
@@ -2256,7 +2303,8 @@ static void process_acl(struct bthost *bthost, const void *data, uint16_t len)
        handle = acl_handle(acl_hdr->handle);
        conn = bthost_find_conn(bthost, handle);
        if (!conn) {
-               printf("ACL data for unknown handle 0x%04x\n", handle);
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                               "ACL data for unknown handle 0x%04x", handle);
                return;
        }
 
@@ -2292,8 +2340,9 @@ static void process_acl(struct bthost *bthost, const void *data, uint16_t len)
                if (l2conn && l2conn->psm == 0x0003)
                        process_rfcomm(bthost, conn, l2conn, l2_data, l2_len);
                else
-                       printf("Packet for unknown CID 0x%04x (%u)\n", cid,
-                                                                       cid);
+                       util_debug(bthost->debug_callback, bthost->debug_data,
+                                       "Packet for unknown CID 0x%04x (%u)",
+                                       cid, cid);
                break;
        }
 }
@@ -2308,6 +2357,9 @@ void bthost_receive_h4(struct bthost *bthost, const void *data, uint16_t len)
        if (len < 1)
                return;
 
+       util_hexdump('>', data, len, bthost->debug_callback,
+                                       bthost->debug_data);
+
        pkt_type = ((const uint8_t *) data)[0];
 
        switch (pkt_type) {
@@ -2318,7 +2370,8 @@ void bthost_receive_h4(struct bthost *bthost, const void *data, uint16_t len)
                process_acl(bthost, data + 1, len - 1);
                break;
        default:
-               printf("Unsupported packet 0x%2.2x\n", pkt_type);
+               util_debug(bthost->debug_callback, bthost->debug_data,
+                               "Unsupported packet 0x%2.2x", pkt_type);
                break;
        }
 }

diff --git a/emulator/bthost.h b/emulator/bthost.h
index 3841f98..77f17fd 100755 (executable)
--- a/emulator/bthost.h
+++ b/emulator/bthost.h
@@ -23,6 +23,11 @@ void bthost_destroy(struct bthost *bthost);
 typedef void (*bthost_ready_cb) (void);
 void bthost_notify_ready(struct bthost *bthost, bthost_ready_cb cb);
 
+typedef void (*bthost_debug_func_t)(const char *str, void *user_data);
+typedef void (*bthost_destroy_func_t)(void *user_data);
+bool bthost_set_debug(struct bthost *bthost, bthost_debug_func_t callback,
+                       void *user_data, bthost_destroy_func_t destroy);
+
 void bthost_set_send_handler(struct bthost *bthost, bthost_send_func handler,
                                                        void *user_data);