From 8e4ca413fd37747df035efd9c584d7c3723eaca0 Mon Sep 17 00:00:00 2001
From: Andrei Emeltchenko <andrei.emeltchenko@intel.com>
Date: Wed, 3 Feb 2016 16:36:54 +0200
Subject: [PATCH] drivers/nble: Add debug tables with function strings

Since RPC to the NBLE is designed in a such a way that it is nearly
impossible to find out which packet received, create debug tables in
debug configuration. The tables store strings of function names
referenced by function index in a table, created the same way as RPC.

Sample output is:
...
bt: rpc_deserialize (0xa80082c4): on_nble_up
...

Change-Id: Ic91fcf73753aa9b78bdbacd5c8a0279823a4679e
Signed-off-by: Andrei Emeltchenko <andrei.emeltchenko@intel.com>
---
 drivers/nble/rpc_deserialize.c | 47 ++++++++++++++++++++++++++++++++++
 1 file changed, 47 insertions(+)

diff --git a/drivers/nble/rpc_deserialize.c b/drivers/nble/rpc_deserialize.c
index 362dfe131f3..341efaeeca4 100644
--- a/drivers/nble/rpc_deserialize.c
+++ b/drivers/nble/rpc_deserialize.c
@@ -17,6 +17,8 @@
 #include <stdlib.h>
 #include <string.h>
 
+#include <bluetooth/log.h>
+
 #ifdef CONFIG_PRINTK
 #include <misc/printk.h>
 #define PRINTK(...) printk(__VA_ARGS__)
@@ -172,6 +174,43 @@ static void (*m_fct_s_b_b_p[])(void *structure, void *buffer1, uint8_t length1,
 			       void *buffer2, uint8_t length2,
 			       void *pointer) = { LIST_FN_SIG_S_B_B_P };
 
+/* Build debug table to help development with this "robust" macro stuff */
+
+#if defined(CONFIG_BLUETOOTH_DEBUG)
+
+#undef FN_SIG_NONE
+#undef FN_SIG_S
+#undef FN_SIG_P
+#undef FN_SIG_S_B
+#undef FN_SIG_B_B_P
+#undef FN_SIG_S_P
+#undef FN_SIG_S_B_P
+#undef FN_SIG_S_B_B_P
+
+#define FN_SIG_NONE(__fn)			#__fn,
+#define FN_SIG_S(__fn, __s)			FN_SIG_NONE(__fn)
+#define FN_SIG_P(__fn, __type)			FN_SIG_NONE(__fn)
+#define FN_SIG_S_B(__fn, __s, __type, __length)				\
+						FN_SIG_NONE(__fn)
+#define FN_SIG_B_B_P(__fn, __type1, __length1, __type2, __length2,	\
+		     __type3)			FN_SIG_NONE(__fn)
+#define FN_SIG_S_P(__fn, __s, __type)		FN_SIG_NONE(__fn)
+#define FN_SIG_S_B_P(__fn, __s, __type, __length, __type_ptr)		\
+						FN_SIG_NONE(__fn)
+#define FN_SIG_S_B_B_P(__fn, __s, __type1, __length1, __type2,		\
+		       __length2, __type3)	FN_SIG_NONE(__fn)
+
+static char *debug_func_none[] = { LIST_FN_SIG_NONE };
+static char *debug_func_s[] = { LIST_FN_SIG_S };
+static char *debug_func_p[] = { LIST_FN_SIG_P };
+static char *debug_func_s_b[] = { LIST_FN_SIG_S_B };
+static char *debug_func_b_b_p[] = { LIST_FN_SIG_B_B_P };
+static char *debug_func_s_p[] = { LIST_FN_SIG_S_P };
+static char *debug_func_s_b_p[] = { LIST_FN_SIG_S_B_P };
+static char *debug_func_s_b_b_p[] = { LIST_FN_SIG_S_B_B_P};
+
+#endif
+
 static void panic(int err)
 {
 	PRINTK("panic: errcode %d", err);
@@ -478,41 +517,49 @@ void rpc_deserialize(const uint8_t *buf, uint16_t length)
 		switch (sig_type) {
 		case SIG_TYPE_NONE:
 			if (sizeof(m_fct_none)) {
+				BT_DBG("%s", debug_func_none[fn_index]);
 				deserialize_none(fn_index, buf, length);
 			}
 			break;
 		case SIG_TYPE_S:
 			if (sizeof(m_fct_s)) {
+				BT_DBG("%s", debug_func_s[fn_index]);
 				deserialize_s(fn_index, buf, length);
 			}
 			break;
 		case SIG_TYPE_P:
 			if (sizeof(m_fct_p)) {
+				BT_DBG("%s", debug_func_p[fn_index]);
 				deserialize_p(fn_index, buf, length);
 			}
 			break;
 		case SIG_TYPE_S_B:
 			if (sizeof(m_fct_s_b)) {
+				BT_DBG("%s", debug_func_s_b[fn_index]);
 				deserialize_s_b(fn_index, buf, length);
 			}
 			break;
 		case SIG_TYPE_B_B_P:
 			if (sizeof(m_fct_b_b_p)) {
+				BT_DBG("%s", debug_func_b_b_p[fn_index]);
 				deserialize_b_b_p(fn_index, buf, length);
 			}
 			break;
 		case SIG_TYPE_S_P:
 			if (sizeof(m_fct_s_p)) {
+				BT_DBG("%s", debug_func_s_p[fn_index]);
 				deserialize_s_p(fn_index, buf, length);
 			}
 			break;
 		case SIG_TYPE_S_B_P:
 			if (sizeof(m_fct_s_b_p)) {
+				BT_DBG("%s", debug_func_s_b_p[fn_index]);
 				deserialize_s_b_p(fn_index, buf, length);
 			}
 			break;
 		case SIG_TYPE_S_B_B_P:
 			if (sizeof(m_fct_s_b_b_p)) {
+				BT_DBG("%s", debug_func_s_b_b_p[fn_index]);
 				deserialize_s_b_b_p(fn_index, buf, length);
 			}
 			break;