pbdrv/bluetooth: Debugging changes for virtualhub.

- Implements HCI logging in bluetooth BTStack.
- Adds a stderr version of uart_debug_first_port.
- (Revert?) Enables debug logging for virtualhub
  bluetooth.

Author: jaguilar

lib/pbio/drv/bluetooth/bluetooth_btstack.c

@@ -54,11 +54,27 @@
 #define HUB_VARIANT 0x0000
 #endif
 
-#define DEBUG 0
+#define DEBUG 1
 
 #if DEBUG
 #include <pbdrv/../../drv/uart/uart_debug_first_port.h>
 #define DEBUG_PRINT pbdrv_uart_debug_printf
+#include <pbdrv/../../drv/uart/uart_debug_first_port.h>
+#define DEBUG_PRINT pbdrv_uart_debug_printf
+static void pbdrv_hci_dump_reset(void) {
+}
+static void pbdrv_hci_dump_log_packet(uint8_t packet_type, uint8_t in, uint8_t *packet, uint16_t len) {
+    pbdrv_uart_debug_printf("HCI %s packet type: %02x, len: %u\n", in ? "in" : "out", packet_type, len);
+}
+static void pbdrv_hci_dump_log_message(int log_level, const char *format, va_list argptr) {
+    pbdrv_uart_debug_vprintf(format, argptr);
+    pbdrv_uart_debug_printf("\n");
+}
+static const hci_dump_t bluetooth_btstack_classic_hci_dump = {
+    .reset = pbdrv_hci_dump_reset,
+    .log_packet = pbdrv_hci_dump_log_packet,
+    .log_message = pbdrv_hci_dump_log_message,
+};
 #else
 #define DEBUG_PRINT(...)
 #endif
@@ -1143,6 +1159,15 @@ void pbdrv_bluetooth_init_hci(void) {
     btstack_run_loop_init(&bluetooth_btstack_run_loop);
 
     hci_init(pdata->transport_instance(), pdata->transport_config());
+
+    #if DEBUG
+    hci_dump_init(&bluetooth_btstack_classic_hci_dump);
+    hci_dump_enable_log_level(HCI_DUMP_LOG_LEVEL_INFO, true);
+    hci_dump_enable_log_level(HCI_DUMP_LOG_LEVEL_ERROR, true);
+    hci_dump_enable_log_level(HCI_DUMP_LOG_LEVEL_DEBUG, true);
+    hci_dump_enable_packet_log(true);
+    #endif
+
     if (pdata->chipset_instance != NULL) {
         hci_set_chipset(pdata->chipset_instance());
     }

lib/pbio/drv/uart/uart_debug_first_port.h

@@ -21,9 +21,20 @@ void pbdrv_uart_debug_init(void);
 
 #else // PBDRV_CONFIG_UART_DEBUG_FIRST_PORT
 
+#if PBDRV_CONFIG_UART_DEBUG_FIRST_PORT_IS_STDERR
+
+#include <stdio.h>
+
+#define pbdrv_uart_debug_printf(...) fprintf(stderr, __VA_ARGS__)
+#define pbdrv_uart_debug_vprintf(format, argptr) vfprintf(stderr, format, argptr)
+
+#else
+
 #define pbdrv_uart_debug_printf(...)
 #define pbdrv_uart_debug_vprintf(format, argptr)
 
+#endif  // PBDRV_CONFIG_UART_DEBUG_FIRST_PORT_IS_STDERR
+
 #define pbdrv_uart_debug_is_done() (true)
 
 #define pbdrv_uart_debug_init()

lib/pbio/platform/virtual_hub/pbdrvconfig.h

@@ -41,6 +41,8 @@
 #define PBDRV_CONFIG_MOTOR_DRIVER_NUM_DEV                   (6)
 #define PBDRV_CONFIG_MOTOR_DRIVER_VIRTUAL_SIMULATION        (1)
 
+#define PBDRV_CONFIG_UART_DEBUG_FIRST_PORT_IS_STDERR        (1)
+
 #define PBDRV_CONFIG_HAS_PORT_A (1)
 #define PBDRV_CONFIG_HAS_PORT_B (1)
 #define PBDRV_CONFIG_HAS_PORT_C (1)