pbio/drv/bluetooth_btstack: Dynamically test local version.

The EV3 is known to have different Bluetooth chips, so we need to determine the version at runtime before we send the initialization script.

Author: laurensvalk

lib/pbio/drv/bluetooth/bluetooth_btstack.c

@@ -223,6 +223,30 @@ static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packe
     #endif // PBDRV_CONFIG_BLUETOOTH_BTSTACK_LE
 
     switch (hci_event_packet_get_type(packet)) {
+        case HCI_EVENT_COMMAND_COMPLETE: {
+            const uint8_t *rp = hci_event_command_complete_get_return_parameters(packet);
+            switch (hci_event_command_complete_get_command_opcode(packet)) {
+                case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION: {
+                    uint16_t lmp_pal_subversion = pbio_get_uint16_le(&rp[7]);
+                    pbdrv_bluetooth_btstack_set_chipset(lmp_pal_subversion);
+
+                    #if DEBUG
+                    // Show version in ev3dev format.
+                    uint16_t chip = (lmp_pal_subversion & 0x7C00) >> 10;
+                    uint16_t min_ver = (lmp_pal_subversion & 0x007F);
+                    uint16_t maj_ver = (lmp_pal_subversion & 0x0380) >> 7;
+                    if (lmp_pal_subversion & 0x8000) {
+                        maj_ver |= 0x0008;
+                    }
+                    DEBUG_PRINT("LMP %04x: TIInit_%d.%d.%d.bts\n", lmp_pal_subversion, chip, maj_ver, min_ver);
+                    #endif
+                    break;
+                }
+                default:
+                    break;
+            }
+            break;
+        }
         #if PBDRV_CONFIG_BLUETOOTH_BTSTACK_LE
         case GATT_EVENT_SERVICE_QUERY_RESULT: {
             // Service discovery not used.

lib/pbio/drv/bluetooth/bluetooth_btstack.h

@@ -12,6 +12,14 @@
 
 void pbdrv_bluetooth_btstack_run_loop_trigger(void);
 
+/**
+ * Hook called when BTstack reads the local version information.
+ *
+ * This is called _after_ hci_set_chipset but _before_ the init script is sent
+ * over the wire, so this can be used to dynamically select the init script.
+ */
+void pbdrv_bluetooth_btstack_set_chipset(uint16_t lmp_pal_subversion);
+
 typedef struct {
     const hci_transport_t *(*transport_instance)(void);
     const void *(*transport_config)(void);

lib/pbio/drv/bluetooth/bluetooth_btstack_stm32_hal.c

@@ -22,6 +22,11 @@
 
 #include <pbdrv/gpio.h>
 
+void pbdrv_bluetooth_btstack_set_chipset(uint16_t lmp_pal_subversion) {
+    // All platforms supported by this abstraction use a cc2560x with the same
+    // init script, so nothing to do here.
+}
+
 static int btstack_control_gpio_on(void) {
     const pbdrv_bluetooth_btstack_stm32_platform_data_t *pdata =
         &pbdrv_bluetooth_btstack_stm32_platform_data;

lib/pbio/test/drv/test_bluetooth_btstack.c

@@ -770,6 +770,10 @@ static void handle_data_source(btstack_data_source_t *ds,  btstack_data_source_c
     }
 }
 
+void pbdrv_bluetooth_btstack_set_chipset(uint16_t lmp_pal_subversion) {
+}
+
+
 static pbio_error_t test_btstack_run_loop_contiki_poll(pbio_os_state_t *state, void *context) {
     static btstack_data_source_t data_source;
     static uint32_t callback_count;